blob: 319f4d4ff85d090f8e27658bad8fc81211aca840 [file] [log] [blame]
Mathias Agopianfc328812010-07-14 23:41:37 -07001/*
2 * Copyright (C) 2010 The Android Open Source Project
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
Mathias Agopian33015422011-05-27 18:18:13 -070017#include <cutils/properties.h>
18
Svetoslavb412f6e2015-04-29 16:50:41 -070019#include <binder/AppOpsManager.h>
Mathias Agopianfc328812010-07-14 23:41:37 -070020#include <binder/BinderService.h>
Mathias Agopian451beee2010-07-19 15:03:55 -070021#include <binder/IServiceManager.h>
Mathias Agopian1cb13462011-06-27 16:05:52 -070022#include <binder/PermissionCache.h>
Mathias Agopianfc328812010-07-14 23:41:37 -070023
Mathias Agopian907103b2012-04-02 18:38:02 -070024#include <gui/SensorEventQueue.h>
Mathias Agopianfc328812010-07-14 23:41:37 -070025
26#include <hardware/sensors.h>
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -070027#include <hardware_legacy/power.h>
Mathias Agopianfc328812010-07-14 23:41:37 -070028
Greg Kaiser53ca2e02016-06-21 16:11:14 -070029#include <openssl/digest.h>
30#include <openssl/hmac.h>
31#include <openssl/rand.h>
32
Mathias Agopian787ac1b2012-09-18 18:49:18 -070033#include "BatteryService.h"
Mathias Agopian984826c2011-05-17 22:54:42 -070034#include "CorrectedGyroSensor.h"
Mathias Agopianf001c922010-11-11 17:58:51 -080035#include "GravitySensor.h"
36#include "LinearAccelerationSensor.h"
Mathias Agopian984826c2011-05-17 22:54:42 -070037#include "OrientationSensor.h"
Mathias Agopianf001c922010-11-11 17:58:51 -080038#include "RotationVectorSensor.h"
Mathias Agopian984826c2011-05-17 22:54:42 -070039#include "SensorFusion.h"
Peng Xu755c4512016-04-07 23:15:14 -070040#include "SensorInterface.h"
Peng Xueb4d6282015-12-10 18:02:41 -080041
Mathias Agopian984826c2011-05-17 22:54:42 -070042#include "SensorService.h"
Peng Xueb4d6282015-12-10 18:02:41 -080043#include "SensorEventAckReceiver.h"
Peng Xu6a2d3a02015-12-21 12:00:23 -080044#include "SensorEventConnection.h"
Peng Xueb4d6282015-12-10 18:02:41 -080045#include "SensorRecord.h"
46#include "SensorRegistrationInfo.h"
Peng Xueb4d6282015-12-10 18:02:41 -080047
48#include <inttypes.h>
49#include <math.h>
50#include <stdint.h>
Peng Xueb4d6282015-12-10 18:02:41 -080051#include <sys/socket.h>
Greg Kaiser53ca2e02016-06-21 16:11:14 -070052#include <sys/stat.h>
53#include <sys/types.h>
54#include <unistd.h>
Mathias Agopianfc328812010-07-14 23:41:37 -070055
56namespace android {
57// ---------------------------------------------------------------------------
58
Mathias Agopian33015422011-05-27 18:18:13 -070059/*
60 * Notes:
61 *
62 * - what about a gyro-corrected magnetic-field sensor?
Mathias Agopian33015422011-05-27 18:18:13 -070063 * - run mag sensor from time to time to force calibration
64 * - gravity sensor length is wrong (=> drift in linear-acc sensor)
65 *
66 */
67
Aravind Akella8ef3c892015-07-10 11:24:28 -070068const char* SensorService::WAKE_LOCK_NAME = "SensorService_wakelock";
Greg Kaiser53ca2e02016-06-21 16:11:14 -070069uint8_t SensorService::sHmacGlobalKey[128] = {};
70bool SensorService::sHmacGlobalKeyIsValid = false;
71
72#define SENSOR_SERVICE_DIR "/data/system/sensor_service"
73#define SENSOR_SERVICE_HMAC_KEY_FILE SENSOR_SERVICE_DIR "/hmac_key"
74
Aravind Akellaa9e6cc32015-04-16 18:57:31 -070075// Permissions.
Aravind Akellaa9e6cc32015-04-16 18:57:31 -070076static const String16 sDump("android.permission.DUMP");
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -070077
Mathias Agopianfc328812010-07-14 23:41:37 -070078SensorService::SensorService()
Aravind Akella8a969552014-09-28 17:52:41 -070079 : mInitCheck(NO_INIT), mSocketBufferSize(SOCKET_BUFFER_SIZE_NON_BATCHED),
Peng Xu47e96012016-03-28 17:55:56 -070080 mWakeLockAcquired(false) {
Mathias Agopianfc328812010-07-14 23:41:37 -070081}
82
Greg Kaiser53ca2e02016-06-21 16:11:14 -070083bool SensorService::initializeHmacKey() {
84 int fd = open(SENSOR_SERVICE_HMAC_KEY_FILE, O_RDONLY|O_CLOEXEC);
85 if (fd != -1) {
86 int result = read(fd, sHmacGlobalKey, sizeof(sHmacGlobalKey));
87 close(fd);
88 if (result == sizeof(sHmacGlobalKey)) {
89 return true;
90 }
91 ALOGW("Unable to read HMAC key; generating new one.");
92 }
93
94 if (RAND_bytes(sHmacGlobalKey, sizeof(sHmacGlobalKey)) == -1) {
95 ALOGW("Can't generate HMAC key; dynamic sensor getId() will be wrong.");
96 return false;
97 }
98
99 // We need to make sure this is only readable to us.
100 bool wroteKey = false;
101 mkdir(SENSOR_SERVICE_DIR, S_IRWXU);
102 fd = open(SENSOR_SERVICE_HMAC_KEY_FILE, O_WRONLY|O_CREAT|O_EXCL|O_CLOEXEC,
103 S_IRUSR|S_IWUSR);
104 if (fd != -1) {
105 int result = write(fd, sHmacGlobalKey, sizeof(sHmacGlobalKey));
106 close(fd);
107 wroteKey = (result == sizeof(sHmacGlobalKey));
108 }
109 if (wroteKey) {
110 ALOGI("Generated new HMAC key.");
111 } else {
112 ALOGW("Unable to write HMAC key; dynamic sensor getId() will change "
113 "after reboot.");
114 }
115 // Even if we failed to write the key we return true, because we did
116 // initialize the HMAC key.
117 return true;
118}
119
Peng Xu47e96012016-03-28 17:55:56 -0700120void SensorService::onFirstRef() {
Steve Blocka5512372011-12-20 16:23:08 +0000121 ALOGD("nuSensorService starting...");
Mathias Agopianf001c922010-11-11 17:58:51 -0800122 SensorDevice& dev(SensorDevice::getInstance());
Mathias Agopianfc328812010-07-14 23:41:37 -0700123
Greg Kaiser53ca2e02016-06-21 16:11:14 -0700124 sHmacGlobalKeyIsValid = initializeHmacKey();
125
Mathias Agopianf001c922010-11-11 17:58:51 -0800126 if (dev.initCheck() == NO_ERROR) {
Mathias Agopianf001c922010-11-11 17:58:51 -0800127 sensor_t const* list;
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700128 ssize_t count = dev.getSensorList(&list);
129 if (count > 0) {
130 ssize_t orientationIndex = -1;
Aravind Akellaf5047892015-07-20 17:29:33 -0700131 bool hasGyro = false, hasAccel = false, hasMag = false;
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700132 uint32_t virtualSensorsNeeds =
133 (1<<SENSOR_TYPE_GRAVITY) |
134 (1<<SENSOR_TYPE_LINEAR_ACCELERATION) |
Peng Xuf66684a2015-07-23 11:41:53 -0700135 (1<<SENSOR_TYPE_ROTATION_VECTOR) |
136 (1<<SENSOR_TYPE_GEOMAGNETIC_ROTATION_VECTOR) |
137 (1<<SENSOR_TYPE_GAME_ROTATION_VECTOR);
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700138
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700139 for (ssize_t i=0 ; i<count ; i++) {
Peng Xuf66684a2015-07-23 11:41:53 -0700140 bool useThisSensor=true;
141
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700142 switch (list[i].type) {
Aravind Akellaf5047892015-07-20 17:29:33 -0700143 case SENSOR_TYPE_ACCELEROMETER:
144 hasAccel = true;
145 break;
146 case SENSOR_TYPE_MAGNETIC_FIELD:
147 hasMag = true;
148 break;
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700149 case SENSOR_TYPE_ORIENTATION:
150 orientationIndex = i;
151 break;
152 case SENSOR_TYPE_GYROSCOPE:
Mathias Agopian03193062013-05-10 19:32:39 -0700153 case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700154 hasGyro = true;
155 break;
156 case SENSOR_TYPE_GRAVITY:
157 case SENSOR_TYPE_LINEAR_ACCELERATION:
158 case SENSOR_TYPE_ROTATION_VECTOR:
Peng Xuf66684a2015-07-23 11:41:53 -0700159 case SENSOR_TYPE_GEOMAGNETIC_ROTATION_VECTOR:
160 case SENSOR_TYPE_GAME_ROTATION_VECTOR:
161 if (IGNORE_HARDWARE_FUSION) {
162 useThisSensor = false;
163 } else {
164 virtualSensorsNeeds &= ~(1<<list[i].type);
165 }
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700166 break;
167 }
Peng Xuf66684a2015-07-23 11:41:53 -0700168 if (useThisSensor) {
169 registerSensor( new HardwareSensor(list[i]) );
170 }
Mathias Agopian50df2952010-07-19 19:09:10 -0700171 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700172
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700173 // it's safe to instantiate the SensorFusion object here
174 // (it wants to be instantiated after h/w sensors have been
175 // registered)
Andreas Gamped4036b62015-07-28 13:49:04 -0700176 SensorFusion::getInstance();
Mathias Agopian984826c2011-05-17 22:54:42 -0700177
Aravind Akellaf5047892015-07-20 17:29:33 -0700178 if (hasGyro && hasAccel && hasMag) {
Mathias Agopian03193062013-05-10 19:32:39 -0700179 // Add Android virtual sensors if they're not already
180 // available in the HAL
Peng Xu0cc8f802016-04-05 23:46:03 -0700181 bool needRotationVector =
182 (virtualSensorsNeeds & (1<<SENSOR_TYPE_ROTATION_VECTOR)) != 0;
Mathias Agopian03193062013-05-10 19:32:39 -0700183
Peng Xu0cc8f802016-04-05 23:46:03 -0700184 registerSensor(new RotationVectorSensor(), !needRotationVector, true);
185 registerSensor(new OrientationSensor(), !needRotationVector, true);
Mathias Agopian03193062013-05-10 19:32:39 -0700186
Peng Xu0cc8f802016-04-05 23:46:03 -0700187 bool needLinearAcceleration =
188 (virtualSensorsNeeds & (1<<SENSOR_TYPE_LINEAR_ACCELERATION)) != 0;
Mathias Agopian03193062013-05-10 19:32:39 -0700189
Peng Xu0cc8f802016-04-05 23:46:03 -0700190 registerSensor(new LinearAccelerationSensor(list, count),
191 !needLinearAcceleration, true);
Peng Xuf66684a2015-07-23 11:41:53 -0700192
Peng Xu0cc8f802016-04-05 23:46:03 -0700193 // virtual debugging sensors are not for user
Peng Xu755c4512016-04-07 23:15:14 -0700194 registerSensor( new CorrectedGyroSensor(list, count), true, true);
195 registerSensor( new GyroDriftSensor(), true, true);
Mathias Agopian33264862012-06-28 19:46:54 -0700196 }
197
Peng Xuf66684a2015-07-23 11:41:53 -0700198 if (hasAccel && hasGyro) {
Peng Xu0cc8f802016-04-05 23:46:03 -0700199 bool needGravitySensor = (virtualSensorsNeeds & (1<<SENSOR_TYPE_GRAVITY)) != 0;
200 registerSensor(new GravitySensor(list, count), !needGravitySensor, true);
Peng Xuf66684a2015-07-23 11:41:53 -0700201
Peng Xu0cc8f802016-04-05 23:46:03 -0700202 bool needGameRotationVector =
203 (virtualSensorsNeeds & (1<<SENSOR_TYPE_GAME_ROTATION_VECTOR)) != 0;
204 registerSensor(new GameRotationVectorSensor(), !needGameRotationVector, true);
Peng Xuf66684a2015-07-23 11:41:53 -0700205 }
206
207 if (hasAccel && hasMag) {
Peng Xu0cc8f802016-04-05 23:46:03 -0700208 bool needGeoMagRotationVector =
209 (virtualSensorsNeeds & (1<<SENSOR_TYPE_GEOMAGNETIC_ROTATION_VECTOR)) != 0;
210 registerSensor(new GeoMagRotationVectorSensor(), !needGeoMagRotationVector, true);
Peng Xuf66684a2015-07-23 11:41:53 -0700211 }
212
Aravind Akella5466c3d2014-08-22 16:11:10 -0700213 // Check if the device really supports batching by looking at the FIFO event
214 // counts for each sensor.
215 bool batchingSupported = false;
Peng Xu0cc8f802016-04-05 23:46:03 -0700216 mSensors.forEachSensor(
217 [&batchingSupported] (const Sensor& s) -> bool {
218 if (s.getFifoMaxEventCount() > 0) {
219 batchingSupported = true;
220 }
221 return !batchingSupported;
222 });
Aravind Akella5466c3d2014-08-22 16:11:10 -0700223
224 if (batchingSupported) {
225 // Increase socket buffer size to a max of 100 KB for batching capabilities.
226 mSocketBufferSize = MAX_SOCKET_BUFFER_SIZE_BATCHED;
227 } else {
228 mSocketBufferSize = SOCKET_BUFFER_SIZE_NON_BATCHED;
229 }
230
231 // Compare the socketBufferSize value against the system limits and limit
232 // it to maxSystemSocketBufferSize if necessary.
Aravind Akella4c8b9512013-09-05 17:03:38 -0700233 FILE *fp = fopen("/proc/sys/net/core/wmem_max", "r");
234 char line[128];
235 if (fp != NULL && fgets(line, sizeof(line), fp) != NULL) {
236 line[sizeof(line) - 1] = '\0';
Aravind Akella5466c3d2014-08-22 16:11:10 -0700237 size_t maxSystemSocketBufferSize;
238 sscanf(line, "%zu", &maxSystemSocketBufferSize);
239 if (mSocketBufferSize > maxSystemSocketBufferSize) {
240 mSocketBufferSize = maxSystemSocketBufferSize;
Aravind Akella4c8b9512013-09-05 17:03:38 -0700241 }
242 }
Aravind Akella4c8b9512013-09-05 17:03:38 -0700243 if (fp) {
244 fclose(fp);
245 }
246
Aravind Akella9a844cf2014-02-11 18:58:52 -0800247 mWakeLockAcquired = false;
Aravind Akella56ae4262014-07-10 16:01:10 -0700248 mLooper = new Looper(false);
Aravind Akella8493b792014-09-08 15:45:47 -0700249 const size_t minBufferSize = SensorEventQueue::MAX_RECEIVE_BUFFER_EVENT_COUNT;
250 mSensorEventBuffer = new sensors_event_t[minBufferSize];
251 mSensorEventScratch = new sensors_event_t[minBufferSize];
252 mMapFlushEventsToConnections = new SensorEventConnection const * [minBufferSize];
Aravind Akellaa9e6cc32015-04-16 18:57:31 -0700253 mCurrentOperatingMode = NORMAL;
Aravind Akella7830ef32014-10-07 14:13:12 -0700254
Aravind Akella18d6d512015-06-18 14:18:28 -0700255 mNextSensorRegIndex = 0;
256 for (int i = 0; i < SENSOR_REGISTRATIONS_BUF_SIZE; ++i) {
257 mLastNSensorRegistrations.push();
258 }
259
260 mInitCheck = NO_ERROR;
Aravind Akellab4373ac2014-10-29 17:55:20 -0700261 mAckReceiver = new SensorEventAckReceiver(this);
262 mAckReceiver->run("SensorEventAckReceiver", PRIORITY_URGENT_DISPLAY);
Aravind Akella7830ef32014-10-07 14:13:12 -0700263 run("SensorService", PRIORITY_URGENT_DISPLAY);
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700264 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700265 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700266}
267
Peng Xu0cc8f802016-04-05 23:46:03 -0700268const Sensor& SensorService::registerSensor(SensorInterface* s, bool isDebug, bool isVirtual) {
269 int handle = s->getSensor().getHandle();
Peng Xu6a2d3a02015-12-21 12:00:23 -0800270 int type = s->getSensor().getType();
Peng Xu0cc8f802016-04-05 23:46:03 -0700271 if (mSensors.add(handle, s, isDebug, isVirtual)){
Peng Xu6a2d3a02015-12-21 12:00:23 -0800272 mRecentEvent.emplace(handle, new RecentEventLogger(type));
Peng Xu0cc8f802016-04-05 23:46:03 -0700273 return s->getSensor();
274 } else {
275 return mSensors.getNonSensor();
276 }
Mathias Agopianf001c922010-11-11 17:58:51 -0800277}
278
Peng Xu6a2d3a02015-12-21 12:00:23 -0800279const Sensor& SensorService::registerDynamicSensorLocked(SensorInterface* s, bool isDebug) {
Peng Xu0cc8f802016-04-05 23:46:03 -0700280 return registerSensor(s, isDebug);
Peng Xu2576cb62016-01-20 00:22:09 -0800281}
282
Peng Xu6a2d3a02015-12-21 12:00:23 -0800283bool SensorService::unregisterDynamicSensorLocked(int handle) {
Peng Xu0cc8f802016-04-05 23:46:03 -0700284 bool ret = mSensors.remove(handle);
Peng Xu6a2d3a02015-12-21 12:00:23 -0800285
286 const auto i = mRecentEvent.find(handle);
287 if (i != mRecentEvent.end()) {
288 delete i->second;
289 mRecentEvent.erase(i);
Peng Xu2576cb62016-01-20 00:22:09 -0800290 }
Peng Xu0cc8f802016-04-05 23:46:03 -0700291 return ret;
Peng Xu2576cb62016-01-20 00:22:09 -0800292}
293
Peng Xu0cc8f802016-04-05 23:46:03 -0700294const Sensor& SensorService::registerVirtualSensor(SensorInterface* s, bool isDebug) {
295 return registerSensor(s, isDebug, true);
Mathias Agopianfc328812010-07-14 23:41:37 -0700296}
297
Peng Xu47e96012016-03-28 17:55:56 -0700298SensorService::~SensorService() {
Peng Xu6a2d3a02015-12-21 12:00:23 -0800299 for (auto && entry : mRecentEvent) {
300 delete entry.second;
301 }
Peng Xu47e96012016-03-28 17:55:56 -0700302}
303
304status_t SensorService::dump(int fd, const Vector<String16>& args) {
Mathias Agopianfc328812010-07-14 23:41:37 -0700305 String8 result;
Mathias Agopian1cb13462011-06-27 16:05:52 -0700306 if (!PermissionCache::checkCallingPermission(sDump)) {
Peng Xueb4d6282015-12-10 18:02:41 -0800307 result.appendFormat("Permission Denial: can't dump SensorService from pid=%d, uid=%d\n",
Mathias Agopianfc328812010-07-14 23:41:37 -0700308 IPCThreadState::self()->getCallingPid(),
309 IPCThreadState::self()->getCallingUid());
Aravind Akella444f2672015-05-07 12:40:52 -0700310 } else {
Aravind Akella841a5922015-06-29 12:37:48 -0700311 if (args.size() > 2) {
Aravind Akella4949c502015-02-11 15:54:35 -0800312 return INVALID_OPERATION;
313 }
314 Mutex::Autolock _l(mLock);
315 SensorDevice& dev(SensorDevice::getInstance());
Aravind Akella841a5922015-06-29 12:37:48 -0700316 if (args.size() == 2 && args[0] == String16("restrict")) {
Aravind Akella444f2672015-05-07 12:40:52 -0700317 // If already in restricted mode. Ignore.
318 if (mCurrentOperatingMode == RESTRICTED) {
319 return status_t(NO_ERROR);
320 }
321 // If in any mode other than normal, ignore.
322 if (mCurrentOperatingMode != NORMAL) {
323 return INVALID_OPERATION;
324 }
Aravind Akellaa9e6cc32015-04-16 18:57:31 -0700325 mCurrentOperatingMode = RESTRICTED;
Aravind Akella4949c502015-02-11 15:54:35 -0800326 dev.disableAllSensors();
327 // Clear all pending flush connections for all active sensors. If one of the active
328 // connections has called flush() and the underlying sensor has been disabled before a
329 // flush complete event is returned, we need to remove the connection from this queue.
330 for (size_t i=0 ; i< mActiveSensors.size(); ++i) {
331 mActiveSensors.valueAt(i)->clearAllPendingFlushConnections();
332 }
Aravind Akella841a5922015-06-29 12:37:48 -0700333 mWhiteListedPackage.setTo(String8(args[1]));
Aravind Akella444f2672015-05-07 12:40:52 -0700334 return status_t(NO_ERROR);
335 } else if (args.size() == 1 && args[0] == String16("enable")) {
336 // If currently in restricted mode, reset back to NORMAL mode else ignore.
337 if (mCurrentOperatingMode == RESTRICTED) {
338 mCurrentOperatingMode = NORMAL;
339 dev.enableAllSensors();
340 }
Aravind Akella841a5922015-06-29 12:37:48 -0700341 if (mCurrentOperatingMode == DATA_INJECTION) {
342 resetToNormalModeLocked();
343 }
344 mWhiteListedPackage.clear();
Aravind Akella444f2672015-05-07 12:40:52 -0700345 return status_t(NO_ERROR);
Aravind Akella841a5922015-06-29 12:37:48 -0700346 } else if (args.size() == 2 && args[0] == String16("data_injection")) {
347 if (mCurrentOperatingMode == NORMAL) {
348 dev.disableAllSensors();
349 status_t err = dev.setMode(DATA_INJECTION);
350 if (err == NO_ERROR) {
351 mCurrentOperatingMode = DATA_INJECTION;
352 } else {
353 // Re-enable sensors.
354 dev.enableAllSensors();
355 }
356 mWhiteListedPackage.setTo(String8(args[1]));
357 return NO_ERROR;
358 } else if (mCurrentOperatingMode == DATA_INJECTION) {
359 // Already in DATA_INJECTION mode. Treat this as a no_op.
360 return NO_ERROR;
361 } else {
362 // Transition to data injection mode supported only from NORMAL mode.
363 return INVALID_OPERATION;
364 }
Peng Xu0cc8f802016-04-05 23:46:03 -0700365 } else if (!mSensors.hasAnySensor()) {
Aravind Akellaee155ca2015-06-24 08:31:32 -0700366 result.append("No Sensors on the device\n");
Aravind Akella444f2672015-05-07 12:40:52 -0700367 } else {
368 // Default dump the sensor list and debugging information.
Peng Xu0cc8f802016-04-05 23:46:03 -0700369 //
Peng Xu6a2d3a02015-12-21 12:00:23 -0800370 result.append("Sensor Device:\n");
371 result.append(SensorDevice::getInstance().dump().c_str());
372
373 result.append("Sensor List:\n");
Peng Xu0cc8f802016-04-05 23:46:03 -0700374 result.append(mSensors.dump().c_str());
Mathias Agopian3560fb22010-07-22 21:24:39 -0700375
Peng Xu6a2d3a02015-12-21 12:00:23 -0800376 result.append("Fusion States:\n");
Aravind Akella444f2672015-05-07 12:40:52 -0700377 SensorFusion::getInstance().dump(result);
Aravind Akella444f2672015-05-07 12:40:52 -0700378
Peng Xu0cc8f802016-04-05 23:46:03 -0700379 result.append("Recent Sensor events:\n");
Peng Xu6a2d3a02015-12-21 12:00:23 -0800380 for (auto&& i : mRecentEvent) {
381 sp<SensorInterface> s = mSensors.getInterface(i.first);
382 if (!i.second->isEmpty() &&
383 s->getSensor().getRequiredPermission().isEmpty()) {
384 // if there is events and sensor does not need special permission.
385 result.appendFormat("%s: ", s->getSensor().getName().string());
386 result.append(i.second->dump().c_str());
387 }
388 }
Peng Xu0cc8f802016-04-05 23:46:03 -0700389
Aravind Akella444f2672015-05-07 12:40:52 -0700390 result.append("Active sensors:\n");
391 for (size_t i=0 ; i<mActiveSensors.size() ; i++) {
392 int handle = mActiveSensors.keyAt(i);
393 result.appendFormat("%s (handle=0x%08x, connections=%zu)\n",
394 getSensorName(handle).string(),
395 handle,
396 mActiveSensors.valueAt(i)->getNumConnections());
Aravind Akella6c2664a2014-08-13 12:24:50 -0700397 }
398
Andreas Gamped4036b62015-07-28 13:49:04 -0700399 result.appendFormat("Socket Buffer size = %zd events\n",
Aravind Akella444f2672015-05-07 12:40:52 -0700400 mSocketBufferSize/sizeof(sensors_event_t));
Aravind Akella18d6d512015-06-18 14:18:28 -0700401 result.appendFormat("WakeLock Status: %s \n", mWakeLockAcquired ? "acquired" :
402 "not held");
Aravind Akella444f2672015-05-07 12:40:52 -0700403 result.appendFormat("Mode :");
404 switch(mCurrentOperatingMode) {
405 case NORMAL:
406 result.appendFormat(" NORMAL\n");
407 break;
408 case RESTRICTED:
Aravind Akella841a5922015-06-29 12:37:48 -0700409 result.appendFormat(" RESTRICTED : %s\n", mWhiteListedPackage.string());
Aravind Akella444f2672015-05-07 12:40:52 -0700410 break;
411 case DATA_INJECTION:
Aravind Akella841a5922015-06-29 12:37:48 -0700412 result.appendFormat(" DATA_INJECTION : %s\n", mWhiteListedPackage.string());
Mathias Agopianba02cd22013-07-03 16:20:57 -0700413 }
Aravind Akella444f2672015-05-07 12:40:52 -0700414 result.appendFormat("%zd active connections\n", mActiveConnections.size());
Aravind Akella0e025c52014-06-03 19:19:57 -0700415
Aravind Akella444f2672015-05-07 12:40:52 -0700416 for (size_t i=0 ; i < mActiveConnections.size() ; i++) {
417 sp<SensorEventConnection> connection(mActiveConnections[i].promote());
418 if (connection != 0) {
419 result.appendFormat("Connection Number: %zu \n", i);
420 connection->dump(result);
421 }
Aravind Akella4c8b9512013-09-05 17:03:38 -0700422 }
Aravind Akella18d6d512015-06-18 14:18:28 -0700423
424 result.appendFormat("Previous Registrations:\n");
425 // Log in the reverse chronological order.
426 int currentIndex = (mNextSensorRegIndex - 1 + SENSOR_REGISTRATIONS_BUF_SIZE) %
427 SENSOR_REGISTRATIONS_BUF_SIZE;
428 const int startIndex = currentIndex;
429 do {
430 const SensorRegistrationInfo& reg_info = mLastNSensorRegistrations[currentIndex];
431 if (SensorRegistrationInfo::isSentinel(reg_info)) {
432 // Ignore sentinel, proceed to next item.
433 currentIndex = (currentIndex - 1 + SENSOR_REGISTRATIONS_BUF_SIZE) %
434 SENSOR_REGISTRATIONS_BUF_SIZE;
435 continue;
436 }
437 if (reg_info.mActivated) {
438 result.appendFormat("%02d:%02d:%02d activated package=%s handle=0x%08x "
439 "samplingRate=%dus maxReportLatency=%dus\n",
440 reg_info.mHour, reg_info.mMin, reg_info.mSec,
441 reg_info.mPackageName.string(), reg_info.mSensorHandle,
442 reg_info.mSamplingRateUs, reg_info.mMaxReportLatencyUs);
443 } else {
444 result.appendFormat("%02d:%02d:%02d de-activated package=%s handle=0x%08x\n",
445 reg_info.mHour, reg_info.mMin, reg_info.mSec,
446 reg_info.mPackageName.string(), reg_info.mSensorHandle);
447 }
448 currentIndex = (currentIndex - 1 + SENSOR_REGISTRATIONS_BUF_SIZE) %
449 SENSOR_REGISTRATIONS_BUF_SIZE;
450 } while(startIndex != currentIndex);
Aravind Akella4c8b9512013-09-05 17:03:38 -0700451 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700452 }
453 write(fd, result.string(), result.size());
454 return NO_ERROR;
455}
456
Peng Xu0cc8f802016-04-05 23:46:03 -0700457//TODO: move to SensorEventConnection later
Aravind Akella9a844cf2014-02-11 18:58:52 -0800458void SensorService::cleanupAutoDisabledSensorLocked(const sp<SensorEventConnection>& connection,
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700459 sensors_event_t const* buffer, const int count) {
460 for (int i=0 ; i<count ; i++) {
461 int handle = buffer[i].sensor;
Aravind Akella8493b792014-09-08 15:45:47 -0700462 if (buffer[i].type == SENSOR_TYPE_META_DATA) {
463 handle = buffer[i].meta_data.sensor;
464 }
Aravind Akella0e025c52014-06-03 19:19:57 -0700465 if (connection->hasSensor(handle)) {
Peng Xu755c4512016-04-07 23:15:14 -0700466 sp<SensorInterface> si = getSensorInterfaceFromHandle(handle);
Aravind Akella0e025c52014-06-03 19:19:57 -0700467 // If this buffer has an event from a one_shot sensor and this connection is registered
468 // for this particular one_shot sensor, try cleaning up the connection.
Peng Xu755c4512016-04-07 23:15:14 -0700469 if (si != nullptr &&
Peng Xu0cc8f802016-04-05 23:46:03 -0700470 si->getSensor().getReportingMode() == AREPORTING_MODE_ONE_SHOT) {
471 si->autoDisable(connection.get(), handle);
Aravind Akella9a844cf2014-02-11 18:58:52 -0800472 cleanupWithoutDisableLocked(connection, handle);
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700473 }
Aravind Akellaa9e6cc32015-04-16 18:57:31 -0700474
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700475 }
Aravind Akellaa9e6cc32015-04-16 18:57:31 -0700476 }
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700477}
478
Peng Xu47e96012016-03-28 17:55:56 -0700479bool SensorService::threadLoop() {
Steve Blocka5512372011-12-20 16:23:08 +0000480 ALOGD("nuSensorService thread starting...");
Mathias Agopianfc328812010-07-14 23:41:37 -0700481
Peng Xueb4d6282015-12-10 18:02:41 -0800482 // each virtual sensor could generate an event per "real" event, that's why we need to size
483 // numEventMax much smaller than MAX_RECEIVE_BUFFER_EVENT_COUNT. in practice, this is too
484 // aggressive, but guaranteed to be enough.
Peng Xu0cc8f802016-04-05 23:46:03 -0700485 const size_t vcount = mSensors.getVirtualSensors().size();
Mathias Agopian90ed3e82013-09-09 23:36:25 -0700486 const size_t minBufferSize = SensorEventQueue::MAX_RECEIVE_BUFFER_EVENT_COUNT;
Peng Xu0cc8f802016-04-05 23:46:03 -0700487 const size_t numEventMax = minBufferSize / (1 + vcount);
Mathias Agopian90ed3e82013-09-09 23:36:25 -0700488
Mathias Agopianf001c922010-11-11 17:58:51 -0800489 SensorDevice& device(SensorDevice::getInstance());
Mathias Agopianfc328812010-07-14 23:41:37 -0700490
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700491 const int halVersion = device.getHalDeviceVersion();
Mathias Agopianfc328812010-07-14 23:41:37 -0700492 do {
Aravind Akella8493b792014-09-08 15:45:47 -0700493 ssize_t count = device.poll(mSensorEventBuffer, numEventMax);
494 if (count < 0) {
Steve Blockf5a12302012-01-06 19:20:56 +0000495 ALOGE("sensor poll failed (%s)", strerror(-count));
Mathias Agopianfc328812010-07-14 23:41:37 -0700496 break;
497 }
Aravind Akella56ae4262014-07-10 16:01:10 -0700498
499 // Reset sensors_event_t.flags to zero for all events in the buffer.
500 for (int i = 0; i < count; i++) {
Aravind Akella8493b792014-09-08 15:45:47 -0700501 mSensorEventBuffer[i].flags = 0;
Aravind Akella56ae4262014-07-10 16:01:10 -0700502 }
Aravind Akellae148bc22014-09-24 22:12:58 -0700503
Peng Xueb4d6282015-12-10 18:02:41 -0800504 // Make a copy of the connection vector as some connections may be removed during the course
505 // of this loop (especially when one-shot sensor events are present in the sensor_event
506 // buffer). Promote all connections to StrongPointers before the lock is acquired. If the
507 // destructor of the sp gets called when the lock is acquired, it may result in a deadlock
508 // as ~SensorEventConnection() needs to acquire mLock again for cleanup. So copy all the
509 // strongPointers to a vector before the lock is acquired.
Aravind Akellae148bc22014-09-24 22:12:58 -0700510 SortedVector< sp<SensorEventConnection> > activeConnections;
Aravind Akellab4373ac2014-10-29 17:55:20 -0700511 populateActiveConnections(&activeConnections);
Peng Xueb4d6282015-12-10 18:02:41 -0800512
Aravind Akella9a844cf2014-02-11 18:58:52 -0800513 Mutex::Autolock _l(mLock);
514 // Poll has returned. Hold a wakelock if one of the events is from a wake up sensor. The
515 // rest of this loop is under a critical section protected by mLock. Acquiring a wakeLock,
516 // sending events to clients (incrementing SensorEventConnection::mWakeLockRefCount) should
517 // not be interleaved with decrementing SensorEventConnection::mWakeLockRefCount and
518 // releasing the wakelock.
519 bool bufferHasWakeUpEvent = false;
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700520 for (int i = 0; i < count; i++) {
Aravind Akella8493b792014-09-08 15:45:47 -0700521 if (isWakeUpSensorEvent(mSensorEventBuffer[i])) {
Aravind Akella9a844cf2014-02-11 18:58:52 -0800522 bufferHasWakeUpEvent = true;
523 break;
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700524 }
525 }
526
Aravind Akella9a844cf2014-02-11 18:58:52 -0800527 if (bufferHasWakeUpEvent && !mWakeLockAcquired) {
Aravind Akellab4373ac2014-10-29 17:55:20 -0700528 setWakeLockAcquiredLocked(true);
Aravind Akella9a844cf2014-02-11 18:58:52 -0800529 }
Aravind Akella8493b792014-09-08 15:45:47 -0700530 recordLastValueLocked(mSensorEventBuffer, count);
Mathias Agopian94e8f682010-11-10 17:50:28 -0800531
Mathias Agopianf001c922010-11-11 17:58:51 -0800532 // handle virtual sensors
533 if (count && vcount) {
Aravind Akella8493b792014-09-08 15:45:47 -0700534 sensors_event_t const * const event = mSensorEventBuffer;
Peng Xu755c4512016-04-07 23:15:14 -0700535 if (!mActiveVirtualSensors.empty()) {
Mathias Agopianf001c922010-11-11 17:58:51 -0800536 size_t k = 0;
Mathias Agopian984826c2011-05-17 22:54:42 -0700537 SensorFusion& fusion(SensorFusion::getInstance());
538 if (fusion.isEnabled()) {
539 for (size_t i=0 ; i<size_t(count) ; i++) {
540 fusion.process(event[i]);
541 }
542 }
Mathias Agopiand1920ff2012-05-29 19:46:14 -0700543 for (size_t i=0 ; i<size_t(count) && k<minBufferSize ; i++) {
Peng Xu755c4512016-04-07 23:15:14 -0700544 for (int handle : mActiveVirtualSensors) {
Mathias Agopiand1920ff2012-05-29 19:46:14 -0700545 if (count + k >= minBufferSize) {
546 ALOGE("buffer too small to hold all events: "
Mark Salyzyndb458612014-06-10 14:50:02 -0700547 "count=%zd, k=%zu, size=%zu",
Mathias Agopiand1920ff2012-05-29 19:46:14 -0700548 count, k, minBufferSize);
549 break;
550 }
Mathias Agopianf001c922010-11-11 17:58:51 -0800551 sensors_event_t out;
Peng Xu755c4512016-04-07 23:15:14 -0700552 sp<SensorInterface> si = mSensors.getInterface(handle);
553 if (si == nullptr) {
554 ALOGE("handle %d is not an valid virtual sensor", handle);
555 continue;
556 }
557
Mathias Agopiand1920ff2012-05-29 19:46:14 -0700558 if (si->process(&out, event[i])) {
Aravind Akella8493b792014-09-08 15:45:47 -0700559 mSensorEventBuffer[count + k] = out;
Mathias Agopianf001c922010-11-11 17:58:51 -0800560 k++;
561 }
562 }
563 }
564 if (k) {
565 // record the last synthesized values
Aravind Akella8493b792014-09-08 15:45:47 -0700566 recordLastValueLocked(&mSensorEventBuffer[count], k);
Mathias Agopianf001c922010-11-11 17:58:51 -0800567 count += k;
568 // sort the buffer by time-stamps
Aravind Akella8493b792014-09-08 15:45:47 -0700569 sortEventBuffer(mSensorEventBuffer, count);
Mathias Agopianfc328812010-07-14 23:41:37 -0700570 }
571 }
572 }
573
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700574 // handle backward compatibility for RotationVector sensor
575 if (halVersion < SENSORS_DEVICE_API_VERSION_1_0) {
576 for (int i = 0; i < count; i++) {
Aravind Akella8493b792014-09-08 15:45:47 -0700577 if (mSensorEventBuffer[i].type == SENSOR_TYPE_ROTATION_VECTOR) {
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700578 // All the 4 components of the quaternion should be available
579 // No heading accuracy. Set it to -1
Aravind Akella8493b792014-09-08 15:45:47 -0700580 mSensorEventBuffer[i].data[4] = -1;
581 }
582 }
583 }
584
Aravind Akella8493b792014-09-08 15:45:47 -0700585 for (int i = 0; i < count; ++i) {
Peng Xu0cc8f802016-04-05 23:46:03 -0700586 // Map flush_complete_events in the buffer to SensorEventConnections which called flush
587 // on the hardware sensor. mapFlushEventsToConnections[i] will be the
588 // SensorEventConnection mapped to the corresponding flush_complete_event in
589 // mSensorEventBuffer[i] if such a mapping exists (NULL otherwise).
Aravind Akella8493b792014-09-08 15:45:47 -0700590 mMapFlushEventsToConnections[i] = NULL;
591 if (mSensorEventBuffer[i].type == SENSOR_TYPE_META_DATA) {
592 const int sensor_handle = mSensorEventBuffer[i].meta_data.sensor;
593 SensorRecord* rec = mActiveSensors.valueFor(sensor_handle);
594 if (rec != NULL) {
595 mMapFlushEventsToConnections[i] = rec->getFirstPendingFlushConnection();
596 rec->removeFirstPendingFlushConnection();
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700597 }
598 }
Peng Xu2576cb62016-01-20 00:22:09 -0800599
600 // handle dynamic sensor meta events, process registration and unregistration of dynamic
601 // sensor based on content of event.
602 if (mSensorEventBuffer[i].type == SENSOR_TYPE_DYNAMIC_SENSOR_META) {
603 if (mSensorEventBuffer[i].dynamic_sensor_meta.connected) {
604 int handle = mSensorEventBuffer[i].dynamic_sensor_meta.handle;
605 const sensor_t& dynamicSensor =
606 *(mSensorEventBuffer[i].dynamic_sensor_meta.sensor);
607 ALOGI("Dynamic sensor handle 0x%x connected, type %d, name %s",
608 handle, dynamicSensor.type, dynamicSensor.name);
609
Peng Xu0cc8f802016-04-05 23:46:03 -0700610 if (mSensors.isNewHandle(handle)) {
Peng Xu6a2d3a02015-12-21 12:00:23 -0800611 const auto& uuid = mSensorEventBuffer[i].dynamic_sensor_meta.uuid;
Peng Xu47e96012016-03-28 17:55:56 -0700612 sensor_t s = dynamicSensor;
613 // make sure the dynamic sensor flag is set
614 s.flags |= DYNAMIC_SENSOR_MASK;
615 // force the handle to be consistent
616 s.handle = handle;
Peng Xu6a2d3a02015-12-21 12:00:23 -0800617
618 SensorInterface *si = new HardwareSensor(s, uuid);
Peng Xu2576cb62016-01-20 00:22:09 -0800619
Peng Xu0cc8f802016-04-05 23:46:03 -0700620 // This will release hold on dynamic sensor meta, so it should be called
621 // after Sensor object is created.
Peng Xu47e96012016-03-28 17:55:56 -0700622 device.handleDynamicSensorConnection(handle, true /*connected*/);
Peng Xu6a2d3a02015-12-21 12:00:23 -0800623 registerDynamicSensorLocked(si);
Peng Xu47e96012016-03-28 17:55:56 -0700624 } else {
625 ALOGE("Handle %d has been used, cannot use again before reboot.", handle);
626 }
Peng Xu2576cb62016-01-20 00:22:09 -0800627 } else {
628 int handle = mSensorEventBuffer[i].dynamic_sensor_meta.handle;
629 ALOGI("Dynamic sensor handle 0x%x disconnected", handle);
630
631 device.handleDynamicSensorConnection(handle, false /*connected*/);
Peng Xu6a2d3a02015-12-21 12:00:23 -0800632 if (!unregisterDynamicSensorLocked(handle)) {
Peng Xu2576cb62016-01-20 00:22:09 -0800633 ALOGE("Dynamic sensor release error.");
634 }
635
636 size_t numConnections = activeConnections.size();
637 for (size_t i=0 ; i < numConnections; ++i) {
638 if (activeConnections[i] != NULL) {
639 activeConnections[i]->removeSensor(handle);
640 }
641 }
642 }
643 }
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700644 }
645
Peng Xu2576cb62016-01-20 00:22:09 -0800646
Aravind Akella9a844cf2014-02-11 18:58:52 -0800647 // Send our events to clients. Check the state of wake lock for each client and release the
648 // lock if none of the clients need it.
649 bool needsWakeLock = false;
Aravind Akella8493b792014-09-08 15:45:47 -0700650 size_t numConnections = activeConnections.size();
651 for (size_t i=0 ; i < numConnections; ++i) {
Aravind Akellae148bc22014-09-24 22:12:58 -0700652 if (activeConnections[i] != 0) {
653 activeConnections[i]->sendEvents(mSensorEventBuffer, count, mSensorEventScratch,
Aravind Akella8493b792014-09-08 15:45:47 -0700654 mMapFlushEventsToConnections);
Aravind Akellae148bc22014-09-24 22:12:58 -0700655 needsWakeLock |= activeConnections[i]->needsWakeLock();
Aravind Akella8493b792014-09-08 15:45:47 -0700656 // If the connection has one-shot sensors, it may be cleaned up after first trigger.
657 // Early check for one-shot sensors.
Aravind Akellae148bc22014-09-24 22:12:58 -0700658 if (activeConnections[i]->hasOneShotSensors()) {
659 cleanupAutoDisabledSensorLocked(activeConnections[i], mSensorEventBuffer,
660 count);
Aravind Akella8493b792014-09-08 15:45:47 -0700661 }
Mathias Agopianf001c922010-11-11 17:58:51 -0800662 }
663 }
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700664
Aravind Akella9a844cf2014-02-11 18:58:52 -0800665 if (mWakeLockAcquired && !needsWakeLock) {
Aravind Akellab4373ac2014-10-29 17:55:20 -0700666 setWakeLockAcquiredLocked(false);
Aravind Akella9a844cf2014-02-11 18:58:52 -0800667 }
Aravind Akella8493b792014-09-08 15:45:47 -0700668 } while (!Thread::exitPending());
Mathias Agopianfc328812010-07-14 23:41:37 -0700669
Steve Block3c20fbe2012-01-05 23:22:43 +0000670 ALOGW("Exiting SensorService::threadLoop => aborting...");
Mathias Agopian1a623012011-11-09 17:50:15 -0800671 abort();
Mathias Agopianfc328812010-07-14 23:41:37 -0700672 return false;
673}
674
Aravind Akella56ae4262014-07-10 16:01:10 -0700675sp<Looper> SensorService::getLooper() const {
676 return mLooper;
677}
678
Aravind Akellab4373ac2014-10-29 17:55:20 -0700679void SensorService::resetAllWakeLockRefCounts() {
680 SortedVector< sp<SensorEventConnection> > activeConnections;
681 populateActiveConnections(&activeConnections);
682 {
683 Mutex::Autolock _l(mLock);
684 for (size_t i=0 ; i < activeConnections.size(); ++i) {
685 if (activeConnections[i] != 0) {
686 activeConnections[i]->resetWakeLockRefCount();
687 }
688 }
689 setWakeLockAcquiredLocked(false);
690 }
691}
692
693void SensorService::setWakeLockAcquiredLocked(bool acquire) {
694 if (acquire) {
695 if (!mWakeLockAcquired) {
696 acquire_wake_lock(PARTIAL_WAKE_LOCK, WAKE_LOCK_NAME);
697 mWakeLockAcquired = true;
698 }
699 mLooper->wake();
700 } else {
701 if (mWakeLockAcquired) {
702 release_wake_lock(WAKE_LOCK_NAME);
703 mWakeLockAcquired = false;
704 }
705 }
706}
707
Aravind Akellab4373ac2014-10-29 17:55:20 -0700708bool SensorService::isWakeLockAcquired() {
709 Mutex::Autolock _l(mLock);
710 return mWakeLockAcquired;
711}
712
Aravind Akella56ae4262014-07-10 16:01:10 -0700713bool SensorService::SensorEventAckReceiver::threadLoop() {
714 ALOGD("new thread SensorEventAckReceiver");
Aravind Akellab4373ac2014-10-29 17:55:20 -0700715 sp<Looper> looper = mService->getLooper();
Aravind Akella56ae4262014-07-10 16:01:10 -0700716 do {
Aravind Akellab4373ac2014-10-29 17:55:20 -0700717 bool wakeLockAcquired = mService->isWakeLockAcquired();
718 int timeout = -1;
719 if (wakeLockAcquired) timeout = 5000;
720 int ret = looper->pollOnce(timeout);
721 if (ret == ALOOPER_POLL_TIMEOUT) {
722 mService->resetAllWakeLockRefCounts();
723 }
Aravind Akella56ae4262014-07-10 16:01:10 -0700724 } while(!Thread::exitPending());
725 return false;
726}
727
Aravind Akella9a844cf2014-02-11 18:58:52 -0800728void SensorService::recordLastValueLocked(
Aravind Akella4b847042014-03-03 19:02:46 -0800729 const sensors_event_t* buffer, size_t count) {
Aravind Akella4b847042014-03-03 19:02:46 -0800730 for (size_t i = 0; i < count; i++) {
Peng Xu2576cb62016-01-20 00:22:09 -0800731 if (buffer[i].type == SENSOR_TYPE_META_DATA ||
732 buffer[i].type == SENSOR_TYPE_DYNAMIC_SENSOR_META ||
Peng Xu6a2d3a02015-12-21 12:00:23 -0800733 buffer[i].type == SENSOR_TYPE_ADDITIONAL_INFO) {
Peng Xu2576cb62016-01-20 00:22:09 -0800734 continue;
Mathias Agopian94e8f682010-11-10 17:50:28 -0800735 }
Peng Xu2576cb62016-01-20 00:22:09 -0800736
Peng Xu6a2d3a02015-12-21 12:00:23 -0800737 auto logger = mRecentEvent.find(buffer[i].sensor);
738 if (logger != mRecentEvent.end()) {
739 logger->second->addEvent(buffer[i]);
Peng Xu2576cb62016-01-20 00:22:09 -0800740 }
Mathias Agopian94e8f682010-11-10 17:50:28 -0800741 }
Mathias Agopian94e8f682010-11-10 17:50:28 -0800742}
743
Peng Xu47e96012016-03-28 17:55:56 -0700744void SensorService::sortEventBuffer(sensors_event_t* buffer, size_t count) {
Mathias Agopianf001c922010-11-11 17:58:51 -0800745 struct compar {
746 static int cmp(void const* lhs, void const* rhs) {
747 sensors_event_t const* l = static_cast<sensors_event_t const*>(lhs);
748 sensors_event_t const* r = static_cast<sensors_event_t const*>(rhs);
Mathias Agopiana5c106a2012-04-19 18:18:24 -0700749 return l->timestamp - r->timestamp;
Mathias Agopianf001c922010-11-11 17:58:51 -0800750 }
751 };
752 qsort(buffer, count, sizeof(sensors_event_t), compar::cmp);
753}
754
Mathias Agopian5d270722010-07-19 15:20:39 -0700755String8 SensorService::getSensorName(int handle) const {
Peng Xu0cc8f802016-04-05 23:46:03 -0700756 return mSensors.getName(handle);
Mathias Agopian5d270722010-07-19 15:20:39 -0700757}
758
Aravind Akellab4099e72013-10-15 15:43:10 -0700759bool SensorService::isVirtualSensor(int handle) const {
Peng Xu755c4512016-04-07 23:15:14 -0700760 sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
761 return sensor != nullptr && sensor->isVirtual();
Aravind Akellab4099e72013-10-15 15:43:10 -0700762}
763
Aravind Akella9a844cf2014-02-11 18:58:52 -0800764bool SensorService::isWakeUpSensorEvent(const sensors_event_t& event) const {
Sean Wan7869e222014-07-14 17:07:33 -0700765 int handle = event.sensor;
766 if (event.type == SENSOR_TYPE_META_DATA) {
767 handle = event.meta_data.sensor;
768 }
Peng Xu755c4512016-04-07 23:15:14 -0700769 sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
770 return sensor != nullptr && sensor->getSensor().isWakeUpSensor();
Aravind Akella9a844cf2014-02-11 18:58:52 -0800771}
772
Greg Kaiser53ca2e02016-06-21 16:11:14 -0700773int32_t SensorService::getIdFromUuid(const Sensor::uuid_t &uuid) const {
774 if ((uuid.i64[0] == 0) && (uuid.i64[1] == 0)) {
775 // UUID is not supported for this device.
776 return 0;
777 }
778 if ((uuid.i64[0] == INT64_C(~0)) && (uuid.i64[1] == INT64_C(~0))) {
779 // This sensor can be uniquely identified in the system by
780 // the combination of its type and name.
781 return -1;
782 }
783
784 // We have a dynamic sensor.
785
786 if (!sHmacGlobalKeyIsValid) {
787 // Rather than risk exposing UUIDs, we cripple dynamic sensors.
788 ALOGW("HMAC key failure; dynamic sensor getId() will be wrong.");
789 return 0;
790 }
791
792 // We want each app author/publisher to get a different ID, so that the
793 // same dynamic sensor cannot be tracked across apps by multiple
794 // authors/publishers. So we use both our UUID and our User ID.
795 // Note potential confusion:
796 // UUID => Universally Unique Identifier.
797 // UID => User Identifier.
798 // We refrain from using "uid" except as needed by API to try to
799 // keep this distinction clear.
800
801 auto appUserId = IPCThreadState::self()->getCallingUid();
802 uint8_t uuidAndApp[sizeof(uuid) + sizeof(appUserId)];
803 memcpy(uuidAndApp, &uuid, sizeof(uuid));
804 memcpy(uuidAndApp + sizeof(uuid), &appUserId, sizeof(appUserId));
805
806 // Now we use our key on our UUID/app combo to get the hash.
807 uint8_t hash[EVP_MAX_MD_SIZE];
808 unsigned int hashLen;
809 if (HMAC(EVP_sha256(),
810 sHmacGlobalKey, sizeof(sHmacGlobalKey),
811 uuidAndApp, sizeof(uuidAndApp),
812 hash, &hashLen) == nullptr) {
813 // Rather than risk exposing UUIDs, we cripple dynamic sensors.
814 ALOGW("HMAC failure; dynamic sensor getId() will be wrong.");
815 return 0;
816 }
817
818 int32_t id = 0;
819 if (hashLen < sizeof(id)) {
820 // We never expect this case, but out of paranoia, we handle it.
821 // Our 'id' length is already quite small, we don't want the
822 // effective length of it to be even smaller.
823 // Rather than risk exposing UUIDs, we cripple dynamic sensors.
824 ALOGW("HMAC insufficient; dynamic sensor getId() will be wrong.");
825 return 0;
826 }
827
828 // This is almost certainly less than all of 'hash', but it's as secure
829 // as we can be with our current 'id' length.
830 memcpy(&id, hash, sizeof(id));
831
832 // Note at the beginning of the function that we return the values of
833 // 0 and -1 to represent special cases. As a result, we can't return
834 // those as dynamic sensor IDs. If we happened to hash to one of those
835 // values, we change 'id' so we report as a dynamic sensor, and not as
836 // one of those special cases.
837 if (id == -1) {
838 id = -2;
839 } else if (id == 0) {
840 id = 1;
841 }
842 return id;
843}
844
845void SensorService::makeUuidsIntoIdsForSensorList(Vector<Sensor> &sensorList) const {
846 for (auto &sensor : sensorList) {
847 int32_t id = getIdFromUuid(sensor.getUuid());
848 sensor.setId(id);
849 }
850}
851
Peng Xu47e96012016-03-28 17:55:56 -0700852Vector<Sensor> SensorService::getSensorList(const String16& opPackageName) {
Mathias Agopian33264862012-06-28 19:46:54 -0700853 char value[PROPERTY_VALUE_MAX];
854 property_get("debug.sensors", value, "0");
Aravind Akella70018042014-04-07 22:52:37 +0000855 const Vector<Sensor>& initialSensorList = (atoi(value)) ?
Peng Xu0cc8f802016-04-05 23:46:03 -0700856 mSensors.getUserDebugSensors() : mSensors.getUserSensors();
Aravind Akella70018042014-04-07 22:52:37 +0000857 Vector<Sensor> accessibleSensorList;
858 for (size_t i = 0; i < initialSensorList.size(); i++) {
859 Sensor sensor = initialSensorList[i];
Svetoslavb412f6e2015-04-29 16:50:41 -0700860 if (canAccessSensor(sensor, "getSensorList", opPackageName)) {
Aravind Akella70018042014-04-07 22:52:37 +0000861 accessibleSensorList.add(sensor);
862 } else {
Svetoslavb412f6e2015-04-29 16:50:41 -0700863 ALOGI("Skipped sensor %s because it requires permission %s and app op %d",
Bernhard Rosenkränzer5f619932014-11-17 21:06:20 +0100864 sensor.getName().string(),
Svetoslavb412f6e2015-04-29 16:50:41 -0700865 sensor.getRequiredPermission().string(),
866 sensor.getRequiredAppOp());
Aravind Akella70018042014-04-07 22:52:37 +0000867 }
Mathias Agopian33264862012-06-28 19:46:54 -0700868 }
Greg Kaiser53ca2e02016-06-21 16:11:14 -0700869 makeUuidsIntoIdsForSensorList(accessibleSensorList);
Aravind Akella70018042014-04-07 22:52:37 +0000870 return accessibleSensorList;
Mathias Agopianfc328812010-07-14 23:41:37 -0700871}
872
Peng Xu47e96012016-03-28 17:55:56 -0700873Vector<Sensor> SensorService::getDynamicSensorList(const String16& opPackageName) {
Peng Xu2576cb62016-01-20 00:22:09 -0800874 Vector<Sensor> accessibleSensorList;
Peng Xu0cc8f802016-04-05 23:46:03 -0700875 mSensors.forEachSensor(
876 [&opPackageName, &accessibleSensorList] (const Sensor& sensor) -> bool {
Peng Xu755c4512016-04-07 23:15:14 -0700877 if (sensor.isDynamicSensor()) {
878 if (canAccessSensor(sensor, "getDynamicSensorList", opPackageName)) {
879 accessibleSensorList.add(sensor);
880 } else {
881 ALOGI("Skipped sensor %s because it requires permission %s and app op %" PRId32,
882 sensor.getName().string(),
883 sensor.getRequiredPermission().string(),
884 sensor.getRequiredAppOp());
885 }
Peng Xu0cc8f802016-04-05 23:46:03 -0700886 }
887 return true;
888 });
Greg Kaiser53ca2e02016-06-21 16:11:14 -0700889 makeUuidsIntoIdsForSensorList(accessibleSensorList);
Peng Xu2576cb62016-01-20 00:22:09 -0800890 return accessibleSensorList;
891}
892
Aravind Akellaa9e6cc32015-04-16 18:57:31 -0700893sp<ISensorEventConnection> SensorService::createSensorEventConnection(const String8& packageName,
Svetoslavb412f6e2015-04-29 16:50:41 -0700894 int requestedMode, const String16& opPackageName) {
Aravind Akellaa9e6cc32015-04-16 18:57:31 -0700895 // Only 2 modes supported for a SensorEventConnection ... NORMAL and DATA_INJECTION.
896 if (requestedMode != NORMAL && requestedMode != DATA_INJECTION) {
897 return NULL;
898 }
Aravind Akellaa9e6cc32015-04-16 18:57:31 -0700899
900 Mutex::Autolock _l(mLock);
Aravind Akella841a5922015-06-29 12:37:48 -0700901 // To create a client in DATA_INJECTION mode to inject data, SensorService should already be
902 // operating in DI mode.
903 if (requestedMode == DATA_INJECTION) {
904 if (mCurrentOperatingMode != DATA_INJECTION) return NULL;
905 if (!isWhiteListedPackage(packageName)) return NULL;
906 }
907
Mathias Agopian5307d172012-09-18 17:02:43 -0700908 uid_t uid = IPCThreadState::self()->getCallingUid();
Aravind Akellaa9e6cc32015-04-16 18:57:31 -0700909 sp<SensorEventConnection> result(new SensorEventConnection(this, uid, packageName,
Svetoslavb412f6e2015-04-29 16:50:41 -0700910 requestedMode == DATA_INJECTION, opPackageName));
Aravind Akellaa9e6cc32015-04-16 18:57:31 -0700911 if (requestedMode == DATA_INJECTION) {
912 if (mActiveConnections.indexOf(result) < 0) {
913 mActiveConnections.add(result);
914 }
915 // Add the associated file descriptor to the Looper for polling whenever there is data to
916 // be injected.
917 result->updateLooperRegistration(mLooper);
918 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700919 return result;
920}
921
Aravind Akella841a5922015-06-29 12:37:48 -0700922int SensorService::isDataInjectionEnabled() {
Aravind Akellaa9e6cc32015-04-16 18:57:31 -0700923 Mutex::Autolock _l(mLock);
Aravind Akella841a5922015-06-29 12:37:48 -0700924 return (mCurrentOperatingMode == DATA_INJECTION);
Aravind Akellaa9e6cc32015-04-16 18:57:31 -0700925}
926
927status_t SensorService::resetToNormalMode() {
928 Mutex::Autolock _l(mLock);
929 return resetToNormalModeLocked();
930}
931
932status_t SensorService::resetToNormalModeLocked() {
933 SensorDevice& dev(SensorDevice::getInstance());
Aravind Akellaa9e6cc32015-04-16 18:57:31 -0700934 status_t err = dev.setMode(NORMAL);
Aniroop Mathurbfac17e2016-08-31 22:59:44 +0530935 if (err == NO_ERROR) {
936 mCurrentOperatingMode = NORMAL;
937 dev.enableAllSensors();
938 }
Aravind Akellaa9e6cc32015-04-16 18:57:31 -0700939 return err;
940}
941
Peng Xu47e96012016-03-28 17:55:56 -0700942void SensorService::cleanupConnection(SensorEventConnection* c) {
Mathias Agopianfc328812010-07-14 23:41:37 -0700943 Mutex::Autolock _l(mLock);
Mathias Agopiandb5b4bc2011-02-03 14:52:47 -0800944 const wp<SensorEventConnection> connection(c);
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700945 size_t size = mActiveSensors.size();
Mark Salyzyndb458612014-06-10 14:50:02 -0700946 ALOGD_IF(DEBUG_CONNECTIONS, "%zu active sensors", size);
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700947 for (size_t i=0 ; i<size ; ) {
Mathias Agopiandb5b4bc2011-02-03 14:52:47 -0800948 int handle = mActiveSensors.keyAt(i);
949 if (c->hasSensor(handle)) {
Mark Salyzyndb458612014-06-10 14:50:02 -0700950 ALOGD_IF(DEBUG_CONNECTIONS, "%zu: disabling handle=0x%08x", i, handle);
Peng Xu755c4512016-04-07 23:15:14 -0700951 sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
952 if (sensor != nullptr) {
Mathias Agopiandb5b4bc2011-02-03 14:52:47 -0800953 sensor->activate(c, false);
Peng Xu755c4512016-04-07 23:15:14 -0700954 } else {
955 ALOGE("sensor interface of handle=0x%08x is null!", handle);
Mathias Agopianf001c922010-11-11 17:58:51 -0800956 }
Aravind Akella8a969552014-09-28 17:52:41 -0700957 c->removeSensor(handle);
Mathias Agopiandb5b4bc2011-02-03 14:52:47 -0800958 }
959 SensorRecord* rec = mActiveSensors.valueAt(i);
Mark Salyzyndb458612014-06-10 14:50:02 -0700960 ALOGE_IF(!rec, "mActiveSensors[%zu] is null (handle=0x%08x)!", i, handle);
Steve Blocka5512372011-12-20 16:23:08 +0000961 ALOGD_IF(DEBUG_CONNECTIONS,
Mark Salyzyndb458612014-06-10 14:50:02 -0700962 "removing connection %p for sensor[%zu].handle=0x%08x",
Mathias Agopiana1b7db92011-05-27 16:23:58 -0700963 c, i, handle);
964
Mathias Agopiandb5b4bc2011-02-03 14:52:47 -0800965 if (rec && rec->removeConnection(connection)) {
Steve Blocka5512372011-12-20 16:23:08 +0000966 ALOGD_IF(DEBUG_CONNECTIONS, "... and it was the last connection");
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700967 mActiveSensors.removeItemsAt(i, 1);
Peng Xu755c4512016-04-07 23:15:14 -0700968 mActiveVirtualSensors.erase(handle);
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700969 delete rec;
970 size--;
971 } else {
972 i++;
Mathias Agopianfc328812010-07-14 23:41:37 -0700973 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700974 }
Aravind Akella8a969552014-09-28 17:52:41 -0700975 c->updateLooperRegistration(mLooper);
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700976 mActiveConnections.remove(connection);
Mathias Agopian787ac1b2012-09-18 18:49:18 -0700977 BatteryService::cleanup(c->getUid());
Aravind Akella9a844cf2014-02-11 18:58:52 -0800978 if (c->needsWakeLock()) {
979 checkWakeLockStateLocked();
980 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700981}
982
Peng Xu755c4512016-04-07 23:15:14 -0700983sp<SensorInterface> SensorService::getSensorInterfaceFromHandle(int handle) const {
Peng Xu0cc8f802016-04-05 23:46:03 -0700984 return mSensors.getInterface(handle);
Peng Xu47e96012016-03-28 17:55:56 -0700985}
986
Aravind Akella70018042014-04-07 22:52:37 +0000987
Mathias Agopianfc328812010-07-14 23:41:37 -0700988status_t SensorService::enable(const sp<SensorEventConnection>& connection,
Svetoslavb412f6e2015-04-29 16:50:41 -0700989 int handle, nsecs_t samplingPeriodNs, nsecs_t maxBatchReportLatencyNs, int reservedFlags,
Peng Xu47e96012016-03-28 17:55:56 -0700990 const String16& opPackageName) {
Mathias Agopian50df2952010-07-19 19:09:10 -0700991 if (mInitCheck != NO_ERROR)
992 return mInitCheck;
993
Peng Xu755c4512016-04-07 23:15:14 -0700994 sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
995 if (sensor == nullptr ||
996 !canAccessSensor(sensor->getSensor(), "Tried enabling", opPackageName)) {
Aravind Akella70018042014-04-07 22:52:37 +0000997 return BAD_VALUE;
998 }
999
Mathias Agopianac9a96d2013-07-12 02:01:16 -07001000 Mutex::Autolock _l(mLock);
Aravind Akella841a5922015-06-29 12:37:48 -07001001 if ((mCurrentOperatingMode == RESTRICTED || mCurrentOperatingMode == DATA_INJECTION)
1002 && !isWhiteListedPackage(connection->getPackageName())) {
Aravind Akella4949c502015-02-11 15:54:35 -08001003 return INVALID_OPERATION;
1004 }
1005
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -07001006 SensorRecord* rec = mActiveSensors.valueFor(handle);
1007 if (rec == 0) {
1008 rec = new SensorRecord(connection);
1009 mActiveSensors.add(handle, rec);
1010 if (sensor->isVirtual()) {
Peng Xu755c4512016-04-07 23:15:14 -07001011 mActiveVirtualSensors.emplace(handle);
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -07001012 }
1013 } else {
1014 if (rec->addConnection(connection)) {
Aravind Akella9a844cf2014-02-11 18:58:52 -08001015 // this sensor is already activated, but we are adding a connection that uses it.
1016 // Immediately send down the last known value of the requested sensor if it's not a
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -07001017 // "continuous" sensor.
Aravind Akella0e025c52014-06-03 19:19:57 -07001018 if (sensor->getSensor().getReportingMode() == AREPORTING_MODE_ON_CHANGE) {
Aravind Akella9a844cf2014-02-11 18:58:52 -08001019 // NOTE: The wake_up flag of this event may get set to
1020 // WAKE_UP_SENSOR_EVENT_NEEDS_ACK if this is a wake_up event.
Peng Xu6a2d3a02015-12-21 12:00:23 -08001021
1022 auto logger = mRecentEvent.find(handle);
1023 if (logger != mRecentEvent.end()) {
Aravind Akella444f2672015-05-07 12:40:52 -07001024 sensors_event_t event;
Aravind Akella444f2672015-05-07 12:40:52 -07001025 // It is unlikely that this buffer is empty as the sensor is already active.
1026 // One possible corner case may be two applications activating an on-change
1027 // sensor at the same time.
Peng Xu6a2d3a02015-12-21 12:00:23 -08001028 if(logger->second->populateLastEvent(&event)) {
Aravind Akella444f2672015-05-07 12:40:52 -07001029 event.sensor = handle;
1030 if (event.version == sizeof(sensors_event_t)) {
1031 if (isWakeUpSensorEvent(event) && !mWakeLockAcquired) {
1032 setWakeLockAcquiredLocked(true);
1033 }
1034 connection->sendEvents(&event, 1, NULL);
1035 if (!connection->needsWakeLock() && mWakeLockAcquired) {
1036 checkWakeLockStateLocked();
1037 }
1038 }
Aravind Akella9a844cf2014-02-11 18:58:52 -08001039 }
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -07001040 }
1041 }
1042 }
1043 }
1044
1045 if (connection->addSensor(handle)) {
1046 BatteryService::enableSensor(connection->getUid(), handle);
1047 // the sensor was added (which means it wasn't already there)
1048 // so, see if this connection becomes active
1049 if (mActiveConnections.indexOf(connection) < 0) {
1050 mActiveConnections.add(connection);
1051 }
1052 } else {
1053 ALOGW("sensor %08x already enabled in connection %p (ignoring)",
1054 handle, connection.get());
1055 }
1056
Aravind Akella724d91d2013-06-27 12:04:23 -07001057 nsecs_t minDelayNs = sensor->getSensor().getMinDelayNs();
1058 if (samplingPeriodNs < minDelayNs) {
1059 samplingPeriodNs = minDelayNs;
1060 }
1061
Aravind Akella6c2664a2014-08-13 12:24:50 -07001062 ALOGD_IF(DEBUG_CONNECTIONS, "Calling batch handle==%d flags=%d"
1063 "rate=%" PRId64 " timeout== %" PRId64"",
Aravind Akella724d91d2013-06-27 12:04:23 -07001064 handle, reservedFlags, samplingPeriodNs, maxBatchReportLatencyNs);
1065
Aravind Akella4949c502015-02-11 15:54:35 -08001066 status_t err = sensor->batch(connection.get(), handle, 0, samplingPeriodNs,
Aravind Akella724d91d2013-06-27 12:04:23 -07001067 maxBatchReportLatencyNs);
Aravind Akella6c2664a2014-08-13 12:24:50 -07001068
Peng Xu20483c42015-10-26 15:14:43 -07001069 // Call flush() before calling activate() on the sensor. Wait for a first
1070 // flush complete event before sending events on this connection. Ignore
1071 // one-shot sensors which don't support flush(). Ignore on-change sensors
1072 // to maintain the on-change logic (any on-change events except the initial
1073 // one should be trigger by a change in value). Also if this sensor isn't
1074 // already active, don't call flush().
1075 if (err == NO_ERROR &&
Peng Xu2576cb62016-01-20 00:22:09 -08001076 sensor->getSensor().getReportingMode() == AREPORTING_MODE_CONTINUOUS &&
Aravind Akella5466c3d2014-08-22 16:11:10 -07001077 rec->getNumConnections() > 1) {
1078 connection->setFirstFlushPending(handle, true);
Aravind Akella4c8b9512013-09-05 17:03:38 -07001079 status_t err_flush = sensor->flush(connection.get(), handle);
Aravind Akella5466c3d2014-08-22 16:11:10 -07001080 // Flush may return error if the underlying h/w sensor uses an older HAL.
Aravind Akella6c2664a2014-08-13 12:24:50 -07001081 if (err_flush == NO_ERROR) {
Aravind Akella6c2664a2014-08-13 12:24:50 -07001082 rec->addPendingFlushConnection(connection.get());
Aravind Akella5466c3d2014-08-22 16:11:10 -07001083 } else {
1084 connection->setFirstFlushPending(handle, false);
Aravind Akella4c8b9512013-09-05 17:03:38 -07001085 }
1086 }
Aravind Akella724d91d2013-06-27 12:04:23 -07001087
1088 if (err == NO_ERROR) {
1089 ALOGD_IF(DEBUG_CONNECTIONS, "Calling activate on %d", handle);
1090 err = sensor->activate(connection.get(), true);
1091 }
1092
Aravind Akella8a969552014-09-28 17:52:41 -07001093 if (err == NO_ERROR) {
1094 connection->updateLooperRegistration(mLooper);
Aravind Akella18d6d512015-06-18 14:18:28 -07001095 SensorRegistrationInfo &reg_info =
1096 mLastNSensorRegistrations.editItemAt(mNextSensorRegIndex);
1097 reg_info.mSensorHandle = handle;
1098 reg_info.mSamplingRateUs = samplingPeriodNs/1000;
1099 reg_info.mMaxReportLatencyUs = maxBatchReportLatencyNs/1000;
1100 reg_info.mActivated = true;
1101 reg_info.mPackageName = connection->getPackageName();
1102 time_t rawtime = time(NULL);
1103 struct tm * timeinfo = localtime(&rawtime);
1104 reg_info.mHour = timeinfo->tm_hour;
1105 reg_info.mMin = timeinfo->tm_min;
1106 reg_info.mSec = timeinfo->tm_sec;
1107 mNextSensorRegIndex = (mNextSensorRegIndex + 1) % SENSOR_REGISTRATIONS_BUF_SIZE;
Aravind Akella56ae4262014-07-10 16:01:10 -07001108 }
1109
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -07001110 if (err != NO_ERROR) {
Aravind Akella724d91d2013-06-27 12:04:23 -07001111 // batch/activate has failed, reset our state.
Mathias Agopianac9a96d2013-07-12 02:01:16 -07001112 cleanupWithoutDisableLocked(connection, handle);
Mathias Agopianfc328812010-07-14 23:41:37 -07001113 }
1114 return err;
1115}
1116
Peng Xu47e96012016-03-28 17:55:56 -07001117status_t SensorService::disable(const sp<SensorEventConnection>& connection, int handle) {
Mathias Agopian50df2952010-07-19 19:09:10 -07001118 if (mInitCheck != NO_ERROR)
1119 return mInitCheck;
1120
Mathias Agopianac9a96d2013-07-12 02:01:16 -07001121 Mutex::Autolock _l(mLock);
1122 status_t err = cleanupWithoutDisableLocked(connection, handle);
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -07001123 if (err == NO_ERROR) {
Peng Xu755c4512016-04-07 23:15:14 -07001124 sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
1125 err = sensor != nullptr ? sensor->activate(connection.get(), false) : status_t(BAD_VALUE);
Aravind Akella18d6d512015-06-18 14:18:28 -07001126
1127 }
1128 if (err == NO_ERROR) {
1129 SensorRegistrationInfo &reg_info =
1130 mLastNSensorRegistrations.editItemAt(mNextSensorRegIndex);
1131 reg_info.mActivated = false;
1132 reg_info.mPackageName= connection->getPackageName();
1133 reg_info.mSensorHandle = handle;
1134 time_t rawtime = time(NULL);
1135 struct tm * timeinfo = localtime(&rawtime);
1136 reg_info.mHour = timeinfo->tm_hour;
1137 reg_info.mMin = timeinfo->tm_min;
1138 reg_info.mSec = timeinfo->tm_sec;
1139 mNextSensorRegIndex = (mNextSensorRegIndex + 1) % SENSOR_REGISTRATIONS_BUF_SIZE;
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -07001140 }
1141 return err;
1142}
1143
Mathias Agopianac9a96d2013-07-12 02:01:16 -07001144status_t SensorService::cleanupWithoutDisable(
1145 const sp<SensorEventConnection>& connection, int handle) {
Mathias Agopianfc328812010-07-14 23:41:37 -07001146 Mutex::Autolock _l(mLock);
Mathias Agopianac9a96d2013-07-12 02:01:16 -07001147 return cleanupWithoutDisableLocked(connection, handle);
1148}
1149
1150status_t SensorService::cleanupWithoutDisableLocked(
1151 const sp<SensorEventConnection>& connection, int handle) {
Mathias Agopianfc328812010-07-14 23:41:37 -07001152 SensorRecord* rec = mActiveSensors.valueFor(handle);
Mathias Agopianfc328812010-07-14 23:41:37 -07001153 if (rec) {
1154 // see if this connection becomes inactive
Mathias Agopian787ac1b2012-09-18 18:49:18 -07001155 if (connection->removeSensor(handle)) {
1156 BatteryService::disableSensor(connection->getUid(), handle);
1157 }
Mathias Agopianfc328812010-07-14 23:41:37 -07001158 if (connection->hasAnySensor() == false) {
Aravind Akella8a969552014-09-28 17:52:41 -07001159 connection->updateLooperRegistration(mLooper);
Mathias Agopianfc328812010-07-14 23:41:37 -07001160 mActiveConnections.remove(connection);
1161 }
1162 // see if this sensor becomes inactive
1163 if (rec->removeConnection(connection)) {
1164 mActiveSensors.removeItem(handle);
Peng Xu755c4512016-04-07 23:15:14 -07001165 mActiveVirtualSensors.erase(handle);
Mathias Agopianfc328812010-07-14 23:41:37 -07001166 delete rec;
Mathias Agopianfc328812010-07-14 23:41:37 -07001167 }
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -07001168 return NO_ERROR;
Mathias Agopian7c1c5312010-07-21 15:59:50 -07001169 }
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -07001170 return BAD_VALUE;
Mathias Agopianfc328812010-07-14 23:41:37 -07001171}
1172
Mathias Agopian7c1c5312010-07-21 15:59:50 -07001173status_t SensorService::setEventRate(const sp<SensorEventConnection>& connection,
Peng Xu47e96012016-03-28 17:55:56 -07001174 int handle, nsecs_t ns, const String16& opPackageName) {
Mathias Agopian50df2952010-07-19 19:09:10 -07001175 if (mInitCheck != NO_ERROR)
1176 return mInitCheck;
1177
Peng Xu755c4512016-04-07 23:15:14 -07001178 sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
1179 if (sensor == nullptr ||
1180 !canAccessSensor(sensor->getSensor(), "Tried configuring", opPackageName)) {
Aravind Akella70018042014-04-07 22:52:37 +00001181 return BAD_VALUE;
1182 }
1183
Mathias Agopian1cd70002010-07-21 15:59:50 -07001184 if (ns < 0)
1185 return BAD_VALUE;
1186
Mathias Agopian62569ec2011-11-07 21:21:47 -08001187 nsecs_t minDelayNs = sensor->getSensor().getMinDelayNs();
1188 if (ns < minDelayNs) {
1189 ns = minDelayNs;
Mathias Agopianae09d652011-11-01 17:37:49 -07001190 }
1191
Mathias Agopianf001c922010-11-11 17:58:51 -08001192 return sensor->setDelay(connection.get(), handle, ns);
Mathias Agopianfc328812010-07-14 23:41:37 -07001193}
1194
Svetoslavb412f6e2015-04-29 16:50:41 -07001195status_t SensorService::flushSensor(const sp<SensorEventConnection>& connection,
1196 const String16& opPackageName) {
Aravind Akella70018042014-04-07 22:52:37 +00001197 if (mInitCheck != NO_ERROR) return mInitCheck;
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001198 SensorDevice& dev(SensorDevice::getInstance());
1199 const int halVersion = dev.getHalDeviceVersion();
1200 status_t err(NO_ERROR);
1201 Mutex::Autolock _l(mLock);
1202 // Loop through all sensors for this connection and call flush on each of them.
1203 for (size_t i = 0; i < connection->mSensorInfo.size(); ++i) {
1204 const int handle = connection->mSensorInfo.keyAt(i);
Peng Xu755c4512016-04-07 23:15:14 -07001205 sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
1206 if (sensor == nullptr) {
1207 continue;
1208 }
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001209 if (sensor->getSensor().getReportingMode() == AREPORTING_MODE_ONE_SHOT) {
1210 ALOGE("flush called on a one-shot sensor");
1211 err = INVALID_OPERATION;
1212 continue;
1213 }
Aravind Akella8493b792014-09-08 15:45:47 -07001214 if (halVersion <= SENSORS_DEVICE_API_VERSION_1_0 || isVirtualSensor(handle)) {
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001215 // For older devices just increment pending flush count which will send a trivial
1216 // flush complete event.
Aravind Akella8a969552014-09-28 17:52:41 -07001217 connection->incrementPendingFlushCount(handle);
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001218 } else {
Svetoslavb412f6e2015-04-29 16:50:41 -07001219 if (!canAccessSensor(sensor->getSensor(), "Tried flushing", opPackageName)) {
1220 err = INVALID_OPERATION;
1221 continue;
1222 }
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001223 status_t err_flush = sensor->flush(connection.get(), handle);
1224 if (err_flush == NO_ERROR) {
1225 SensorRecord* rec = mActiveSensors.valueFor(handle);
1226 if (rec != NULL) rec->addPendingFlushConnection(connection);
1227 }
1228 err = (err_flush != NO_ERROR) ? err_flush : err;
1229 }
Aravind Akella70018042014-04-07 22:52:37 +00001230 }
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001231 return err;
Aravind Akella724d91d2013-06-27 12:04:23 -07001232}
Aravind Akella70018042014-04-07 22:52:37 +00001233
Svetoslavb412f6e2015-04-29 16:50:41 -07001234bool SensorService::canAccessSensor(const Sensor& sensor, const char* operation,
1235 const String16& opPackageName) {
1236 const String8& requiredPermission = sensor.getRequiredPermission();
Aravind Akella70018042014-04-07 22:52:37 +00001237
Svetoslavb412f6e2015-04-29 16:50:41 -07001238 if (requiredPermission.length() <= 0) {
Aravind Akella70018042014-04-07 22:52:37 +00001239 return true;
Svetoslavb412f6e2015-04-29 16:50:41 -07001240 }
1241
1242 bool hasPermission = false;
1243
1244 // Runtime permissions can't use the cache as they may change.
1245 if (sensor.isRequiredPermissionRuntime()) {
1246 hasPermission = checkPermission(String16(requiredPermission),
1247 IPCThreadState::self()->getCallingPid(), IPCThreadState::self()->getCallingUid());
Aravind Akella70018042014-04-07 22:52:37 +00001248 } else {
Svetoslavb412f6e2015-04-29 16:50:41 -07001249 hasPermission = PermissionCache::checkCallingPermission(String16(requiredPermission));
1250 }
1251
1252 if (!hasPermission) {
1253 ALOGE("%s a sensor (%s) without holding its required permission: %s",
1254 operation, sensor.getName().string(), sensor.getRequiredPermission().string());
Aravind Akella70018042014-04-07 22:52:37 +00001255 return false;
1256 }
Svetoslavb412f6e2015-04-29 16:50:41 -07001257
1258 const int32_t opCode = sensor.getRequiredAppOp();
1259 if (opCode >= 0) {
1260 AppOpsManager appOps;
1261 if (appOps.noteOp(opCode, IPCThreadState::self()->getCallingUid(), opPackageName)
1262 != AppOpsManager::MODE_ALLOWED) {
Andreas Gamped4036b62015-07-28 13:49:04 -07001263 ALOGE("%s a sensor (%s) without enabled required app op: %d",
Svetoslavb412f6e2015-04-29 16:50:41 -07001264 operation, sensor.getName().string(), opCode);
1265 return false;
1266 }
1267 }
1268
1269 return true;
Aravind Akella70018042014-04-07 22:52:37 +00001270}
1271
Aravind Akella9a844cf2014-02-11 18:58:52 -08001272void SensorService::checkWakeLockState() {
1273 Mutex::Autolock _l(mLock);
1274 checkWakeLockStateLocked();
1275}
1276
1277void SensorService::checkWakeLockStateLocked() {
1278 if (!mWakeLockAcquired) {
1279 return;
1280 }
1281 bool releaseLock = true;
1282 for (size_t i=0 ; i<mActiveConnections.size() ; i++) {
1283 sp<SensorEventConnection> connection(mActiveConnections[i].promote());
1284 if (connection != 0) {
1285 if (connection->needsWakeLock()) {
1286 releaseLock = false;
1287 break;
1288 }
1289 }
1290 }
1291 if (releaseLock) {
Aravind Akellab4373ac2014-10-29 17:55:20 -07001292 setWakeLockAcquiredLocked(false);
1293 }
1294}
1295
1296void SensorService::sendEventsFromCache(const sp<SensorEventConnection>& connection) {
1297 Mutex::Autolock _l(mLock);
1298 connection->writeToSocketFromCache();
1299 if (connection->needsWakeLock()) {
1300 setWakeLockAcquiredLocked(true);
1301 }
1302}
1303
1304void SensorService::populateActiveConnections(
1305 SortedVector< sp<SensorEventConnection> >* activeConnections) {
1306 Mutex::Autolock _l(mLock);
1307 for (size_t i=0 ; i < mActiveConnections.size(); ++i) {
1308 sp<SensorEventConnection> connection(mActiveConnections[i].promote());
1309 if (connection != 0) {
1310 activeConnections->add(connection);
1311 }
Aravind Akella9a844cf2014-02-11 18:58:52 -08001312 }
1313}
Aravind Akella6c2664a2014-08-13 12:24:50 -07001314
Aravind Akella4949c502015-02-11 15:54:35 -08001315bool SensorService::isWhiteListedPackage(const String8& packageName) {
Aravind Akella841a5922015-06-29 12:37:48 -07001316 return (packageName.contains(mWhiteListedPackage.string()));
Aravind Akella4949c502015-02-11 15:54:35 -08001317}
1318
Mathias Agopianfc328812010-07-14 23:41:37 -07001319}; // namespace android
1320