1e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/****************************************************************************** 2e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * 3e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * Copyright (C) 2012 Broadcom Corporation 4e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * 5e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * Licensed under the Apache License, Version 2.0 (the "License"); 6e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * you may not use this file except in compliance with the License. 7e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * You may obtain a copy of the License at: 8e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * 9e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * http://www.apache.org/licenses/LICENSE-2.0 10e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * 11e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * Unless required by applicable law or agreed to in writing, software 12e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * distributed under the License is distributed on an "AS IS" BASIS, 13e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 14e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * See the License for the specific language governing permissions and 15e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * limitations under the License. 16e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * 17e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project ******************************************************************************/ 18e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 19e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/****************************************************************************** 20e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * 21e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * Encapsulate a condition variable for thread synchronization. 22e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project * 23e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project ******************************************************************************/ 24e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#define LOG_TAG "NfcNciHal" 25e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#include "OverrideLog.h" 26e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#include "CondVar.h" 27e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project#include <errno.h> 28e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 29e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 30e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 31e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 32e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function: CondVar 33e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 34e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description: Initialize member variables. 35e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 36e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns: None. 37e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 38e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 39e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source ProjectCondVar::CondVar () 40e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{ 418d3c6b9faddfe63303c72dd050e25b9673a6e7d8Colin Cross pthread_condattr_t attr; 428d3c6b9faddfe63303c72dd050e25b9673a6e7d8Colin Cross pthread_condattr_init(&attr); 438d3c6b9faddfe63303c72dd050e25b9673a6e7d8Colin Cross pthread_condattr_setclock(&attr, CLOCK_MONOTONIC); 44e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project memset (&mCondition, 0, sizeof(mCondition)); 458d3c6b9faddfe63303c72dd050e25b9673a6e7d8Colin Cross int const res = pthread_cond_init (&mCondition, &attr); 46e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project if (res) 47e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project { 48e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project ALOGE ("CondVar::CondVar: fail init; error=0x%X", res); 49e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 50e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 51e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 52e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 53e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 54e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 55e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function: ~CondVar 56e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 57e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description: Cleanup all resources. 58e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 59e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns: None. 60e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 61e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 62e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source ProjectCondVar::~CondVar () 63e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{ 64e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project int const res = pthread_cond_destroy (&mCondition); 65e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project if (res) 66e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project { 67e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project ALOGE ("CondVar::~CondVar: fail destroy; error=0x%X", res); 68e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 69e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 70e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 71e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 72e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 73e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 74e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function: wait 75e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 76e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description: Block the caller and wait for a condition. 77e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 78e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns: None. 79e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 80e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 81e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid CondVar::wait (Mutex& mutex) 82e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{ 83e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project int const res = pthread_cond_wait (&mCondition, mutex.nativeHandle()); 84e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project if (res) 85e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project { 86e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project ALOGE ("CondVar::wait: fail wait; error=0x%X", res); 87e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 88e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 89e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 90e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 91e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 92e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 93e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function: wait 94e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 95e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description: Block the caller and wait for a condition. 96e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** millisec: Timeout in milliseconds. 97e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 98e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns: True if wait is successful; false if timeout occurs. 99e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 100e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 101e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectbool CondVar::wait (Mutex& mutex, long millisec) 102e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{ 103e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project bool retVal = false; 104e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project struct timespec absoluteTime; 105e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 106e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project if (clock_gettime (CLOCK_MONOTONIC, &absoluteTime) == -1) 107e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project { 108e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project ALOGE ("CondVar::wait: fail get time; errno=0x%X", errno); 109e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 110e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project else 111e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project { 112e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project absoluteTime.tv_sec += millisec / 1000; 113e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project long ns = absoluteTime.tv_nsec + ((millisec % 1000) * 1000000); 114e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project if (ns > 1000000000) 115e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project { 116e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project absoluteTime.tv_sec++; 117e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project absoluteTime.tv_nsec = ns - 1000000000; 118e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 119e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project else 120e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project absoluteTime.tv_nsec = ns; 121e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 122e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 1230a85f658ebd49b72be39fe0fb61fcca4ee0fbc82Martijn Coenen int waitResult = pthread_cond_timedwait (&mCondition, mutex.nativeHandle(), &absoluteTime); 124e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project if ((waitResult != 0) && (waitResult != ETIMEDOUT)) 125e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project ALOGE ("CondVar::wait: fail timed wait; error=0x%X", waitResult); 126e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project retVal = (waitResult == 0); //waited successfully 127e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project return retVal; 128e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 129e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 130e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 131e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project/******************************************************************************* 132e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 133e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Function: notifyOne 134e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 135e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Description: Unblock the waiting thread. 136e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 137e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** Returns: None. 138e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project** 139e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project*******************************************************************************/ 140e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Projectvoid CondVar::notifyOne () 141e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project{ 142e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project int const res = pthread_cond_signal (&mCondition); 143e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project if (res) 144e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project { 145e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project ALOGE ("CondVar::notifyOne: fail signal; error=0x%X", res); 146e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project } 147e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project} 148e9df6ba5a8fcccf306a80b1670b423be8fe7746The Android Open Source Project 149