SensorService.cpp revision 700180487ffec09d9df1657b018a7caadac24b75
1fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian/* 2fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian * Copyright (C) 2010 The Android Open Source Project 3fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian * 4fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian * Licensed under the Apache License, Version 2.0 (the "License"); 5fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian * you may not use this file except in compliance with the License. 6fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian * You may obtain a copy of the License at 7fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian * 8fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian * http://www.apache.org/licenses/LICENSE-2.0 9fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian * 10fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian * Unless required by applicable law or agreed to in writing, software 11fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian * distributed under the License is distributed on an "AS IS" BASIS, 12fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian * See the License for the specific language governing permissions and 14fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian * limitations under the License. 15fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian */ 16fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 17fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian#include <stdint.h> 18f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian#include <math.h> 19fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian#include <sys/types.h> 20fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 213301542828febc768e1df42892cfac4992c35474Mathias Agopian#include <cutils/properties.h> 223301542828febc768e1df42892cfac4992c35474Mathias Agopian 23fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian#include <utils/SortedVector.h> 24fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian#include <utils/KeyedVector.h> 25fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian#include <utils/threads.h> 26fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian#include <utils/Atomic.h> 27fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian#include <utils/Errors.h> 28fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian#include <utils/RefBase.h> 29451beee076cac09f817abae78a990dea108a9482Mathias Agopian#include <utils/Singleton.h> 30c4a930d1d5a432a1f302763ac55460d6e83fe7e0Mathias Agopian#include <utils/String16.h> 31fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 32fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian#include <binder/BinderService.h> 33451beee076cac09f817abae78a990dea108a9482Mathias Agopian#include <binder/IServiceManager.h> 341cb13461a8cf62e3ba634e5965332f2d284f6d42Mathias Agopian#include <binder/PermissionCache.h> 35fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 36fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian#include <gui/ISensorServer.h> 37fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian#include <gui/ISensorEventConnection.h> 38907103bf186cfdd2ed9eb3b6c36de53ade7b16f6Mathias Agopian#include <gui/SensorEventQueue.h> 39fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 40fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian#include <hardware/sensors.h> 414342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh#include <hardware_legacy/power.h> 42fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 43787ac1b388f144f5e6dd38f8b807866a5256dafcMathias Agopian#include "BatteryService.h" 44984826cc158193e61e3a00359ef4f6699c7d748aMathias Agopian#include "CorrectedGyroSensor.h" 45f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian#include "GravitySensor.h" 46f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian#include "LinearAccelerationSensor.h" 47984826cc158193e61e3a00359ef4f6699c7d748aMathias Agopian#include "OrientationSensor.h" 48f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian#include "RotationVectorSensor.h" 49984826cc158193e61e3a00359ef4f6699c7d748aMathias Agopian#include "SensorFusion.h" 50984826cc158193e61e3a00359ef4f6699c7d748aMathias Agopian#include "SensorService.h" 51fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 52fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopiannamespace android { 53fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian// --------------------------------------------------------------------------- 54fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 553301542828febc768e1df42892cfac4992c35474Mathias Agopian/* 563301542828febc768e1df42892cfac4992c35474Mathias Agopian * Notes: 573301542828febc768e1df42892cfac4992c35474Mathias Agopian * 583301542828febc768e1df42892cfac4992c35474Mathias Agopian * - what about a gyro-corrected magnetic-field sensor? 593301542828febc768e1df42892cfac4992c35474Mathias Agopian * - run mag sensor from time to time to force calibration 603301542828febc768e1df42892cfac4992c35474Mathias Agopian * - gravity sensor length is wrong (=> drift in linear-acc sensor) 613301542828febc768e1df42892cfac4992c35474Mathias Agopian * 623301542828febc768e1df42892cfac4992c35474Mathias Agopian */ 633301542828febc768e1df42892cfac4992c35474Mathias Agopian 644342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganeshconst char* SensorService::WAKE_LOCK_NAME = "SensorService"; 654342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh 66fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias AgopianSensorService::SensorService() 671cb13461a8cf62e3ba634e5965332f2d284f6d42Mathias Agopian : mInitCheck(NO_INIT) 68fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 69fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 70fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 71fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopianvoid SensorService::onFirstRef() 72fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 73a551237de142549fb8a6608ee9d2fbf4b7ca2ebfSteve Block ALOGD("nuSensorService starting..."); 7450df2959e58fc7408f98d11d77c8428397dca445Mathias Agopian 75f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian SensorDevice& dev(SensorDevice::getInstance()); 76fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 77f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian if (dev.initCheck() == NO_ERROR) { 78f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian sensor_t const* list; 797b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian ssize_t count = dev.getSensorList(&list); 807b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian if (count > 0) { 817b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian ssize_t orientationIndex = -1; 827b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian bool hasGyro = false; 837b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian uint32_t virtualSensorsNeeds = 847b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian (1<<SENSOR_TYPE_GRAVITY) | 857b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian (1<<SENSOR_TYPE_LINEAR_ACCELERATION) | 867b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian (1<<SENSOR_TYPE_ROTATION_VECTOR); 877b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian 887b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian mLastEventSeen.setCapacity(count); 897b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian for (ssize_t i=0 ; i<count ; i++) { 907b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian registerSensor( new HardwareSensor(list[i]) ); 917b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian switch (list[i].type) { 927b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian case SENSOR_TYPE_ORIENTATION: 937b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian orientationIndex = i; 947b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian break; 957b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian case SENSOR_TYPE_GYROSCOPE: 960319306670b0344da99efa606b6f172dde575a39Mathias Agopian case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED: 977b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian hasGyro = true; 987b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian break; 997b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian case SENSOR_TYPE_GRAVITY: 1007b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian case SENSOR_TYPE_LINEAR_ACCELERATION: 1017b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian case SENSOR_TYPE_ROTATION_VECTOR: 1027b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian virtualSensorsNeeds &= ~(1<<list[i].type); 1037b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian break; 1047b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian } 10550df2959e58fc7408f98d11d77c8428397dca445Mathias Agopian } 106fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 1077b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian // it's safe to instantiate the SensorFusion object here 1087b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian // (it wants to be instantiated after h/w sensors have been 1097b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian // registered) 1107b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian const SensorFusion& fusion(SensorFusion::getInstance()); 1117b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian 1120319306670b0344da99efa606b6f172dde575a39Mathias Agopian // build the sensor list returned to users 1130319306670b0344da99efa606b6f172dde575a39Mathias Agopian mUserSensorList = mSensorList; 1140319306670b0344da99efa606b6f172dde575a39Mathias Agopian 1157b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian if (hasGyro) { 1160319306670b0344da99efa606b6f172dde575a39Mathias Agopian Sensor aSensor; 1177b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian 1180319306670b0344da99efa606b6f172dde575a39Mathias Agopian // Add Android virtual sensors if they're not already 1190319306670b0344da99efa606b6f172dde575a39Mathias Agopian // available in the HAL 1207b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian 1210319306670b0344da99efa606b6f172dde575a39Mathias Agopian aSensor = registerVirtualSensor( new RotationVectorSensor() ); 1220319306670b0344da99efa606b6f172dde575a39Mathias Agopian if (virtualSensorsNeeds & (1<<SENSOR_TYPE_ROTATION_VECTOR)) { 1230319306670b0344da99efa606b6f172dde575a39Mathias Agopian mUserSensorList.add(aSensor); 1240319306670b0344da99efa606b6f172dde575a39Mathias Agopian } 125f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian 1260319306670b0344da99efa606b6f172dde575a39Mathias Agopian aSensor = registerVirtualSensor( new GravitySensor(list, count) ); 1270319306670b0344da99efa606b6f172dde575a39Mathias Agopian if (virtualSensorsNeeds & (1<<SENSOR_TYPE_GRAVITY)) { 1280319306670b0344da99efa606b6f172dde575a39Mathias Agopian mUserSensorList.add(aSensor); 1290319306670b0344da99efa606b6f172dde575a39Mathias Agopian } 13033264868ba0aaccb9d4b5e5a067a79a43633f6ecMathias Agopian 1310319306670b0344da99efa606b6f172dde575a39Mathias Agopian aSensor = registerVirtualSensor( new LinearAccelerationSensor(list, count) ); 1320319306670b0344da99efa606b6f172dde575a39Mathias Agopian if (virtualSensorsNeeds & (1<<SENSOR_TYPE_LINEAR_ACCELERATION)) { 1330319306670b0344da99efa606b6f172dde575a39Mathias Agopian mUserSensorList.add(aSensor); 1340319306670b0344da99efa606b6f172dde575a39Mathias Agopian } 13533264868ba0aaccb9d4b5e5a067a79a43633f6ecMathias Agopian 1360319306670b0344da99efa606b6f172dde575a39Mathias Agopian aSensor = registerVirtualSensor( new OrientationSensor() ); 1370319306670b0344da99efa606b6f172dde575a39Mathias Agopian if (virtualSensorsNeeds & (1<<SENSOR_TYPE_ROTATION_VECTOR)) { 1380319306670b0344da99efa606b6f172dde575a39Mathias Agopian // if we are doing our own rotation-vector, also add 1390319306670b0344da99efa606b6f172dde575a39Mathias Agopian // the orientation sensor and remove the HAL provided one. 1400319306670b0344da99efa606b6f172dde575a39Mathias Agopian mUserSensorList.replaceAt(aSensor, orientationIndex); 1417b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian } 1420319306670b0344da99efa606b6f172dde575a39Mathias Agopian 1430319306670b0344da99efa606b6f172dde575a39Mathias Agopian // virtual debugging sensors are not added to mUserSensorList 1440319306670b0344da99efa606b6f172dde575a39Mathias Agopian registerVirtualSensor( new CorrectedGyroSensor(list, count) ); 1450319306670b0344da99efa606b6f172dde575a39Mathias Agopian registerVirtualSensor( new GyroDriftSensor() ); 146010e42230135815907e76e5d7e5f30edf9e1799dMathias Agopian } 147010e42230135815907e76e5d7e5f30edf9e1799dMathias Agopian 14833264868ba0aaccb9d4b5e5a067a79a43633f6ecMathias Agopian // debugging sensor list 1490319306670b0344da99efa606b6f172dde575a39Mathias Agopian mUserSensorListDebug = mSensorList; 15033264868ba0aaccb9d4b5e5a067a79a43633f6ecMathias Agopian 1514c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella mSocketBufferSize = SOCKET_BUFFER_SIZE_NON_BATCHED; 1524c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella FILE *fp = fopen("/proc/sys/net/core/wmem_max", "r"); 1534c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella char line[128]; 1544c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (fp != NULL && fgets(line, sizeof(line), fp) != NULL) { 1554c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella line[sizeof(line) - 1] = '\0'; 1564c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella sscanf(line, "%u", &mSocketBufferSize); 1574c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (mSocketBufferSize > MAX_SOCKET_BUFFER_SIZE_BATCHED) { 1584c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella mSocketBufferSize = MAX_SOCKET_BUFFER_SIZE_BATCHED; 1594c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 1604c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 1614c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella ALOGD("Max socket buffer size %u", mSocketBufferSize); 1624c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (fp) { 1634c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella fclose(fp); 1644c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 1654c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella 1667b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian run("SensorService", PRIORITY_URGENT_DISPLAY); 1677b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian mInitCheck = NO_ERROR; 1687b2b32f2e761a919deb6f82d978b379429f77b05Mathias Agopian } 169fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 170fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 171fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 1720319306670b0344da99efa606b6f172dde575a39Mathias AgopianSensor SensorService::registerSensor(SensorInterface* s) 173f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian{ 174f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian sensors_event_t event; 175f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian memset(&event, 0, sizeof(event)); 176f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian 177f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian const Sensor sensor(s->getSensor()); 178f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian // add to the sensor list (returned to clients) 179f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian mSensorList.add(sensor); 180f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian // add to our handle->SensorInterface mapping 181f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian mSensorMap.add(sensor.getHandle(), s); 182f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian // create an entry in the mLastEventSeen array 183f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian mLastEventSeen.add(sensor.getHandle(), event); 1840319306670b0344da99efa606b6f172dde575a39Mathias Agopian 1850319306670b0344da99efa606b6f172dde575a39Mathias Agopian return sensor; 186f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian} 187f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian 1880319306670b0344da99efa606b6f172dde575a39Mathias AgopianSensor SensorService::registerVirtualSensor(SensorInterface* s) 189f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian{ 1900319306670b0344da99efa606b6f172dde575a39Mathias Agopian Sensor sensor = registerSensor(s); 191f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian mVirtualSensorList.add( s ); 1920319306670b0344da99efa606b6f172dde575a39Mathias Agopian return sensor; 193f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian} 194f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian 195fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias AgopianSensorService::~SensorService() 196fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 197f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian for (size_t i=0 ; i<mSensorMap.size() ; i++) 198f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian delete mSensorMap.valueAt(i); 199fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 200fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 2011cb13461a8cf62e3ba634e5965332f2d284f6d42Mathias Agopianstatic const String16 sDump("android.permission.DUMP"); 2021cb13461a8cf62e3ba634e5965332f2d284f6d42Mathias Agopian 203fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopianstatus_t SensorService::dump(int fd, const Vector<String16>& args) 204fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 205fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian String8 result; 2061cb13461a8cf62e3ba634e5965332f2d284f6d42Mathias Agopian if (!PermissionCache::checkCallingPermission(sDump)) { 207ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian result.appendFormat("Permission Denial: " 208700180487ffec09d9df1657b018a7caadac24b75Aravind Akella "can't dump SensorService from pid=%d, uid=%d\n", 209fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian IPCThreadState::self()->getCallingPid(), 210fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian IPCThreadState::self()->getCallingUid()); 211fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } else { 212fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian Mutex::Autolock _l(mLock); 213ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian result.append("Sensor List:\n"); 2143560fb24b668675627934356f210d84d19bf4e56Mathias Agopian for (size_t i=0 ; i<mSensorList.size() ; i++) { 2153560fb24b668675627934356f210d84d19bf4e56Mathias Agopian const Sensor& s(mSensorList[i]); 2163560fb24b668675627934356f210d84d19bf4e56Mathias Agopian const sensors_event_t& e(mLastEventSeen.valueFor(s.getHandle())); 217ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian result.appendFormat( 218700180487ffec09d9df1657b018a7caadac24b75Aravind Akella "%-48s| %-32s| %-48s| 0x%08x | \"%s\"\n\t", 2193560fb24b668675627934356f210d84d19bf4e56Mathias Agopian s.getName().string(), 2203560fb24b668675627934356f210d84d19bf4e56Mathias Agopian s.getVendor().string(), 221700180487ffec09d9df1657b018a7caadac24b75Aravind Akella s.getStringType().string(), 222700180487ffec09d9df1657b018a7caadac24b75Aravind Akella s.getHandle(), 223700180487ffec09d9df1657b018a7caadac24b75Aravind Akella s.getRequiredPermission().string()); 224ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian 225ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian if (s.getMinDelay() > 0) { 226ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian result.appendFormat( 227700180487ffec09d9df1657b018a7caadac24b75Aravind Akella "maxRate=%7.2fHz | ", 1e6f / s.getMinDelay()); 228ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian } else { 229ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian result.append(s.getMinDelay() == 0 230ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian ? "on-demand | " 231ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian : "one-shot | "); 232ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian } 233724d91d778e71c8186399f4955de14b54812b3edAravind Akella if (s.getFifoMaxEventCount() > 0) { 234700180487ffec09d9df1657b018a7caadac24b75Aravind Akella result.appendFormat("FifoMax=%d events | ", 235700180487ffec09d9df1657b018a7caadac24b75Aravind Akella s.getFifoMaxEventCount()); 236724d91d778e71c8186399f4955de14b54812b3edAravind Akella } else { 237724d91d778e71c8186399f4955de14b54812b3edAravind Akella result.append("no batching support | "); 238724d91d778e71c8186399f4955de14b54812b3edAravind Akella } 239ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian 240ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian switch (s.getType()) { 241ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian case SENSOR_TYPE_ROTATION_VECTOR: 242ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian case SENSOR_TYPE_GEOMAGNETIC_ROTATION_VECTOR: 243ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian result.appendFormat( 244ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian "last=<%5.1f,%5.1f,%5.1f,%5.1f,%5.1f>\n", 245ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian e.data[0], e.data[1], e.data[2], e.data[3], e.data[4]); 246ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian break; 247ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian case SENSOR_TYPE_MAGNETIC_FIELD_UNCALIBRATED: 248ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED: 249ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian result.appendFormat( 250ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian "last=<%5.1f,%5.1f,%5.1f,%5.1f,%5.1f,%5.1f>\n", 251ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian e.data[0], e.data[1], e.data[2], e.data[3], e.data[4], e.data[5]); 252ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian break; 253ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian case SENSOR_TYPE_GAME_ROTATION_VECTOR: 254ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian result.appendFormat( 255ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian "last=<%5.1f,%5.1f,%5.1f,%5.1f>\n", 256ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian e.data[0], e.data[1], e.data[2], e.data[3]); 257ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian break; 258ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian case SENSOR_TYPE_SIGNIFICANT_MOTION: 259ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian case SENSOR_TYPE_STEP_DETECTOR: 260ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian result.appendFormat( "last=<%f>\n", e.data[0]); 261ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian break; 262ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian case SENSOR_TYPE_STEP_COUNTER: 263ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian result.appendFormat( "last=<%llu>\n", e.u64.step_counter); 264ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian break; 265ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian default: 266ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian // default to 3 values 267ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian result.appendFormat( 268ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian "last=<%5.1f,%5.1f,%5.1f>\n", 269ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian e.data[0], e.data[1], e.data[2]); 270ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian break; 271ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian } 2723560fb24b668675627934356f210d84d19bf4e56Mathias Agopian } 273ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian SensorFusion::getInstance().dump(result); 274ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian SensorDevice::getInstance().dump(result); 275ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian 276ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian result.append("Active sensors:\n"); 277fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian for (size_t i=0 ; i<mActiveSensors.size() ; i++) { 2785d2707214dfb97bd8dfcc6620be36841d3c82420Mathias Agopian int handle = mActiveSensors.keyAt(i); 279ba02cd2f6cc3f59adf66cb2b9176bfe6c9e382d1Mathias Agopian result.appendFormat("%s (handle=0x%08x, connections=%d)\n", 2805d2707214dfb97bd8dfcc6620be36841d3c82420Mathias Agopian getSensorName(handle).string(), 2815d2707214dfb97bd8dfcc6620be36841d3c82420Mathias Agopian handle, 282fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian mActiveSensors.valueAt(i)->getNumConnections()); 283fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 2844c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella 2854c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella result.appendFormat("%u Max Socket Buffer size\n", mSocketBufferSize); 2864c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella result.appendFormat("%d active connections\n", mActiveConnections.size()); 2874c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella 2884c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella for (size_t i=0 ; i < mActiveConnections.size() ; i++) { 2894c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella sp<SensorEventConnection> connection(mActiveConnections[i].promote()); 2904c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (connection != 0) { 2914c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella result.appendFormat("Connection Number: %d \n", i); 2924c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella connection->dump(result); 2934c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 2944c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 295fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 296fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian write(fd, result.string(), result.size()); 297fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian return NO_ERROR; 298fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 299fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 3004342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganeshvoid SensorService::cleanupAutoDisabledSensor(const sp<SensorEventConnection>& connection, 3014342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh sensors_event_t const* buffer, const int count) { 3024c01b1ad80e084f0cd1057f89fdd1fcedf19dd96Jaikumar Ganesh SensorInterface* sensor; 3034c01b1ad80e084f0cd1057f89fdd1fcedf19dd96Jaikumar Ganesh status_t err = NO_ERROR; 3044342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh for (int i=0 ; i<count ; i++) { 3054342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh int handle = buffer[i].sensor; 3067438fd1a0132bc6de101e2a5f75040a119b6f29bMathias Agopian int type = buffer[i].type; 3077438fd1a0132bc6de101e2a5f75040a119b6f29bMathias Agopian if (type == SENSOR_TYPE_SIGNIFICANT_MOTION) { 3084342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh if (connection->hasSensor(handle)) { 3094c01b1ad80e084f0cd1057f89fdd1fcedf19dd96Jaikumar Ganesh sensor = mSensorMap.valueFor(handle); 310ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian if (sensor != NULL) { 311ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian sensor->autoDisable(connection.get(), handle); 3124c01b1ad80e084f0cd1057f89fdd1fcedf19dd96Jaikumar Ganesh } 3134342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh cleanupWithoutDisable(connection, handle); 3144342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } 3154342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } 3164342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } 3174342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh} 3184342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh 319fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopianbool SensorService::threadLoop() 320fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 321a551237de142549fb8a6608ee9d2fbf4b7ca2ebfSteve Block ALOGD("nuSensorService thread starting..."); 322fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 32390ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian // each virtual sensor could generate an event per "real" event, that's why we need 32490ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian // to size numEventMax much smaller than MAX_RECEIVE_BUFFER_EVENT_COUNT. 32590ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian // in practice, this is too aggressive, but guaranteed to be enough. 32690ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian const size_t minBufferSize = SensorEventQueue::MAX_RECEIVE_BUFFER_EVENT_COUNT; 32790ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian const size_t numEventMax = minBufferSize / (1 + mVirtualSensorList.size()); 32890ed3e8d7883d9c80fb8bf11b1c593bd8b2b39d0Mathias Agopian 329d1920ffede9e9bc107104ad94c291ca0f0f18bc3Mathias Agopian sensors_event_t buffer[minBufferSize]; 330d1920ffede9e9bc107104ad94c291ca0f0f18bc3Mathias Agopian sensors_event_t scratch[minBufferSize]; 331f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian SensorDevice& device(SensorDevice::getInstance()); 332f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian const size_t vcount = mVirtualSensorList.size(); 333fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 334f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian ssize_t count; 3354342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh bool wakeLockAcquired = false; 3364342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh const int halVersion = device.getHalDeviceVersion(); 337fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian do { 338f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian count = device.poll(buffer, numEventMax); 339fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian if (count<0) { 340f5a1230d322c14c42331d0a1536b50c87742973bSteve Block ALOGE("sensor poll failed (%s)", strerror(-count)); 341fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian break; 342fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 343fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 3444342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // Poll has returned. Hold a wakelock. 3454342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // Todo(): add a flag to the sensors definitions to indicate 3464342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // the sensors which can wake up the AP 3474342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh for (int i = 0; i < count; i++) { 3487438fd1a0132bc6de101e2a5f75040a119b6f29bMathias Agopian if (buffer[i].type == SENSOR_TYPE_SIGNIFICANT_MOTION) { 3494342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh acquire_wake_lock(PARTIAL_WAKE_LOCK, WAKE_LOCK_NAME); 3504342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh wakeLockAcquired = true; 3514342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh break; 3524342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } 3534342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } 3544342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh 35594e8f6813f3fb2beaa9bcbfb1ad9b4ae2eb46949Mathias Agopian recordLastValue(buffer, count); 35694e8f6813f3fb2beaa9bcbfb1ad9b4ae2eb46949Mathias Agopian 357f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian // handle virtual sensors 358f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian if (count && vcount) { 359984826cc158193e61e3a00359ef4f6699c7d748aMathias Agopian sensors_event_t const * const event = buffer; 360f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian const DefaultKeyedVector<int, SensorInterface*> virtualSensors( 361f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian getActiveVirtualSensors()); 362f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian const size_t activeVirtualSensorCount = virtualSensors.size(); 363f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian if (activeVirtualSensorCount) { 364f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian size_t k = 0; 365984826cc158193e61e3a00359ef4f6699c7d748aMathias Agopian SensorFusion& fusion(SensorFusion::getInstance()); 366984826cc158193e61e3a00359ef4f6699c7d748aMathias Agopian if (fusion.isEnabled()) { 367984826cc158193e61e3a00359ef4f6699c7d748aMathias Agopian for (size_t i=0 ; i<size_t(count) ; i++) { 368984826cc158193e61e3a00359ef4f6699c7d748aMathias Agopian fusion.process(event[i]); 369984826cc158193e61e3a00359ef4f6699c7d748aMathias Agopian } 370984826cc158193e61e3a00359ef4f6699c7d748aMathias Agopian } 371d1920ffede9e9bc107104ad94c291ca0f0f18bc3Mathias Agopian for (size_t i=0 ; i<size_t(count) && k<minBufferSize ; i++) { 372f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian for (size_t j=0 ; j<activeVirtualSensorCount ; j++) { 373d1920ffede9e9bc107104ad94c291ca0f0f18bc3Mathias Agopian if (count + k >= minBufferSize) { 374d1920ffede9e9bc107104ad94c291ca0f0f18bc3Mathias Agopian ALOGE("buffer too small to hold all events: " 375d1920ffede9e9bc107104ad94c291ca0f0f18bc3Mathias Agopian "count=%u, k=%u, size=%u", 376d1920ffede9e9bc107104ad94c291ca0f0f18bc3Mathias Agopian count, k, minBufferSize); 377d1920ffede9e9bc107104ad94c291ca0f0f18bc3Mathias Agopian break; 378d1920ffede9e9bc107104ad94c291ca0f0f18bc3Mathias Agopian } 379f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian sensors_event_t out; 380d1920ffede9e9bc107104ad94c291ca0f0f18bc3Mathias Agopian SensorInterface* si = virtualSensors.valueAt(j); 381d1920ffede9e9bc107104ad94c291ca0f0f18bc3Mathias Agopian if (si->process(&out, event[i])) { 382f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian buffer[count + k] = out; 383f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian k++; 384f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian } 385f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian } 386f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian } 387f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian if (k) { 388f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian // record the last synthesized values 389f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian recordLastValue(&buffer[count], k); 390f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian count += k; 391f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian // sort the buffer by time-stamps 392f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian sortEventBuffer(buffer, count); 393f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian } 394f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian } 395f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian } 396f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian 3974342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // handle backward compatibility for RotationVector sensor 3984342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh if (halVersion < SENSORS_DEVICE_API_VERSION_1_0) { 3994342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh for (int i = 0; i < count; i++) { 4007438fd1a0132bc6de101e2a5f75040a119b6f29bMathias Agopian if (buffer[i].type == SENSOR_TYPE_ROTATION_VECTOR) { 4014342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // All the 4 components of the quaternion should be available 4024342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // No heading accuracy. Set it to -1 4034342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh buffer[i].data[4] = -1; 4044342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } 4054342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } 4064342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } 4074342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh 408f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian // send our events to clients... 409fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian const SortedVector< wp<SensorEventConnection> > activeConnections( 410fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian getActiveConnections()); 411fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian size_t numConnections = activeConnections.size(); 412f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian for (size_t i=0 ; i<numConnections ; i++) { 413f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian sp<SensorEventConnection> connection( 414f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian activeConnections[i].promote()); 415f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian if (connection != 0) { 416f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian connection->sendEvents(buffer, count, scratch); 4174342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // Some sensors need to be auto disabled after the trigger 4184342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh cleanupAutoDisabledSensor(connection, buffer, count); 419fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 420fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 4214342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh 4224342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // We have read the data, upper layers should hold the wakelock. 4234342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh if (wakeLockAcquired) release_wake_lock(WAKE_LOCK_NAME); 424fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } while (count >= 0 || Thread::exitPending()); 425fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 4263c20fbed7f3a916ced10f2ed5a272271b7d81edeSteve Block ALOGW("Exiting SensorService::threadLoop => aborting..."); 4271a62301fc58cd2af18239b0415813461bf5fc41bMathias Agopian abort(); 428fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian return false; 429fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 430fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 43194e8f6813f3fb2beaa9bcbfb1ad9b4ae2eb46949Mathias Agopianvoid SensorService::recordLastValue( 4324b84704b97300eff3ebfab85652e64d54149d205Aravind Akella const sensors_event_t* buffer, size_t count) { 43394e8f6813f3fb2beaa9bcbfb1ad9b4ae2eb46949Mathias Agopian Mutex::Autolock _l(mLock); 4344b84704b97300eff3ebfab85652e64d54149d205Aravind Akella const sensors_event_t* last = NULL; 4354b84704b97300eff3ebfab85652e64d54149d205Aravind Akella for (size_t i = 0; i < count; i++) { 4364b84704b97300eff3ebfab85652e64d54149d205Aravind Akella const sensors_event_t* event = &buffer[i]; 4374b84704b97300eff3ebfab85652e64d54149d205Aravind Akella if (event->type != SENSOR_TYPE_META_DATA) { 4384b84704b97300eff3ebfab85652e64d54149d205Aravind Akella if (last && event->sensor != last->sensor) { 4394b84704b97300eff3ebfab85652e64d54149d205Aravind Akella mLastEventSeen.editValueFor(last->sensor) = *last; 4404b84704b97300eff3ebfab85652e64d54149d205Aravind Akella } 4414b84704b97300eff3ebfab85652e64d54149d205Aravind Akella last = event; 44294e8f6813f3fb2beaa9bcbfb1ad9b4ae2eb46949Mathias Agopian } 44394e8f6813f3fb2beaa9bcbfb1ad9b4ae2eb46949Mathias Agopian } 4444b84704b97300eff3ebfab85652e64d54149d205Aravind Akella if (last) { 4454b84704b97300eff3ebfab85652e64d54149d205Aravind Akella mLastEventSeen.editValueFor(last->sensor) = *last; 4464b84704b97300eff3ebfab85652e64d54149d205Aravind Akella } 44794e8f6813f3fb2beaa9bcbfb1ad9b4ae2eb46949Mathias Agopian} 44894e8f6813f3fb2beaa9bcbfb1ad9b4ae2eb46949Mathias Agopian 449f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopianvoid SensorService::sortEventBuffer(sensors_event_t* buffer, size_t count) 450f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian{ 451f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian struct compar { 452f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian static int cmp(void const* lhs, void const* rhs) { 453f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian sensors_event_t const* l = static_cast<sensors_event_t const*>(lhs); 454f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian sensors_event_t const* r = static_cast<sensors_event_t const*>(rhs); 455a5c106a4f0afcf061728a1cb7c8c3b908728575dMathias Agopian return l->timestamp - r->timestamp; 456f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian } 457f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian }; 458f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian qsort(buffer, count, sizeof(sensors_event_t), compar::cmp); 459f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian} 460f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian 461fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias AgopianSortedVector< wp<SensorService::SensorEventConnection> > 462fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias AgopianSensorService::getActiveConnections() const 463fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 464fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian Mutex::Autolock _l(mLock); 465fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian return mActiveConnections; 466fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 467fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 468f001c92436b4a66eb7687286325ced7f10c9f917Mathias AgopianDefaultKeyedVector<int, SensorInterface*> 469f001c92436b4a66eb7687286325ced7f10c9f917Mathias AgopianSensorService::getActiveVirtualSensors() const 470f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian{ 471f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian Mutex::Autolock _l(mLock); 472f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian return mActiveVirtualSensors; 473f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian} 474f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian 4755d2707214dfb97bd8dfcc6620be36841d3c82420Mathias AgopianString8 SensorService::getSensorName(int handle) const { 476010e42230135815907e76e5d7e5f30edf9e1799dMathias Agopian size_t count = mUserSensorList.size(); 4775d2707214dfb97bd8dfcc6620be36841d3c82420Mathias Agopian for (size_t i=0 ; i<count ; i++) { 478010e42230135815907e76e5d7e5f30edf9e1799dMathias Agopian const Sensor& sensor(mUserSensorList[i]); 4795d2707214dfb97bd8dfcc6620be36841d3c82420Mathias Agopian if (sensor.getHandle() == handle) { 4805d2707214dfb97bd8dfcc6620be36841d3c82420Mathias Agopian return sensor.getName(); 4815d2707214dfb97bd8dfcc6620be36841d3c82420Mathias Agopian } 4825d2707214dfb97bd8dfcc6620be36841d3c82420Mathias Agopian } 4835d2707214dfb97bd8dfcc6620be36841d3c82420Mathias Agopian String8 result("unknown"); 4845d2707214dfb97bd8dfcc6620be36841d3c82420Mathias Agopian return result; 4855d2707214dfb97bd8dfcc6620be36841d3c82420Mathias Agopian} 4865d2707214dfb97bd8dfcc6620be36841d3c82420Mathias Agopian 487b4099e77ec2bf8e9d4259ff30f0cb1d621deed91Aravind Akellabool SensorService::isVirtualSensor(int handle) const { 488b4099e77ec2bf8e9d4259ff30f0cb1d621deed91Aravind Akella SensorInterface* sensor = mSensorMap.valueFor(handle); 489b4099e77ec2bf8e9d4259ff30f0cb1d621deed91Aravind Akella return sensor->isVirtual(); 490b4099e77ec2bf8e9d4259ff30f0cb1d621deed91Aravind Akella} 491b4099e77ec2bf8e9d4259ff30f0cb1d621deed91Aravind Akella 492fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias AgopianVector<Sensor> SensorService::getSensorList() 493fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 49433264868ba0aaccb9d4b5e5a067a79a43633f6ecMathias Agopian char value[PROPERTY_VALUE_MAX]; 49533264868ba0aaccb9d4b5e5a067a79a43633f6ecMathias Agopian property_get("debug.sensors", value, "0"); 496700180487ffec09d9df1657b018a7caadac24b75Aravind Akella const Vector<Sensor>& initialSensorList = (atoi(value)) ? 497700180487ffec09d9df1657b018a7caadac24b75Aravind Akella mUserSensorListDebug : mUserSensorList; 498700180487ffec09d9df1657b018a7caadac24b75Aravind Akella Vector<Sensor> accessibleSensorList; 499700180487ffec09d9df1657b018a7caadac24b75Aravind Akella for (size_t i = 0; i < initialSensorList.size(); i++) { 500700180487ffec09d9df1657b018a7caadac24b75Aravind Akella Sensor sensor = initialSensorList[i]; 501700180487ffec09d9df1657b018a7caadac24b75Aravind Akella if (canAccessSensor(sensor)) { 502700180487ffec09d9df1657b018a7caadac24b75Aravind Akella accessibleSensorList.add(sensor); 503700180487ffec09d9df1657b018a7caadac24b75Aravind Akella } else { 504700180487ffec09d9df1657b018a7caadac24b75Aravind Akella String8 infoMessage; 505700180487ffec09d9df1657b018a7caadac24b75Aravind Akella infoMessage.appendFormat( 506700180487ffec09d9df1657b018a7caadac24b75Aravind Akella "Skipped sensor %s because it requires permission %s", 507700180487ffec09d9df1657b018a7caadac24b75Aravind Akella sensor.getName().string(), 508700180487ffec09d9df1657b018a7caadac24b75Aravind Akella sensor.getRequiredPermission().string()); 509700180487ffec09d9df1657b018a7caadac24b75Aravind Akella ALOGI(infoMessage.string()); 510700180487ffec09d9df1657b018a7caadac24b75Aravind Akella } 51133264868ba0aaccb9d4b5e5a067a79a43633f6ecMathias Agopian } 512700180487ffec09d9df1657b018a7caadac24b75Aravind Akella return accessibleSensorList; 513fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 514fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 515fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopiansp<ISensorEventConnection> SensorService::createSensorEventConnection() 516fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 5175307d17fe33fc26eeeacd6339a9fbfe96cf56873Mathias Agopian uid_t uid = IPCThreadState::self()->getCallingUid(); 5185307d17fe33fc26eeeacd6339a9fbfe96cf56873Mathias Agopian sp<SensorEventConnection> result(new SensorEventConnection(this, uid)); 519fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian return result; 520fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 521fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 522db5b4bce9e65ec9c2c7762b601297e4abadbc22aMathias Agopianvoid SensorService::cleanupConnection(SensorEventConnection* c) 523fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 524fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian Mutex::Autolock _l(mLock); 525db5b4bce9e65ec9c2c7762b601297e4abadbc22aMathias Agopian const wp<SensorEventConnection> connection(c); 5267c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian size_t size = mActiveSensors.size(); 527a551237de142549fb8a6608ee9d2fbf4b7ca2ebfSteve Block ALOGD_IF(DEBUG_CONNECTIONS, "%d active sensors", size); 5287c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian for (size_t i=0 ; i<size ; ) { 529db5b4bce9e65ec9c2c7762b601297e4abadbc22aMathias Agopian int handle = mActiveSensors.keyAt(i); 530db5b4bce9e65ec9c2c7762b601297e4abadbc22aMathias Agopian if (c->hasSensor(handle)) { 531a551237de142549fb8a6608ee9d2fbf4b7ca2ebfSteve Block ALOGD_IF(DEBUG_CONNECTIONS, "%i: disabling handle=0x%08x", i, handle); 532f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian SensorInterface* sensor = mSensorMap.valueFor( handle ); 533f5a1230d322c14c42331d0a1536b50c87742973bSteve Block ALOGE_IF(!sensor, "mSensorMap[handle=0x%08x] is null!", handle); 534f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian if (sensor) { 535db5b4bce9e65ec9c2c7762b601297e4abadbc22aMathias Agopian sensor->activate(c, false); 536f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian } 537db5b4bce9e65ec9c2c7762b601297e4abadbc22aMathias Agopian } 538db5b4bce9e65ec9c2c7762b601297e4abadbc22aMathias Agopian SensorRecord* rec = mActiveSensors.valueAt(i); 539f5a1230d322c14c42331d0a1536b50c87742973bSteve Block ALOGE_IF(!rec, "mActiveSensors[%d] is null (handle=0x%08x)!", i, handle); 540a551237de142549fb8a6608ee9d2fbf4b7ca2ebfSteve Block ALOGD_IF(DEBUG_CONNECTIONS, 541a1b7db95b6ccf5be9d8dfaac1b8f45494813edc0Mathias Agopian "removing connection %p for sensor[%d].handle=0x%08x", 542a1b7db95b6ccf5be9d8dfaac1b8f45494813edc0Mathias Agopian c, i, handle); 543a1b7db95b6ccf5be9d8dfaac1b8f45494813edc0Mathias Agopian 544db5b4bce9e65ec9c2c7762b601297e4abadbc22aMathias Agopian if (rec && rec->removeConnection(connection)) { 545a551237de142549fb8a6608ee9d2fbf4b7ca2ebfSteve Block ALOGD_IF(DEBUG_CONNECTIONS, "... and it was the last connection"); 5467c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian mActiveSensors.removeItemsAt(i, 1); 547f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian mActiveVirtualSensors.removeItem(handle); 5487c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian delete rec; 5497c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian size--; 5507c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian } else { 5517c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian i++; 552fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 553fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 5547c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian mActiveConnections.remove(connection); 555787ac1b388f144f5e6dd38f8b807866a5256dafcMathias Agopian BatteryService::cleanup(c->getUid()); 556fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 557fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 558700180487ffec09d9df1657b018a7caadac24b75Aravind AkellaSensor SensorService::getSensorFromHandle(int handle) const { 559700180487ffec09d9df1657b018a7caadac24b75Aravind Akella return mSensorMap.valueFor(handle)->getSensor(); 560700180487ffec09d9df1657b018a7caadac24b75Aravind Akella} 561700180487ffec09d9df1657b018a7caadac24b75Aravind Akella 562fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopianstatus_t SensorService::enable(const sp<SensorEventConnection>& connection, 563724d91d778e71c8186399f4955de14b54812b3edAravind Akella int handle, nsecs_t samplingPeriodNs, nsecs_t maxBatchReportLatencyNs, int reservedFlags) 564fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 56550df2959e58fc7408f98d11d77c8428397dca445Mathias Agopian if (mInitCheck != NO_ERROR) 56650df2959e58fc7408f98d11d77c8428397dca445Mathias Agopian return mInitCheck; 56750df2959e58fc7408f98d11d77c8428397dca445Mathias Agopian 568f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian SensorInterface* sensor = mSensorMap.valueFor(handle); 569ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian if (sensor == NULL) { 570ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian return BAD_VALUE; 571ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian } 572700180487ffec09d9df1657b018a7caadac24b75Aravind Akella 573700180487ffec09d9df1657b018a7caadac24b75Aravind Akella if (!verifyCanAccessSensor(sensor->getSensor(), "Tried enabling")) { 574700180487ffec09d9df1657b018a7caadac24b75Aravind Akella return BAD_VALUE; 575700180487ffec09d9df1657b018a7caadac24b75Aravind Akella } 576700180487ffec09d9df1657b018a7caadac24b75Aravind Akella 577ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian Mutex::Autolock _l(mLock); 5784342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh SensorRecord* rec = mActiveSensors.valueFor(handle); 5794342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh if (rec == 0) { 5804342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh rec = new SensorRecord(connection); 5814342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh mActiveSensors.add(handle, rec); 5824342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh if (sensor->isVirtual()) { 5834342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh mActiveVirtualSensors.add(handle, sensor); 5843560fb24b668675627934356f210d84d19bf4e56Mathias Agopian } 5854342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } else { 5864342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh if (rec->addConnection(connection)) { 5874342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // this sensor is already activated, but we are adding a 5884342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // connection that uses it. Immediately send down the last 5894342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // known value of the requested sensor if it's not a 5904342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // "continuous" sensor. 5914342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh if (sensor->getSensor().getMinDelay() == 0) { 5924342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh sensors_event_t scratch; 5934342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh sensors_event_t& event(mLastEventSeen.editValueFor(handle)); 5944342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh if (event.version == sizeof(sensors_event_t)) { 5954342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh connection->sendEvents(&event, 1); 596f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian } 5977c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian } 598fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 599fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 6004342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh 6014342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh if (connection->addSensor(handle)) { 6024342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh BatteryService::enableSensor(connection->getUid(), handle); 6034342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // the sensor was added (which means it wasn't already there) 6044342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh // so, see if this connection becomes active 6054342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh if (mActiveConnections.indexOf(connection) < 0) { 6064342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh mActiveConnections.add(connection); 6074342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } 6084342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } else { 6094342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh ALOGW("sensor %08x already enabled in connection %p (ignoring)", 6104342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh handle, connection.get()); 6114342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } 6124342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh 613724d91d778e71c8186399f4955de14b54812b3edAravind Akella nsecs_t minDelayNs = sensor->getSensor().getMinDelayNs(); 614724d91d778e71c8186399f4955de14b54812b3edAravind Akella if (samplingPeriodNs < minDelayNs) { 615724d91d778e71c8186399f4955de14b54812b3edAravind Akella samplingPeriodNs = minDelayNs; 616724d91d778e71c8186399f4955de14b54812b3edAravind Akella } 617724d91d778e71c8186399f4955de14b54812b3edAravind Akella 618724d91d778e71c8186399f4955de14b54812b3edAravind Akella ALOGD_IF(DEBUG_CONNECTIONS, "Calling batch handle==%d flags=%d rate=%lld timeout== %lld", 619724d91d778e71c8186399f4955de14b54812b3edAravind Akella handle, reservedFlags, samplingPeriodNs, maxBatchReportLatencyNs); 620724d91d778e71c8186399f4955de14b54812b3edAravind Akella 621724d91d778e71c8186399f4955de14b54812b3edAravind Akella status_t err = sensor->batch(connection.get(), handle, reservedFlags, samplingPeriodNs, 622724d91d778e71c8186399f4955de14b54812b3edAravind Akella maxBatchReportLatencyNs); 6234c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (err == NO_ERROR) { 6244c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella connection->setFirstFlushPending(handle, true); 6254c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella status_t err_flush = sensor->flush(connection.get(), handle); 6264c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella // Flush may return error if the sensor is not activated or the underlying h/w sensor does 6274c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella // not support flush. 6284c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (err_flush != NO_ERROR) { 6294c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella connection->setFirstFlushPending(handle, false); 6304c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 6314c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 632724d91d778e71c8186399f4955de14b54812b3edAravind Akella 633724d91d778e71c8186399f4955de14b54812b3edAravind Akella if (err == NO_ERROR) { 634724d91d778e71c8186399f4955de14b54812b3edAravind Akella ALOGD_IF(DEBUG_CONNECTIONS, "Calling activate on %d", handle); 635724d91d778e71c8186399f4955de14b54812b3edAravind Akella err = sensor->activate(connection.get(), true); 636724d91d778e71c8186399f4955de14b54812b3edAravind Akella } 637724d91d778e71c8186399f4955de14b54812b3edAravind Akella 6384342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh if (err != NO_ERROR) { 639724d91d778e71c8186399f4955de14b54812b3edAravind Akella // batch/activate has failed, reset our state. 640ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian cleanupWithoutDisableLocked(connection, handle); 6414342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } 642fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian return err; 643fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 644fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 645fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopianstatus_t SensorService::disable(const sp<SensorEventConnection>& connection, 646fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian int handle) 647fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 64850df2959e58fc7408f98d11d77c8428397dca445Mathias Agopian if (mInitCheck != NO_ERROR) 64950df2959e58fc7408f98d11d77c8428397dca445Mathias Agopian return mInitCheck; 65050df2959e58fc7408f98d11d77c8428397dca445Mathias Agopian 651ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian Mutex::Autolock _l(mLock); 652ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian status_t err = cleanupWithoutDisableLocked(connection, handle); 6534342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh if (err == NO_ERROR) { 6544342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh SensorInterface* sensor = mSensorMap.valueFor(handle); 6554342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh err = sensor ? sensor->activate(connection.get(), false) : status_t(BAD_VALUE); 6564342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh } 6574342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh return err; 6584342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh} 6594342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh 660ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopianstatus_t SensorService::cleanupWithoutDisable( 661ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian const sp<SensorEventConnection>& connection, int handle) { 662fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian Mutex::Autolock _l(mLock); 663ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian return cleanupWithoutDisableLocked(connection, handle); 664ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian} 665ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian 666ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopianstatus_t SensorService::cleanupWithoutDisableLocked( 667ac9a96da65f6eae4513654adaad8a457d1c1575cMathias Agopian const sp<SensorEventConnection>& connection, int handle) { 668fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian SensorRecord* rec = mActiveSensors.valueFor(handle); 669fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian if (rec) { 670fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian // see if this connection becomes inactive 671787ac1b388f144f5e6dd38f8b807866a5256dafcMathias Agopian if (connection->removeSensor(handle)) { 672787ac1b388f144f5e6dd38f8b807866a5256dafcMathias Agopian BatteryService::disableSensor(connection->getUid(), handle); 673787ac1b388f144f5e6dd38f8b807866a5256dafcMathias Agopian } 674fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian if (connection->hasAnySensor() == false) { 675fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian mActiveConnections.remove(connection); 676fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 677fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian // see if this sensor becomes inactive 678fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian if (rec->removeConnection(connection)) { 679fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian mActiveSensors.removeItem(handle); 680f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian mActiveVirtualSensors.removeItem(handle); 681fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian delete rec; 682fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 6834342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh return NO_ERROR; 6847c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian } 6854342fdf14ffb792a36c1de25ad14b745df628da2Jaikumar Ganesh return BAD_VALUE; 686fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 687fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 6887c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopianstatus_t SensorService::setEventRate(const sp<SensorEventConnection>& connection, 689fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian int handle, nsecs_t ns) 690fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 69150df2959e58fc7408f98d11d77c8428397dca445Mathias Agopian if (mInitCheck != NO_ERROR) 69250df2959e58fc7408f98d11d77c8428397dca445Mathias Agopian return mInitCheck; 69350df2959e58fc7408f98d11d77c8428397dca445Mathias Agopian 694ae09d65f5b35cb51da2e1386a6dd7a52085f1325Mathias Agopian SensorInterface* sensor = mSensorMap.valueFor(handle); 695ae09d65f5b35cb51da2e1386a6dd7a52085f1325Mathias Agopian if (!sensor) 696ae09d65f5b35cb51da2e1386a6dd7a52085f1325Mathias Agopian return BAD_VALUE; 697ae09d65f5b35cb51da2e1386a6dd7a52085f1325Mathias Agopian 698700180487ffec09d9df1657b018a7caadac24b75Aravind Akella if (!verifyCanAccessSensor(sensor->getSensor(), "Tried configuring")) { 699700180487ffec09d9df1657b018a7caadac24b75Aravind Akella return BAD_VALUE; 700700180487ffec09d9df1657b018a7caadac24b75Aravind Akella } 701700180487ffec09d9df1657b018a7caadac24b75Aravind Akella 7021cd700015318727d6d42236ab6274f1949fb08baMathias Agopian if (ns < 0) 7031cd700015318727d6d42236ab6274f1949fb08baMathias Agopian return BAD_VALUE; 7041cd700015318727d6d42236ab6274f1949fb08baMathias Agopian 70562569ecf526c7c01cb68ea461c6bbd3cb26057d2Mathias Agopian nsecs_t minDelayNs = sensor->getSensor().getMinDelayNs(); 70662569ecf526c7c01cb68ea461c6bbd3cb26057d2Mathias Agopian if (ns < minDelayNs) { 70762569ecf526c7c01cb68ea461c6bbd3cb26057d2Mathias Agopian ns = minDelayNs; 708ae09d65f5b35cb51da2e1386a6dd7a52085f1325Mathias Agopian } 709ae09d65f5b35cb51da2e1386a6dd7a52085f1325Mathias Agopian 710f001c92436b4a66eb7687286325ced7f10c9f917Mathias Agopian return sensor->setDelay(connection.get(), handle, ns); 711fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 712fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 713724d91d778e71c8186399f4955de14b54812b3edAravind Akellastatus_t SensorService::flushSensor(const sp<SensorEventConnection>& connection, 714724d91d778e71c8186399f4955de14b54812b3edAravind Akella int handle) { 715700180487ffec09d9df1657b018a7caadac24b75Aravind Akella if (mInitCheck != NO_ERROR) return mInitCheck; 716700180487ffec09d9df1657b018a7caadac24b75Aravind Akella SensorInterface* sensor = mSensorMap.valueFor(handle); 717700180487ffec09d9df1657b018a7caadac24b75Aravind Akella if (sensor == NULL) { 718700180487ffec09d9df1657b018a7caadac24b75Aravind Akella return BAD_VALUE; 719700180487ffec09d9df1657b018a7caadac24b75Aravind Akella } 720700180487ffec09d9df1657b018a7caadac24b75Aravind Akella 721700180487ffec09d9df1657b018a7caadac24b75Aravind Akella if (!verifyCanAccessSensor(sensor->getSensor(), "Tried flushing")) { 722700180487ffec09d9df1657b018a7caadac24b75Aravind Akella return BAD_VALUE; 723700180487ffec09d9df1657b018a7caadac24b75Aravind Akella } 724700180487ffec09d9df1657b018a7caadac24b75Aravind Akella 725700180487ffec09d9df1657b018a7caadac24b75Aravind Akella if (sensor->getSensor().getType() == SENSOR_TYPE_SIGNIFICANT_MOTION) { 726700180487ffec09d9df1657b018a7caadac24b75Aravind Akella ALOGE("flush called on Significant Motion sensor"); 727700180487ffec09d9df1657b018a7caadac24b75Aravind Akella return INVALID_OPERATION; 728700180487ffec09d9df1657b018a7caadac24b75Aravind Akella } 729700180487ffec09d9df1657b018a7caadac24b75Aravind Akella return sensor->flush(connection.get(), handle); 730700180487ffec09d9df1657b018a7caadac24b75Aravind Akella} 731700180487ffec09d9df1657b018a7caadac24b75Aravind Akella 732700180487ffec09d9df1657b018a7caadac24b75Aravind Akella 733700180487ffec09d9df1657b018a7caadac24b75Aravind Akellabool SensorService::canAccessSensor(const Sensor& sensor) { 734700180487ffec09d9df1657b018a7caadac24b75Aravind Akella String16 permissionString(sensor.getRequiredPermission()); 735700180487ffec09d9df1657b018a7caadac24b75Aravind Akella return permissionString.size() == 0 || 736700180487ffec09d9df1657b018a7caadac24b75Aravind Akella PermissionCache::checkCallingPermission(permissionString); 737724d91d778e71c8186399f4955de14b54812b3edAravind Akella} 738700180487ffec09d9df1657b018a7caadac24b75Aravind Akella 739700180487ffec09d9df1657b018a7caadac24b75Aravind Akellabool SensorService::verifyCanAccessSensor(const Sensor& sensor, const char* operation) { 740700180487ffec09d9df1657b018a7caadac24b75Aravind Akella if (canAccessSensor(sensor)) { 741700180487ffec09d9df1657b018a7caadac24b75Aravind Akella return true; 742700180487ffec09d9df1657b018a7caadac24b75Aravind Akella } else { 743700180487ffec09d9df1657b018a7caadac24b75Aravind Akella String8 errorMessage; 744700180487ffec09d9df1657b018a7caadac24b75Aravind Akella errorMessage.appendFormat( 745700180487ffec09d9df1657b018a7caadac24b75Aravind Akella "%s a sensor (%s) without holding its required permission: %s", 746700180487ffec09d9df1657b018a7caadac24b75Aravind Akella operation, 747700180487ffec09d9df1657b018a7caadac24b75Aravind Akella sensor.getName().string(), 748700180487ffec09d9df1657b018a7caadac24b75Aravind Akella sensor.getRequiredPermission().string()); 749700180487ffec09d9df1657b018a7caadac24b75Aravind Akella return false; 750700180487ffec09d9df1657b018a7caadac24b75Aravind Akella } 751700180487ffec09d9df1657b018a7caadac24b75Aravind Akella} 752700180487ffec09d9df1657b018a7caadac24b75Aravind Akella 753fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian// --------------------------------------------------------------------------- 754fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 755fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias AgopianSensorService::SensorRecord::SensorRecord( 756fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian const sp<SensorEventConnection>& connection) 757fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 758fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian mConnections.add(connection); 759fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 760fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 7617c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopianbool SensorService::SensorRecord::addConnection( 762fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian const sp<SensorEventConnection>& connection) 763fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 764fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian if (mConnections.indexOf(connection) < 0) { 765fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian mConnections.add(connection); 7667c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian return true; 767fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 7687c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian return false; 769fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 770fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 771fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopianbool SensorService::SensorRecord::removeConnection( 772fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian const wp<SensorEventConnection>& connection) 773fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 774fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian ssize_t index = mConnections.indexOf(connection); 775fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian if (index >= 0) { 776fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian mConnections.removeItemsAt(index, 1); 777fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 778fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian return mConnections.size() ? false : true; 779fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 780fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 781fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian// --------------------------------------------------------------------------- 782fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 783fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias AgopianSensorService::SensorEventConnection::SensorEventConnection( 7845307d17fe33fc26eeeacd6339a9fbfe96cf56873Mathias Agopian const sp<SensorService>& service, uid_t uid) 7854c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella : mService(service), mUid(uid) 786fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 7874c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella const SensorDevice& device(SensorDevice::getInstance()); 7884c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (device.getHalDeviceVersion() >= SENSORS_DEVICE_API_VERSION_1_1) { 7894c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella // Increase socket buffer size to 1MB for batching capabilities. 7904c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella mChannel = new BitTube(service->mSocketBufferSize); 7914c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } else { 7924c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella mChannel = new BitTube(SOCKET_BUFFER_SIZE_NON_BATCHED); 7934c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 794fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 795fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 796fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias AgopianSensorService::SensorEventConnection::~SensorEventConnection() 797fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 798a551237de142549fb8a6608ee9d2fbf4b7ca2ebfSteve Block ALOGD_IF(DEBUG_CONNECTIONS, "~SensorEventConnection(%p)", this); 799fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian mService->cleanupConnection(this); 800fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 801fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 802fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopianvoid SensorService::SensorEventConnection::onFirstRef() 803fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 804fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 805fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 8064c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akellavoid SensorService::SensorEventConnection::dump(String8& result) { 8074c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella Mutex::Autolock _l(mConnectionLock); 8084c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella for (size_t i = 0; i < mSensorInfo.size(); ++i) { 8094c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella const FlushInfo& flushInfo = mSensorInfo.valueAt(i); 8104c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella result.appendFormat("\t %s | status: %s | pending flush events %d\n", 8114c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella mService->getSensorName(mSensorInfo.keyAt(i)).string(), 8124c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella flushInfo.mFirstFlushPending ? "First flush pending" : 8134c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella "active", 8144c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella flushInfo.mPendingFlushEventsToSend); 8154c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 8164c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella} 8174c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella 8187c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopianbool SensorService::SensorEventConnection::addSensor(int32_t handle) { 81971d7a5c289c6ef6b5fc86dd4784a075ca6470e38Mathias Agopian Mutex::Autolock _l(mConnectionLock); 820700180487ffec09d9df1657b018a7caadac24b75Aravind Akella if (!verifyCanAccessSensor(mService->getSensorFromHandle(handle), "Tried adding")) { 821700180487ffec09d9df1657b018a7caadac24b75Aravind Akella return false; 822700180487ffec09d9df1657b018a7caadac24b75Aravind Akella } 8234c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (mSensorInfo.indexOfKey(handle) < 0) { 8244c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella mSensorInfo.add(handle, FlushInfo()); 8257c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian return true; 826fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 8277c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian return false; 828fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 829fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 8307c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopianbool SensorService::SensorEventConnection::removeSensor(int32_t handle) { 83171d7a5c289c6ef6b5fc86dd4784a075ca6470e38Mathias Agopian Mutex::Autolock _l(mConnectionLock); 8324c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (mSensorInfo.removeItem(handle) >= 0) { 8337c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian return true; 8347c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian } 8357c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian return false; 836fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 837fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 838fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopianbool SensorService::SensorEventConnection::hasSensor(int32_t handle) const { 83971d7a5c289c6ef6b5fc86dd4784a075ca6470e38Mathias Agopian Mutex::Autolock _l(mConnectionLock); 8404c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella return mSensorInfo.indexOfKey(handle) >= 0; 841fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 842fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 843fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopianbool SensorService::SensorEventConnection::hasAnySensor() const { 84471d7a5c289c6ef6b5fc86dd4784a075ca6470e38Mathias Agopian Mutex::Autolock _l(mConnectionLock); 8457c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian return mSensorInfo.size() ? true : false; 8467c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian} 8477c1c531872a95051cb11ec829e3daf890d9bb58aMathias Agopian 8484c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akellavoid SensorService::SensorEventConnection::setFirstFlushPending(int32_t handle, 8494c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella bool value) { 8504c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella Mutex::Autolock _l(mConnectionLock); 8514c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella ssize_t index = mSensorInfo.indexOfKey(handle); 8524c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (index >= 0) { 8534c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella FlushInfo& flushInfo = mSensorInfo.editValueAt(index); 8544c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella flushInfo.mFirstFlushPending = value; 8554c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 8564c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella} 8574c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella 858fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopianstatus_t SensorService::SensorEventConnection::sendEvents( 859cf51001dbf28e9885fcacd4048902f1c75768fe9Mathias Agopian sensors_event_t const* buffer, size_t numEvents, 860cf51001dbf28e9885fcacd4048902f1c75768fe9Mathias Agopian sensors_event_t* scratch) 861fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 862cf51001dbf28e9885fcacd4048902f1c75768fe9Mathias Agopian // filter out events not for this connection 8633560fb24b668675627934356f210d84d19bf4e56Mathias Agopian size_t count = 0; 8644c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella 8653560fb24b668675627934356f210d84d19bf4e56Mathias Agopian if (scratch) { 86671d7a5c289c6ef6b5fc86dd4784a075ca6470e38Mathias Agopian Mutex::Autolock _l(mConnectionLock); 8673560fb24b668675627934356f210d84d19bf4e56Mathias Agopian size_t i=0; 8683560fb24b668675627934356f210d84d19bf4e56Mathias Agopian while (i<numEvents) { 869724d91d778e71c8186399f4955de14b54812b3edAravind Akella int32_t curr = buffer[i].sensor; 870724d91d778e71c8186399f4955de14b54812b3edAravind Akella if (buffer[i].type == SENSOR_TYPE_META_DATA) { 871724d91d778e71c8186399f4955de14b54812b3edAravind Akella ALOGD_IF(DEBUG_CONNECTIONS, "flush complete event sensor==%d ", 872724d91d778e71c8186399f4955de14b54812b3edAravind Akella buffer[i].meta_data.sensor); 873724d91d778e71c8186399f4955de14b54812b3edAravind Akella // Setting curr to the correct sensor to ensure the sensor events per connection are 874724d91d778e71c8186399f4955de14b54812b3edAravind Akella // filtered correctly. buffer[i].sensor is zero for meta_data events. 875724d91d778e71c8186399f4955de14b54812b3edAravind Akella curr = buffer[i].meta_data.sensor; 876724d91d778e71c8186399f4955de14b54812b3edAravind Akella } 8774c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella ssize_t index = mSensorInfo.indexOfKey(curr); 8784c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (index >= 0 && mSensorInfo[index].mFirstFlushPending == true && 8794c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella buffer[i].type == SENSOR_TYPE_META_DATA) { 8804c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella // This is the first flush before activate is called. Events can now be sent for 8814c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella // this sensor on this connection. 8824c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella ALOGD_IF(DEBUG_CONNECTIONS, "First flush event for sensor==%d ", 8834c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella buffer[i].meta_data.sensor); 8844c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella mSensorInfo.editValueAt(index).mFirstFlushPending = false; 8854c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 8864c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (index >= 0 && mSensorInfo[index].mFirstFlushPending == false) { 8873560fb24b668675627934356f210d84d19bf4e56Mathias Agopian do { 8884c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella scratch[count++] = buffer[i++]; 889724d91d778e71c8186399f4955de14b54812b3edAravind Akella } while ((i<numEvents) && ((buffer[i].sensor == curr) || 890724d91d778e71c8186399f4955de14b54812b3edAravind Akella (buffer[i].type == SENSOR_TYPE_META_DATA && 891724d91d778e71c8186399f4955de14b54812b3edAravind Akella buffer[i].meta_data.sensor == curr))); 8923560fb24b668675627934356f210d84d19bf4e56Mathias Agopian } else { 8933560fb24b668675627934356f210d84d19bf4e56Mathias Agopian i++; 8943560fb24b668675627934356f210d84d19bf4e56Mathias Agopian } 895cf51001dbf28e9885fcacd4048902f1c75768fe9Mathias Agopian } 8963560fb24b668675627934356f210d84d19bf4e56Mathias Agopian } else { 8973560fb24b668675627934356f210d84d19bf4e56Mathias Agopian scratch = const_cast<sensors_event_t *>(buffer); 8983560fb24b668675627934356f210d84d19bf4e56Mathias Agopian count = numEvents; 899cf51001dbf28e9885fcacd4048902f1c75768fe9Mathias Agopian } 900fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 9014c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella // Send pending flush events (if any) before sending events from the cache. 9024c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella { 9034c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella ASensorEvent flushCompleteEvent; 9044c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella flushCompleteEvent.type = SENSOR_TYPE_META_DATA; 9054c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella flushCompleteEvent.sensor = 0; 9064c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella Mutex::Autolock _l(mConnectionLock); 9074c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella // Loop through all the sensors for this connection and check if there are any pending 9084c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella // flush complete events to be sent. 9094c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella for (size_t i = 0; i < mSensorInfo.size(); ++i) { 9104c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella FlushInfo& flushInfo = mSensorInfo.editValueAt(i); 9114c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella while (flushInfo.mPendingFlushEventsToSend > 0) { 9124c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella flushCompleteEvent.meta_data.sensor = mSensorInfo.keyAt(i); 9134c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella ssize_t size = SensorEventQueue::write(mChannel, &flushCompleteEvent, 1); 9144c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (size < 0) { 9154c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella // ALOGW("dropping %d events on the floor", count); 916c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella countFlushCompleteEventsLocked(scratch, count); 9174c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella return size; 9184c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 9194c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella ALOGD_IF(DEBUG_CONNECTIONS, "sent dropped flush complete event==%d ", 9204c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella flushCompleteEvent.meta_data.sensor); 9214c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella flushInfo.mPendingFlushEventsToSend--; 9224c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 9234c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 9244c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 9254c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella 926b4099e77ec2bf8e9d4259ff30f0cb1d621deed91Aravind Akella // Early return if there are no events for this connection. 927b4099e77ec2bf8e9d4259ff30f0cb1d621deed91Aravind Akella if (count == 0) { 928b4099e77ec2bf8e9d4259ff30f0cb1d621deed91Aravind Akella return status_t(NO_ERROR); 929b4099e77ec2bf8e9d4259ff30f0cb1d621deed91Aravind Akella } 930b4099e77ec2bf8e9d4259ff30f0cb1d621deed91Aravind Akella 931907103bf186cfdd2ed9eb3b6c36de53ade7b16f6Mathias Agopian // NOTE: ASensorEvent and sensors_event_t are the same type 932907103bf186cfdd2ed9eb3b6c36de53ade7b16f6Mathias Agopian ssize_t size = SensorEventQueue::write(mChannel, 933907103bf186cfdd2ed9eb3b6c36de53ade7b16f6Mathias Agopian reinterpret_cast<ASensorEvent const*>(scratch), count); 934fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian if (size == -EAGAIN) { 935fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian // the destination doesn't accept events anymore, it's probably 936fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian // full. For now, we just drop the events on the floor. 9374c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella // ALOGW("dropping %d events on the floor", count); 938c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella Mutex::Autolock _l(mConnectionLock); 939c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella countFlushCompleteEventsLocked(scratch, count); 940fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian return size; 941fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 942fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 9431e0b1e8491e5f6dc59faabe70cbfa942853150e0Jeff Brown return size < 0 ? status_t(size) : status_t(NO_ERROR); 944fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 945fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 946c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akellavoid SensorService::SensorEventConnection::countFlushCompleteEventsLocked( 9474c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella sensors_event_t* scratch, const int numEventsDropped) { 9484c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella ALOGD_IF(DEBUG_CONNECTIONS, "dropping %d events ", numEventsDropped); 9494c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella // Count flushComplete events in the events that are about to the dropped. These will be sent 9504c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella // separately before the next batch of events. 9514c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella for (int j = 0; j < numEventsDropped; ++j) { 9524c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella if (scratch[j].type == SENSOR_TYPE_META_DATA) { 9534c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella FlushInfo& flushInfo = mSensorInfo.editValueFor(scratch[j].meta_data.sensor); 9544c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella flushInfo.mPendingFlushEventsToSend++; 9554c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella ALOGD_IF(DEBUG_CONNECTIONS, "increment pendingFlushCount %d", 9564c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella flushInfo.mPendingFlushEventsToSend); 9574c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 9584c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella } 9594c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella return; 9604c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella} 9614c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella 962b3989276d17f2b083bec67b695d1078fb86c6c53Mathias Agopiansp<BitTube> SensorService::SensorEventConnection::getSensorChannel() const 963fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 964fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian return mChannel; 965fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 966fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 967fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopianstatus_t SensorService::SensorEventConnection::enableDisable( 968724d91d778e71c8186399f4955de14b54812b3edAravind Akella int handle, bool enabled, nsecs_t samplingPeriodNs, nsecs_t maxBatchReportLatencyNs, 969724d91d778e71c8186399f4955de14b54812b3edAravind Akella int reservedFlags) 970fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 971fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian status_t err; 972fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian if (enabled) { 973724d91d778e71c8186399f4955de14b54812b3edAravind Akella err = mService->enable(this, handle, samplingPeriodNs, maxBatchReportLatencyNs, 974724d91d778e71c8186399f4955de14b54812b3edAravind Akella reservedFlags); 975fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } else { 976fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian err = mService->disable(this, handle); 977fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian } 978fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian return err; 979fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 980fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 981fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopianstatus_t SensorService::SensorEventConnection::setEventRate( 982724d91d778e71c8186399f4955de14b54812b3edAravind Akella int handle, nsecs_t samplingPeriodNs) 983fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian{ 984724d91d778e71c8186399f4955de14b54812b3edAravind Akella return mService->setEventRate(this, handle, samplingPeriodNs); 985fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian} 986fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 987701166d9f60a6e1149ff568aec0e03f3f3925292Aravind Akellastatus_t SensorService::SensorEventConnection::flush() { 988c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella SensorDevice& dev(SensorDevice::getInstance()); 989c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella const int halVersion = dev.getHalDeviceVersion(); 990701166d9f60a6e1149ff568aec0e03f3f3925292Aravind Akella Mutex::Autolock _l(mConnectionLock); 991701166d9f60a6e1149ff568aec0e03f3f3925292Aravind Akella status_t err(NO_ERROR); 992c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella // Loop through all sensors for this connection and call flush on each of them. 993701166d9f60a6e1149ff568aec0e03f3f3925292Aravind Akella for (size_t i = 0; i < mSensorInfo.size(); ++i) { 994701166d9f60a6e1149ff568aec0e03f3f3925292Aravind Akella const int handle = mSensorInfo.keyAt(i); 995b4099e77ec2bf8e9d4259ff30f0cb1d621deed91Aravind Akella if (halVersion < SENSORS_DEVICE_API_VERSION_1_1 || mService->isVirtualSensor(handle)) { 996c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella // For older devices just increment pending flush count which will send a trivial 997c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella // flush complete event. 998c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella FlushInfo& flushInfo = mSensorInfo.editValueFor(handle); 999c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella flushInfo.mPendingFlushEventsToSend++; 1000c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella } else { 1001c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella status_t err_flush = mService->flushSensor(this, handle); 1002c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella if (err_flush != NO_ERROR) { 1003c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella ALOGE("Flush error handle=%d %s", handle, strerror(-err_flush)); 1004c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella } 1005c551eac5b16a53f872cbb692d3a0c81e39329725Aravind Akella err = (err_flush != NO_ERROR) ? err_flush : err; 1006701166d9f60a6e1149ff568aec0e03f3f3925292Aravind Akella } 1007701166d9f60a6e1149ff568aec0e03f3f3925292Aravind Akella } 1008701166d9f60a6e1149ff568aec0e03f3f3925292Aravind Akella return err; 1009724d91d778e71c8186399f4955de14b54812b3edAravind Akella} 10104c8b951f8d6a121e758bd3905fa8987c77863790Aravind Akella 1011fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian// --------------------------------------------------------------------------- 1012fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian}; // namespace android 1013fc32881fcc68640d008c7515cdd1bcd866f72cd5Mathias Agopian 1014