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 19589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian#include <stdint.h> 20589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian#include <sys/types.h> 21589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 22589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian#include <utils/Errors.h> 23589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian#include <utils/RefBase.h> 2459abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown#include <utils/Looper.h> 25589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 26589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian#include <gui/Sensor.h> 275cae0d0699a169e468fff3e21165f35db12f2cdeMathias Agopian#include <gui/BitTube.h> 28589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian#include <gui/SensorEventQueue.h> 29589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian#include <gui/ISensorEventConnection.h> 30589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 31589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian#include <android/sensor.h> 32589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 33589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian// ---------------------------------------------------------------------------- 34589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopiannamespace android { 35589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian// ---------------------------------------------------------------------------- 36589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 37589ce85ee4174829cfedce91b6b2509d2a4002ebMathias AgopianSensorEventQueue::SensorEventQueue(const sp<ISensorEventConnection>& connection) 3890ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian : mSensorEventConnection(connection), mRecBuffer(NULL), mAvailable(0), mConsumed(0) { 3990ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian mRecBuffer = new ASensorEvent[MAX_RECEIVE_BUFFER_EVENT_COUNT]; 40589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 41589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 4290ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias AgopianSensorEventQueue::~SensorEventQueue() { 4390ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian delete [] mRecBuffer; 44589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 45589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 46589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopianvoid SensorEventQueue::onFirstRef() 47589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian{ 48589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian mSensorChannel = mSensorEventConnection->getSensorChannel(); 49589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 50589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 51589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopianint SensorEventQueue::getFd() const 52589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian{ 53589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian return mSensorChannel->getFd(); 54589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 55589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 567b5be95cb3903087742f1079fe89cddd8abe3696Mathias Agopian 577b5be95cb3903087742f1079fe89cddd8abe3696Mathias Agopianssize_t SensorEventQueue::write(const sp<BitTube>& tube, 587b5be95cb3903087742f1079fe89cddd8abe3696Mathias Agopian ASensorEvent const* events, size_t numEvents) { 597b5be95cb3903087742f1079fe89cddd8abe3696Mathias Agopian return BitTube::sendObjects(tube, events, numEvents); 60589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 61589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 6290ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopianssize_t SensorEventQueue::read(ASensorEvent* events, size_t numEvents) { 6390ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian if (mAvailable == 0) { 6490ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian ssize_t err = BitTube::recvObjects(mSensorChannel, 6590ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian mRecBuffer, MAX_RECEIVE_BUFFER_EVENT_COUNT); 6690ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian if (err < 0) { 6790ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian return err; 6890ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian } 6990ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian mAvailable = err; 7090ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian mConsumed = 0; 7190ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian } 7290ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian size_t count = numEvents < mAvailable ? numEvents : mAvailable; 7390ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian memcpy(events, mRecBuffer + mConsumed, count*sizeof(ASensorEvent)); 7490ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian mAvailable -= count; 7590ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian mConsumed += count; 7690ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian return count; 77589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 78589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 7959abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brownsp<Looper> SensorEventQueue::getLooper() const 80589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian{ 81a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian Mutex::Autolock _l(mLock); 8259abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown if (mLooper == 0) { 8359abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown mLooper = new Looper(true); 8459abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown mLooper->addFd(getFd(), getFd(), ALOOPER_EVENT_INPUT, NULL, NULL); 85a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian } 8659abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown return mLooper; 87589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 88589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 89a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopianstatus_t SensorEventQueue::waitForEvent() const 90589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian{ 91a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian const int fd = getFd(); 9259abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown sp<Looper> looper(getLooper()); 93aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian 9429267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian int events; 95aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian int32_t result; 96aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian do { 9729267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian result = looper->pollOnce(-1, NULL, &events, NULL); 9829267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian if (result == ALOOPER_POLL_ERROR) { 99e6f43ddce78d6846af12550ff9193c5c6fe5844bSteve Block ALOGE("SensorEventQueue::waitForEvent error (errno=%d)", errno); 100aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian result = -EPIPE; // unknown error, so we make up one 101aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian break; 102aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian } 10329267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian if (events & ALOOPER_EVENT_HANGUP) { 10429267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian // the other-side has died 10529267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian ALOGE("SensorEventQueue::waitForEvent error HANGUP"); 10629267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian result = -EPIPE; // unknown error, so we make up one 10729267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian break; 10829267fe8495a74893dfce1bd9eceb6448df7abeaMathias Agopian } 109aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian } while (result != fd); 110aeda9afdba5c28d4d152e3ec3bce74be42949065Mathias Agopian 1112ffb24799e579c47a73c992ab567f05c4bf0c962Mathias Agopian return (result == fd) ? status_t(NO_ERROR) : result; 112589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 113589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 114a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopianstatus_t SensorEventQueue::wake() const 115589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian{ 11659abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown sp<Looper> looper(getLooper()); 11759abe7e0909bf4b7bf7b9601e1e40a05f6d4fd8aJeff Brown looper->wake(); 118a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian return NO_ERROR; 119a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian} 120a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian 121a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopianstatus_t SensorEventQueue::enableSensor(Sensor const* sensor) const { 122724d91d778e71c8186399f4955de14b54812b3edAravind Akella return mSensorEventConnection->enableDisable(sensor->getHandle(), true, 0, 0, false); 123a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian} 124a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian 125a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopianstatus_t SensorEventQueue::disableSensor(Sensor const* sensor) const { 126724d91d778e71c8186399f4955de14b54812b3edAravind Akella return mSensorEventConnection->enableDisable(sensor->getHandle(), false, 0, 0, false); 127a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian} 128a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian 129724d91d778e71c8186399f4955de14b54812b3edAravind Akellastatus_t SensorEventQueue::enableSensor(int32_t handle, int32_t samplingPeriodUs, 130724d91d778e71c8186399f4955de14b54812b3edAravind Akella int maxBatchReportLatencyUs, int reservedFlags) const { 131724d91d778e71c8186399f4955de14b54812b3edAravind Akella return mSensorEventConnection->enableDisable(handle, true, us2ns(samplingPeriodUs), 132724d91d778e71c8186399f4955de14b54812b3edAravind Akella us2ns(maxBatchReportLatencyUs), reservedFlags); 133724d91d778e71c8186399f4955de14b54812b3edAravind Akella} 134724d91d778e71c8186399f4955de14b54812b3edAravind Akella 135701166d9f60a6e1149ff568aec0e03f3f3925292Aravind Akellastatus_t SensorEventQueue::flush() const { 136701166d9f60a6e1149ff568aec0e03f3f3925292Aravind Akella return mSensorEventConnection->flush(); 137a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian} 138a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian 139a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopianstatus_t SensorEventQueue::disableSensor(int32_t handle) const { 140724d91d778e71c8186399f4955de14b54812b3edAravind Akella return mSensorEventConnection->enableDisable(handle, false, 0, 0, false); 141a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian} 142a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopian 143a7352c9f4a6e642c29782b19db5bc0bd98feddc8Mathias Agopianstatus_t SensorEventQueue::setEventRate(Sensor const* sensor, nsecs_t ns) const { 144589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian return mSensorEventConnection->setEventRate(sensor->getHandle(), ns); 145589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian} 146589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 147589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian// ---------------------------------------------------------------------------- 148589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian}; // namespace android 149589ce85ee4174829cfedce91b6b2509d2a4002ebMathias Agopian 150