1589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian/* 2589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian * Copyright (C) 2010 The Android Open Source Project 3589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian * 4589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian * Licensed under the Apache License, Version 2.0 (the "License"); 5589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian * you may not use this file except in compliance with the License. 6589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian * You may obtain a copy of the License at 7589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian * 8589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian * http://www.apache.org/licenses/LICENSE-2.0 9589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian * 10589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian * Unless required by applicable law or agreed to in writing, software 11589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian * distributed under the License is distributed on an "AS IS" BASIS, 12589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian * See the License for the specific language governing permissions and 14589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian * limitations under the License. 15589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian */ 16a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian 17a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian#define LOG_TAG "Sensors" 18a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian 19801ea093b0e923a61b832f2adba698a273479880Mathias Agopian#include <sensor/SensorEventQueue.h> 20801ea093b0e923a61b832f2adba698a273479880Mathias Agopian 21d723bd7669b4fc88dc282d8bf8ba5ecb2849d22fDan Stoza#include <algorithm> 2256ae42613c91f6a6fb0dc3f626daa24666fd18c2Aravind Akella#include <sys/socket.h> 23589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 24589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian#include <utils/RefBase.h> 2559abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown#include <utils/Looper.h> 26589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 27801ea093b0e923a61b832f2adba698a273479880Mathias Agopian#include <sensor/Sensor.h> 28801ea093b0e923a61b832f2adba698a273479880Mathias Agopian#include <sensor/BitTube.h> 29801ea093b0e923a61b832f2adba698a273479880Mathias Agopian#include <sensor/ISensorEventConnection.h> 30589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 31589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian#include <android/sensor.h> 32589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 33d723bd7669b4fc88dc282d8bf8ba5ecb2849d22fDan Stozausing std::min; 34d723bd7669b4fc88dc282d8bf8ba5ecb2849d22fDan Stoza 35589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian// ---------------------------------------------------------------------------- 36589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopiannamespace android { 37589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian// ---------------------------------------------------------------------------- 38589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 39589ce85ee4174829cfedce91b6b2509d2a4002ebMathias AgopianSensorEventQueue::SensorEventQueue(const sp<ISensorEventConnection>& connection) 408a96955c8e14db40b16164236830fc9506a00872Aravind Akella : mSensorEventConnection(connection), mRecBuffer(NULL), mAvailable(0), mConsumed(0), 418a96955c8e14db40b16164236830fc9506a00872Aravind Akella mNumAcksToSend(0) { 4290ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian mRecBuffer = new ASensorEvent[MAX_RECEIVE_BUFFER_EVENT_COUNT]; 43589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 44589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 4590ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias AgopianSensorEventQueue::~SensorEventQueue() { 4690ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian delete [] mRecBuffer; 47589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 48589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 49589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopianvoid SensorEventQueue::onFirstRef() 50589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian{ 51589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian mSensorChannel = mSensorEventConnection->getSensorChannel(); 52589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 53589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 54589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopianint SensorEventQueue::getFd() const 55589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian{ 56589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian return mSensorChannel->getFd(); 57589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 58589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 597b5be95cb3903087742f1079fe89cddd8abe3696Mathias Agopian 607b5be95cb3903087742f1079fe89cddd8abe3696Mathias Agopianssize_t SensorEventQueue::write(const sp<BitTube>& tube, 617b5be95cb3903087742f1079fe89cddd8abe3696Mathias Agopian ASensorEvent const* events, size_t numEvents) { 627b5be95cb3903087742f1079fe89cddd8abe3696Mathias Agopian return BitTube::sendObjects(tube, events, numEvents); 63589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 64589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 6590ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopianssize_t SensorEventQueue::read(ASensorEvent* events, size_t numEvents) { 6690ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian if (mAvailable == 0) { 6790ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian ssize_t err = BitTube::recvObjects(mSensorChannel, 6890ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian mRecBuffer, MAX_RECEIVE_BUFFER_EVENT_COUNT); 6990ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian if (err < 0) { 7090ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian return err; 7190ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian } 72d723bd7669b4fc88dc282d8bf8ba5ecb2849d22fDan Stoza mAvailable = static_cast<size_t>(err); 7390ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian mConsumed = 0; 7490ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian } 75d723bd7669b4fc88dc282d8bf8ba5ecb2849d22fDan Stoza size_t count = min(numEvents, mAvailable); 76d723bd7669b4fc88dc282d8bf8ba5ecb2849d22fDan Stoza memcpy(events, mRecBuffer + mConsumed, count * sizeof(ASensorEvent)); 7790ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian mAvailable -= count; 7890ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian mConsumed += count; 79d723bd7669b4fc88dc282d8bf8ba5ecb2849d22fDan Stoza return static_cast<ssize_t>(count); 80589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 81589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 8259abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brownsp<Looper> SensorEventQueue::getLooper() const 83589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian{ 84a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian Mutex::Autolock _l(mLock); 8559abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown if (mLooper == 0) { 8659abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown mLooper = new Looper(true); 8759abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown mLooper->addFd(getFd(), getFd(), ALOOPER_EVENT_INPUT, NULL, NULL); 88a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian } 8959abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown return mLooper; 90589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 91589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 92a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopianstatus_t SensorEventQueue::waitForEvent() const 93589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian{ 94a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian const int fd = getFd(); 9559abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown sp<Looper> looper(getLooper()); 96aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian 9729267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian int events; 98aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian int32_t result; 99aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian do { 10029267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian result = looper->pollOnce(-1, NULL, &events, NULL); 10129267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian if (result == ALOOPER_POLL_ERROR) { 102e6f43ddce78d6846af12550ff9193c5c6fe5844bSteve Block ALOGE("SensorEventQueue::waitForEvent error (errno=%d)", errno); 103aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian result = -EPIPE; // unknown error, so we make up one 104aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian break; 105aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian } 10629267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian if (events & ALOOPER_EVENT_HANGUP) { 10729267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian // the other-side has died 10829267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian ALOGE("SensorEventQueue::waitForEvent error HANGUP"); 10929267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian result = -EPIPE; // unknown error, so we make up one 11029267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian break; 11129267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian } 112aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian } while (result != fd); 113aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian 1142ffb24799e579c47a73c992ab567f05c4bf0c962Mathias Agopian return (result == fd) ? status_t(NO_ERROR) : result; 115589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 116589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 117a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopianstatus_t SensorEventQueue::wake() const 118589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian{ 11959abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown sp<Looper> looper(getLooper()); 12059abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown looper->wake(); 121a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian return NO_ERROR; 122a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian} 123a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian 124a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopianstatus_t SensorEventQueue::enableSensor(Sensor const* sensor) const { 1252f3bf13887257abc9943b7e5bf58e9cd8189eb0aPeng Xu return enableSensor(sensor, SENSOR_DELAY_NORMAL); 1262f3bf13887257abc9943b7e5bf58e9cd8189eb0aPeng Xu} 1272f3bf13887257abc9943b7e5bf58e9cd8189eb0aPeng Xu 1282f3bf13887257abc9943b7e5bf58e9cd8189eb0aPeng Xustatus_t SensorEventQueue::enableSensor(Sensor const* sensor, int32_t samplingPeriodUs) const { 1292f3bf13887257abc9943b7e5bf58e9cd8189eb0aPeng Xu return mSensorEventConnection->enableDisable(sensor->getHandle(), true, 1302f3bf13887257abc9943b7e5bf58e9cd8189eb0aPeng Xu us2ns(samplingPeriodUs), 0, 0); 131a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian} 132a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian 133a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopianstatus_t SensorEventQueue::disableSensor(Sensor const* sensor) const { 1342f3bf13887257abc9943b7e5bf58e9cd8189eb0aPeng Xu return mSensorEventConnection->enableDisable(sensor->getHandle(), false, 0, 0, 0); 135a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian} 136a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian 137724d91d778e71c8186399f4955de14b54812b3edAravind Akellastatus_t SensorEventQueue::enableSensor(int32_t handle, int32_t samplingPeriodUs, 138da8385cb97ba40ab87e7e9b8d5b7c8f0ba5ba0fdPeng Xu int64_t maxBatchReportLatencyUs, int reservedFlags) const { 139724d91d778e71c8186399f4955de14b54812b3edAravind Akella return mSensorEventConnection->enableDisable(handle, true, us2ns(samplingPeriodUs), 140724d91d778e71c8186399f4955de14b54812b3edAravind Akella us2ns(maxBatchReportLatencyUs), reservedFlags); 141724d91d778e71c8186399f4955de14b54812b3edAravind Akella} 142724d91d778e71c8186399f4955de14b54812b3edAravind Akella 143701166d9f60a6e1149ff568aec0e03f3f3925292Aravind Akellastatus_t SensorEventQueue::flush() const { 144701166d9f60a6e1149ff568aec0e03f3f3925292Aravind Akella return mSensorEventConnection->flush(); 145a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian} 146a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian 147a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopianstatus_t SensorEventQueue::disableSensor(int32_t handle) const { 148724d91d778e71c8186399f4955de14b54812b3edAravind Akella return mSensorEventConnection->enableDisable(handle, false, 0, 0, false); 149a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian} 150a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian 151a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopianstatus_t SensorEventQueue::setEventRate(Sensor const* sensor, nsecs_t ns) const { 152589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian return mSensorEventConnection->setEventRate(sensor->getHandle(), ns); 153589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 154589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 155a9e6cc387072e25706a6d847a97b02a6f25a918bAravind Akellastatus_t SensorEventQueue::injectSensorEvent(const ASensorEvent& event) { 1565c538053346107a8ec704d8769059ab6a23ebeefAravind Akella do { 1575c538053346107a8ec704d8769059ab6a23ebeefAravind Akella // Blocking call. 1585c538053346107a8ec704d8769059ab6a23ebeefAravind Akella ssize_t size = ::send(mSensorChannel->getFd(), &event, sizeof(event), MSG_NOSIGNAL); 1595c538053346107a8ec704d8769059ab6a23ebeefAravind Akella if (size >= 0) { 1605c538053346107a8ec704d8769059ab6a23ebeefAravind Akella return NO_ERROR; 1615c538053346107a8ec704d8769059ab6a23ebeefAravind Akella } else if (size < 0 && errno == EAGAIN) { 1625c538053346107a8ec704d8769059ab6a23ebeefAravind Akella // If send is returning a "Try again" error, sleep for 100ms and try again. In all 1635c538053346107a8ec704d8769059ab6a23ebeefAravind Akella // other cases log a failure and exit. 1645c538053346107a8ec704d8769059ab6a23ebeefAravind Akella usleep(100000); 1655c538053346107a8ec704d8769059ab6a23ebeefAravind Akella } else { 1665c538053346107a8ec704d8769059ab6a23ebeefAravind Akella ALOGE("injectSensorEvent failure %s %zd", strerror(errno), size); 1675c538053346107a8ec704d8769059ab6a23ebeefAravind Akella return INVALID_OPERATION; 1685c538053346107a8ec704d8769059ab6a23ebeefAravind Akella } 1695c538053346107a8ec704d8769059ab6a23ebeefAravind Akella } while (true); 170a9e6cc387072e25706a6d847a97b02a6f25a918bAravind Akella} 171a9e6cc387072e25706a6d847a97b02a6f25a918bAravind Akella 1729a844cf78f09953145200b4074d47589257a408cAravind Akellavoid SensorEventQueue::sendAck(const ASensorEvent* events, int count) { 1739a844cf78f09953145200b4074d47589257a408cAravind Akella for (int i = 0; i < count; ++i) { 1749a844cf78f09953145200b4074d47589257a408cAravind Akella if (events[i].flags & WAKE_UP_SENSOR_EVENT_NEEDS_ACK) { 1758a96955c8e14db40b16164236830fc9506a00872Aravind Akella ++mNumAcksToSend; 1768a96955c8e14db40b16164236830fc9506a00872Aravind Akella } 1778a96955c8e14db40b16164236830fc9506a00872Aravind Akella } 1788a96955c8e14db40b16164236830fc9506a00872Aravind Akella // Send mNumAcksToSend to acknowledge for the wake up sensor events received. 1798a96955c8e14db40b16164236830fc9506a00872Aravind Akella if (mNumAcksToSend > 0) { 1808a96955c8e14db40b16164236830fc9506a00872Aravind Akella ssize_t size = ::send(mSensorChannel->getFd(), &mNumAcksToSend, sizeof(mNumAcksToSend), 1818a96955c8e14db40b16164236830fc9506a00872Aravind Akella MSG_DONTWAIT | MSG_NOSIGNAL); 1828a96955c8e14db40b16164236830fc9506a00872Aravind Akella if (size < 0) { 183f10c46ef855b6410b20ebd8b1351d4d78d8eca8eDan Stoza ALOGE("sendAck failure %zd %d", size, mNumAcksToSend); 1848a96955c8e14db40b16164236830fc9506a00872Aravind Akella } else { 1858a96955c8e14db40b16164236830fc9506a00872Aravind Akella mNumAcksToSend = 0; 1869a844cf78f09953145200b4074d47589257a408cAravind Akella } 1879a844cf78f09953145200b4074d47589257a408cAravind Akella } 1889a844cf78f09953145200b4074d47589257a408cAravind Akella return; 1899a844cf78f09953145200b4074d47589257a408cAravind Akella} 1909a844cf78f09953145200b4074d47589257a408cAravind Akella 191589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian// ---------------------------------------------------------------------------- 192589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian}; // namespace android 193589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 194