services/sensorservice/SensorService.cpp

   1 /*
   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 #include <binder/AppOpsManager.h>
  17 #include <binder/BinderService.h>
  18 #include <binder/IServiceManager.h>
  19 #include <binder/PermissionCache.h>
  20 #include <cutils/ashmem.h>
  21 #include <cutils/properties.h>
  22 #include <hardware/sensors.h>
  23 #include <hardware_legacy/power.h>
  24 #include <openssl/digest.h>
  25 #include <openssl/hmac.h>
  26 #include <openssl/rand.h>
  27 #include <sensor/SensorEventQueue.h>
  28 #include <utils/SystemClock.h>
  29
  30 #include "BatteryService.h"
  31 #include "CorrectedGyroSensor.h"
  32 #include "GravitySensor.h"
  33 #include "LinearAccelerationSensor.h"
  34 #include "OrientationSensor.h"
  35 #include "RotationVectorSensor.h"
  36 #include "SensorFusion.h"
  37 #include "SensorInterface.h"
  38
  39 #include "SensorService.h"
  40 #include "SensorDirectConnection.h"
  41 #include "SensorEventAckReceiver.h"
  42 #include "SensorEventConnection.h"
  43 #include "SensorRecord.h"
  44 #include "SensorRegistrationInfo.h"
  45
  46 #include <inttypes.h>
  47 #include <math.h>
  48 #include <sched.h>
  49 #include <stdint.h>
  50 #include <sys/socket.h>
  51 #include <sys/stat.h>
  52 #include <sys/types.h>
  53 #include <unistd.h>
  54
  55 namespace android {
  56 // ---------------------------------------------------------------------------
  57
  58 /*
  59  * Notes:
  60  *
  61  * - what about a gyro-corrected magnetic-field sensor?
  62  * - run mag sensor from time to time to force calibration
  63  * - gravity sensor length is wrong (=> drift in linear-acc sensor)
  64  *
  65  */
  66
  67 const char* SensorService::WAKE_LOCK_NAME = "SensorService_wakelock";
  68 uint8_t SensorService::sHmacGlobalKey[128] = {};
  69 bool SensorService::sHmacGlobalKeyIsValid = false;
  70
  71 #define SENSOR_SERVICE_DIR "/data/system/sensor_service"
  72 #define SENSOR_SERVICE_HMAC_KEY_FILE  SENSOR_SERVICE_DIR "/hmac_key"
  73 #define SENSOR_SERVICE_SCHED_FIFO_PRIORITY 10
  74
  75 // Permissions.
  76 static const String16 sDumpPermission("android.permission.DUMP");
  77 static const String16 sLocationHardwarePermission("android.permission.LOCATION_HARDWARE");
  78
  79 SensorService::SensorService()
  80     : mInitCheck(NO_INIT), mSocketBufferSize(SOCKET_BUFFER_SIZE_NON_BATCHED),
  81       mWakeLockAcquired(false) {
  82 }
  83
  84 bool SensorService::initializeHmacKey() {
  85     int fd = open(SENSOR_SERVICE_HMAC_KEY_FILE, O_RDONLY|O_CLOEXEC);
  86     if (fd != -1) {
  87         int result = read(fd, sHmacGlobalKey, sizeof(sHmacGlobalKey));
  88         close(fd);
  89         if (result == sizeof(sHmacGlobalKey)) {
  90             return true;
  91         }
  92         ALOGW("Unable to read HMAC key; generating new one.");
  93     }
  94
  95     if (RAND_bytes(sHmacGlobalKey, sizeof(sHmacGlobalKey)) == -1) {
  96         ALOGW("Can't generate HMAC key; dynamic sensor getId() will be wrong.");
  97         return false;
  98     }
  99
 100     // We need to make sure this is only readable to us.
 101     bool wroteKey = false;
 102     mkdir(SENSOR_SERVICE_DIR, S_IRWXU);
 103     fd = open(SENSOR_SERVICE_HMAC_KEY_FILE, O_WRONLY|O_CREAT|O_EXCL|O_CLOEXEC,
 104               S_IRUSR|S_IWUSR);
 105     if (fd != -1) {
 106         int result = write(fd, sHmacGlobalKey, sizeof(sHmacGlobalKey));
 107         close(fd);
 108         wroteKey = (result == sizeof(sHmacGlobalKey));
 109     }
 110     if (wroteKey) {
 111         ALOGI("Generated new HMAC key.");
 112     } else {
 113         ALOGW("Unable to write HMAC key; dynamic sensor getId() will change "
 114               "after reboot.");
 115     }
 116     // Even if we failed to write the key we return true, because we did
 117     // initialize the HMAC key.
 118     return true;
 119 }
 120
 121 // Set main thread to SCHED_FIFO to lower sensor event latency when system is under load
 122 void SensorService::enableSchedFifoMode() {
 123     struct sched_param param = {0};
 124     param.sched_priority = SENSOR_SERVICE_SCHED_FIFO_PRIORITY;
 125     if (sched_setscheduler(getTid(), SCHED_FIFO | SCHED_RESET_ON_FORK, &param) != 0) {
 126         ALOGE("Couldn't set SCHED_FIFO for SensorService thread");
 127     }
 128 }
 129
 130 void SensorService::onFirstRef() {
 131     ALOGD("nuSensorService starting...");
 132     SensorDevice& dev(SensorDevice::getInstance());
 133
 134     sHmacGlobalKeyIsValid = initializeHmacKey();
 135
 136     if (dev.initCheck() == NO_ERROR) {
 137         sensor_t const* list;
 138         ssize_t count = dev.getSensorList(&list);
 139         if (count > 0) {
 140             ssize_t orientationIndex = -1;
 141             bool hasGyro = false, hasAccel = false, hasMag = false;
 142             uint32_t virtualSensorsNeeds =
 143                     (1<<SENSOR_TYPE_GRAVITY) |
 144                     (1<<SENSOR_TYPE_LINEAR_ACCELERATION) |
 145                     (1<<SENSOR_TYPE_ROTATION_VECTOR) |
 146                     (1<<SENSOR_TYPE_GEOMAGNETIC_ROTATION_VECTOR) |
 147                     (1<<SENSOR_TYPE_GAME_ROTATION_VECTOR);
 148
 149             for (ssize_t i=0 ; i<count ; i++) {
 150                 bool useThisSensor=true;
 151
 152                 switch (list[i].type) {
 153                     case SENSOR_TYPE_ACCELEROMETER:
 154                         hasAccel = true;
 155                         break;
 156                     case SENSOR_TYPE_MAGNETIC_FIELD:
 157                         hasMag = true;
 158                         break;
 159                     case SENSOR_TYPE_ORIENTATION:
 160                         orientationIndex = i;
 161                         break;
 162                     case SENSOR_TYPE_GYROSCOPE:
 163                     case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
 164                         hasGyro = true;
 165                         break;
 166                     case SENSOR_TYPE_GRAVITY:
 167                     case SENSOR_TYPE_LINEAR_ACCELERATION:
 168                     case SENSOR_TYPE_ROTATION_VECTOR:
 169                     case SENSOR_TYPE_GEOMAGNETIC_ROTATION_VECTOR:
 170                     case SENSOR_TYPE_GAME_ROTATION_VECTOR:
 171                         if (IGNORE_HARDWARE_FUSION) {
 172                             useThisSensor = false;
 173                         } else {
 174                             virtualSensorsNeeds &= ~(1<<list[i].type);
 175                         }
 176                         break;
 177                 }
 178                 if (useThisSensor) {
 179                     registerSensor( new HardwareSensor(list[i]) );
 180                 }
 181             }
 182
 183             // it's safe to instantiate the SensorFusion object here
 184             // (it wants to be instantiated after h/w sensors have been
 185             // registered)
 186             SensorFusion::getInstance();
 187
 188             if (hasGyro && hasAccel && hasMag) {
 189                 // Add Android virtual sensors if they're not already
 190                 // available in the HAL
 191                 bool needRotationVector =
 192                         (virtualSensorsNeeds & (1<<SENSOR_TYPE_ROTATION_VECTOR)) != 0;
 193
 194                 registerSensor(new RotationVectorSensor(), !needRotationVector, true);
 195                 registerSensor(new OrientationSensor(), !needRotationVector, true);
 196
 197                 bool needLinearAcceleration =
 198                         (virtualSensorsNeeds & (1<<SENSOR_TYPE_LINEAR_ACCELERATION)) != 0;
 199
 200                 registerSensor(new LinearAccelerationSensor(list, count),
 201                                !needLinearAcceleration, true);
 202
 203                 // virtual debugging sensors are not for user
 204                 registerSensor( new CorrectedGyroSensor(list, count), true, true);
 205                 registerSensor( new GyroDriftSensor(), true, true);
 206             }
 207
 208             if (hasAccel && hasGyro) {
 209                 bool needGravitySensor = (virtualSensorsNeeds & (1<<SENSOR_TYPE_GRAVITY)) != 0;
 210                 registerSensor(new GravitySensor(list, count), !needGravitySensor, true);
 211
 212                 bool needGameRotationVector =
 213                         (virtualSensorsNeeds & (1<<SENSOR_TYPE_GAME_ROTATION_VECTOR)) != 0;
 214                 registerSensor(new GameRotationVectorSensor(), !needGameRotationVector, true);
 215             }
 216
 217             if (hasAccel && hasMag) {
 218                 bool needGeoMagRotationVector =
 219                         (virtualSensorsNeeds & (1<<SENSOR_TYPE_GEOMAGNETIC_ROTATION_VECTOR)) != 0;
 220                 registerSensor(new GeoMagRotationVectorSensor(), !needGeoMagRotationVector, true);
 221             }
 222
 223             // Check if the device really supports batching by looking at the FIFO event
 224             // counts for each sensor.
 225             bool batchingSupported = false;
 226             mSensors.forEachSensor(
 227                     [&batchingSupported] (const Sensor& s) -> bool {
 228                         if (s.getFifoMaxEventCount() > 0) {
 229                             batchingSupported = true;
 230                         }
 231                         return !batchingSupported;
 232                     });
 233
 234             if (batchingSupported) {
 235                 // Increase socket buffer size to a max of 100 KB for batching capabilities.
 236                 mSocketBufferSize = MAX_SOCKET_BUFFER_SIZE_BATCHED;
 237             } else {
 238                 mSocketBufferSize = SOCKET_BUFFER_SIZE_NON_BATCHED;
 239             }
 240
 241             // Compare the socketBufferSize value against the system limits and limit
 242             // it to maxSystemSocketBufferSize if necessary.
 243             FILE *fp = fopen("/proc/sys/net/core/wmem_max", "r");
 244             char line[128];
 245             if (fp != NULL && fgets(line, sizeof(line), fp) != NULL) {
 246                 line[sizeof(line) - 1] = '\0';
 247                 size_t maxSystemSocketBufferSize;
 248                 sscanf(line, "%zu", &maxSystemSocketBufferSize);
 249                 if (mSocketBufferSize > maxSystemSocketBufferSize) {
 250                     mSocketBufferSize = maxSystemSocketBufferSize;
 251                 }
 252             }
 253             if (fp) {
 254                 fclose(fp);
 255             }
 256
 257             mWakeLockAcquired = false;
 258             mLooper = new Looper(false);
 259             const size_t minBufferSize = SensorEventQueue::MAX_RECEIVE_BUFFER_EVENT_COUNT;
 260             mSensorEventBuffer = new sensors_event_t[minBufferSize];
 261             mSensorEventScratch = new sensors_event_t[minBufferSize];
 262             mMapFlushEventsToConnections = new wp<const SensorEventConnection> [minBufferSize];
 263             mCurrentOperatingMode = NORMAL;
 264
 265             mNextSensorRegIndex = 0;
 266             for (int i = 0; i < SENSOR_REGISTRATIONS_BUF_SIZE; ++i) {
 267                 mLastNSensorRegistrations.push();
 268             }
 269
 270             mInitCheck = NO_ERROR;
 271             mAckReceiver = new SensorEventAckReceiver(this);
 272             mAckReceiver->run("SensorEventAckReceiver", PRIORITY_URGENT_DISPLAY);
 273             run("SensorService", PRIORITY_URGENT_DISPLAY);
 274
 275             // priority can only be changed after run
 276             enableSchedFifoMode();
 277         }
 278     }
 279 }
 280
 281 const Sensor& SensorService::registerSensor(SensorInterface* s, bool isDebug, bool isVirtual) {
 282     int handle = s->getSensor().getHandle();
 283     int type = s->getSensor().getType();
 284     if (mSensors.add(handle, s, isDebug, isVirtual)){
 285         mRecentEvent.emplace(handle, new RecentEventLogger(type));
 286         return s->getSensor();
 287     } else {
 288         return mSensors.getNonSensor();
 289     }
 290 }
 291
 292 const Sensor& SensorService::registerDynamicSensorLocked(SensorInterface* s, bool isDebug) {
 293     return registerSensor(s, isDebug);
 294 }
 295
 296 bool SensorService::unregisterDynamicSensorLocked(int handle) {
 297     bool ret = mSensors.remove(handle);
 298
 299     const auto i = mRecentEvent.find(handle);
 300     if (i != mRecentEvent.end()) {
 301         delete i->second;
 302         mRecentEvent.erase(i);
 303     }
 304     return ret;
 305 }
 306
 307 const Sensor& SensorService::registerVirtualSensor(SensorInterface* s, bool isDebug) {
 308     return registerSensor(s, isDebug, true);
 309 }
 310
 311 SensorService::~SensorService() {
 312     for (auto && entry : mRecentEvent) {
 313         delete entry.second;
 314     }
 315 }
 316
 317 status_t SensorService::dump(int fd, const Vector<String16>& args) {
 318     String8 result;
 319     if (!PermissionCache::checkCallingPermission(sDumpPermission)) {
 320         result.appendFormat("Permission Denial: can't dump SensorService from pid=%d, uid=%d\n",
 321                 IPCThreadState::self()->getCallingPid(),
 322                 IPCThreadState::self()->getCallingUid());
 323     } else {
 324         bool privileged = IPCThreadState::self()->getCallingUid() == 0;
 325         if (args.size() > 2) {
 326            return INVALID_OPERATION;
 327         }
 328         Mutex::Autolock _l(mLock);
 329         SensorDevice& dev(SensorDevice::getInstance());
 330         if (args.size() == 2 && args[0] == String16("restrict")) {
 331             // If already in restricted mode. Ignore.
 332             if (mCurrentOperatingMode == RESTRICTED) {
 333                 return status_t(NO_ERROR);
 334             }
 335             // If in any mode other than normal, ignore.
 336             if (mCurrentOperatingMode != NORMAL) {
 337                 return INVALID_OPERATION;
 338             }
 339
 340             mCurrentOperatingMode = RESTRICTED;
 341             // temporarily stop all sensor direct report
 342             for (auto &i : mDirectConnections) {
 343                 sp<SensorDirectConnection> connection(i.promote());
 344                 if (connection != nullptr) {
 345                     connection->stopAll(true /* backupRecord */);
 346                 }
 347             }
 348
 349             dev.disableAllSensors();
 350             // Clear all pending flush connections for all active sensors. If one of the active
 351             // connections has called flush() and the underlying sensor has been disabled before a
 352             // flush complete event is returned, we need to remove the connection from this queue.
 353             for (size_t i=0 ; i< mActiveSensors.size(); ++i) {
 354                 mActiveSensors.valueAt(i)->clearAllPendingFlushConnections();
 355             }
 356             mWhiteListedPackage.setTo(String8(args[1]));
 357             return status_t(NO_ERROR);
 358         } else if (args.size() == 1 && args[0] == String16("enable")) {
 359             // If currently in restricted mode, reset back to NORMAL mode else ignore.
 360             if (mCurrentOperatingMode == RESTRICTED) {
 361                 mCurrentOperatingMode = NORMAL;
 362                 dev.enableAllSensors();
 363                 // recover all sensor direct report
 364                 for (auto &i : mDirectConnections) {
 365                     sp<SensorDirectConnection> connection(i.promote());
 366                     if (connection != nullptr) {
 367                         connection->recoverAll();
 368                     }
 369                 }
 370             }
 371             if (mCurrentOperatingMode == DATA_INJECTION) {
 372                resetToNormalModeLocked();
 373             }
 374             mWhiteListedPackage.clear();
 375             return status_t(NO_ERROR);
 376         } else if (args.size() == 2 && args[0] == String16("data_injection")) {
 377             if (mCurrentOperatingMode == NORMAL) {
 378                 dev.disableAllSensors();
 379                 status_t err = dev.setMode(DATA_INJECTION);
 380                 if (err == NO_ERROR) {
 381                     mCurrentOperatingMode = DATA_INJECTION;
 382                 } else {
 383                     // Re-enable sensors.
 384                     dev.enableAllSensors();
 385                 }
 386                 mWhiteListedPackage.setTo(String8(args[1]));
 387                 return NO_ERROR;
 388             } else if (mCurrentOperatingMode == DATA_INJECTION) {
 389                 // Already in DATA_INJECTION mode. Treat this as a no_op.
 390                 return NO_ERROR;
 391             } else {
 392                 // Transition to data injection mode supported only from NORMAL mode.
 393                 return INVALID_OPERATION;
 394             }
 395         } else if (!mSensors.hasAnySensor()) {
 396             result.append("No Sensors on the device\n");
 397             result.append("devInitCheck : %d\n", SensorDevice::getInstance().initCheck());
 398         } else {
 399             // Default dump the sensor list and debugging information.
 400             //
 401             result.append("Sensor Device:\n");
 402             result.append(SensorDevice::getInstance().dump().c_str());
 403
 404             result.append("Sensor List:\n");
 405             result.append(mSensors.dump().c_str());
 406
 407             result.append("Fusion States:\n");
 408             SensorFusion::getInstance().dump(result);
 409
 410             result.append("Recent Sensor events:\n");
 411             for (auto&& i : mRecentEvent) {
 412                 sp<SensorInterface> s = mSensors.getInterface(i.first);
 413                 if (!i.second->isEmpty()) {
 414                     if (privileged || s->getSensor().getRequiredPermission().isEmpty()) {
 415                         i.second->setFormat("normal");
 416                     } else {
 417                         i.second->setFormat("mask_data");
 418                     }
 419                     // if there is events and sensor does not need special permission.
 420                     result.appendFormat("%s: ", s->getSensor().getName().string());
 421                     result.append(i.second->dump().c_str());
 422                 }
 423             }
 424
 425             result.append("Active sensors:\n");
 426             for (size_t i=0 ; i<mActiveSensors.size() ; i++) {
 427                 int handle = mActiveSensors.keyAt(i);
 428                 result.appendFormat("%s (handle=0x%08x, connections=%zu)\n",
 429                         getSensorName(handle).string(),
 430                         handle,
 431                         mActiveSensors.valueAt(i)->getNumConnections());
 432             }
 433
 434             result.appendFormat("Socket Buffer size = %zd events\n",
 435                                 mSocketBufferSize/sizeof(sensors_event_t));
 436             result.appendFormat("WakeLock Status: %s \n", mWakeLockAcquired ? "acquired" :
 437                     "not held");
 438             result.appendFormat("Mode :");
 439             switch(mCurrentOperatingMode) {
 440                case NORMAL:
 441                    result.appendFormat(" NORMAL\n");
 442                    break;
 443                case RESTRICTED:
 444                    result.appendFormat(" RESTRICTED : %s\n", mWhiteListedPackage.string());
 445                    break;
 446                case DATA_INJECTION:
 447                    result.appendFormat(" DATA_INJECTION : %s\n", mWhiteListedPackage.string());
 448             }
 449
 450             result.appendFormat("%zd active connections\n", mActiveConnections.size());
 451             for (size_t i=0 ; i < mActiveConnections.size() ; i++) {
 452                 sp<SensorEventConnection> connection(mActiveConnections[i].promote());
 453                 if (connection != 0) {
 454                     result.appendFormat("Connection Number: %zu \n", i);
 455                     connection->dump(result);
 456                 }
 457             }
 458
 459             result.appendFormat("%zd direct connections\n", mDirectConnections.size());
 460             for (size_t i = 0 ; i < mDirectConnections.size() ; i++) {
 461                 sp<SensorDirectConnection> connection(mDirectConnections[i].promote());
 462                 if (connection != nullptr) {
 463                     result.appendFormat("Direct connection %zu:\n", i);
 464                     connection->dump(result);
 465                 }
 466             }
 467
 468             result.appendFormat("Previous Registrations:\n");
 469             // Log in the reverse chronological order.
 470             int currentIndex = (mNextSensorRegIndex - 1 + SENSOR_REGISTRATIONS_BUF_SIZE) %
 471                 SENSOR_REGISTRATIONS_BUF_SIZE;
 472             const int startIndex = currentIndex;
 473             do {
 474                 const SensorRegistrationInfo& reg_info = mLastNSensorRegistrations[currentIndex];
 475                 if (SensorRegistrationInfo::isSentinel(reg_info)) {
 476                     // Ignore sentinel, proceed to next item.
 477                     currentIndex = (currentIndex - 1 + SENSOR_REGISTRATIONS_BUF_SIZE) %
 478                         SENSOR_REGISTRATIONS_BUF_SIZE;
 479                     continue;
 480                 }
 481                 result.appendFormat("%s\n", reg_info.dump().c_str());
 482                 currentIndex = (currentIndex - 1 + SENSOR_REGISTRATIONS_BUF_SIZE) %
 483                         SENSOR_REGISTRATIONS_BUF_SIZE;
 484             } while(startIndex != currentIndex);
 485         }
 486     }
 487     write(fd, result.string(), result.size());
 488     return NO_ERROR;
 489 }
 490
 491 //TODO: move to SensorEventConnection later
 492 void SensorService::cleanupAutoDisabledSensorLocked(const sp<SensorEventConnection>& connection,
 493         sensors_event_t const* buffer, const int count) {
 494     for (int i=0 ; i<count ; i++) {
 495         int handle = buffer[i].sensor;
 496         if (buffer[i].type == SENSOR_TYPE_META_DATA) {
 497             handle = buffer[i].meta_data.sensor;
 498         }
 499         if (connection->hasSensor(handle)) {
 500             sp<SensorInterface> si = getSensorInterfaceFromHandle(handle);
 501             // If this buffer has an event from a one_shot sensor and this connection is registered
 502             // for this particular one_shot sensor, try cleaning up the connection.
 503             if (si != nullptr &&
 504                 si->getSensor().getReportingMode() == AREPORTING_MODE_ONE_SHOT) {
 505                 si->autoDisable(connection.get(), handle);
 506                 cleanupWithoutDisableLocked(connection, handle);
 507             }
 508
 509         }
 510    }
 511 }
 512
 513 bool SensorService::threadLoop() {
 514     ALOGD("nuSensorService thread starting...");
 515
 516     // each virtual sensor could generate an event per "real" event, that's why we need to size
 517     // numEventMax much smaller than MAX_RECEIVE_BUFFER_EVENT_COUNT.  in practice, this is too
 518     // aggressive, but guaranteed to be enough.
 519     const size_t vcount = mSensors.getVirtualSensors().size();
 520     const size_t minBufferSize = SensorEventQueue::MAX_RECEIVE_BUFFER_EVENT_COUNT;
 521     const size_t numEventMax = minBufferSize / (1 + vcount);
 522
 523     SensorDevice& device(SensorDevice::getInstance());
 524
 525     const int halVersion = device.getHalDeviceVersion();
 526     do {
 527         ssize_t count = device.poll(mSensorEventBuffer, numEventMax);
 528         if (count < 0) {
 529             ALOGE("sensor poll failed (%s)", strerror(-count));
 530             break;
 531         }
 532
 533         // Reset sensors_event_t.flags to zero for all events in the buffer.
 534         for (int i = 0; i < count; i++) {
 535              mSensorEventBuffer[i].flags = 0;
 536         }
 537
 538         // Make a copy of the connection vector as some connections may be removed during the course
 539         // of this loop (especially when one-shot sensor events are present in the sensor_event
 540         // buffer). Promote all connections to StrongPointers before the lock is acquired. If the
 541         // destructor of the sp gets called when the lock is acquired, it may result in a deadlock
 542         // as ~SensorEventConnection() needs to acquire mLock again for cleanup. So copy all the
 543         // strongPointers to a vector before the lock is acquired.
 544         SortedVector< sp<SensorEventConnection> > activeConnections;
 545         populateActiveConnections(&activeConnections);
 546
 547         Mutex::Autolock _l(mLock);
 548         // Poll has returned. Hold a wakelock if one of the events is from a wake up sensor. The
 549         // rest of this loop is under a critical section protected by mLock. Acquiring a wakeLock,
 550         // sending events to clients (incrementing SensorEventConnection::mWakeLockRefCount) should
 551         // not be interleaved with decrementing SensorEventConnection::mWakeLockRefCount and
 552         // releasing the wakelock.
 553         bool bufferHasWakeUpEvent = false;
 554         for (int i = 0; i < count; i++) {
 555             if (isWakeUpSensorEvent(mSensorEventBuffer[i])) {
 556                 bufferHasWakeUpEvent = true;
 557                 break;
 558             }
 559         }
 560
 561         if (bufferHasWakeUpEvent && !mWakeLockAcquired) {
 562             setWakeLockAcquiredLocked(true);
 563         }
 564         recordLastValueLocked(mSensorEventBuffer, count);
 565
 566         // handle virtual sensors
 567         if (count && vcount) {
 568             sensors_event_t const * const event = mSensorEventBuffer;
 569             if (!mActiveVirtualSensors.empty()) {
 570                 size_t k = 0;
 571                 SensorFusion& fusion(SensorFusion::getInstance());
 572                 if (fusion.isEnabled()) {
 573                     for (size_t i=0 ; i<size_t(count) ; i++) {
 574                         fusion.process(event[i]);
 575                     }
 576                 }
 577                 for (size_t i=0 ; i<size_t(count) && k<minBufferSize ; i++) {
 578                     for (int handle : mActiveVirtualSensors) {
 579                         if (count + k >= minBufferSize) {
 580                             ALOGE("buffer too small to hold all events: "
 581                                     "count=%zd, k=%zu, size=%zu",
 582                                     count, k, minBufferSize);
 583                             break;
 584                         }
 585                         sensors_event_t out;
 586                         sp<SensorInterface> si = mSensors.getInterface(handle);
 587                         if (si == nullptr) {
 588                             ALOGE("handle %d is not an valid virtual sensor", handle);
 589                             continue;
 590                         }
 591
 592                         if (si->process(&out, event[i])) {
 593                             mSensorEventBuffer[count + k] = out;
 594                             k++;
 595                         }
 596                     }
 597                 }
 598                 if (k) {
 599                     // record the last synthesized values
 600                     recordLastValueLocked(&mSensorEventBuffer[count], k);
 601                     count += k;
 602                     // sort the buffer by time-stamps
 603                     sortEventBuffer(mSensorEventBuffer, count);
 604                 }
 605             }
 606         }
 607
 608         // handle backward compatibility for RotationVector sensor
 609         if (halVersion < SENSORS_DEVICE_API_VERSION_1_0) {
 610             for (int i = 0; i < count; i++) {
 611                 if (mSensorEventBuffer[i].type == SENSOR_TYPE_ROTATION_VECTOR) {
 612                     // All the 4 components of the quaternion should be available
 613                     // No heading accuracy. Set it to -1
 614                     mSensorEventBuffer[i].data[4] = -1;
 615                 }
 616             }
 617         }
 618
 619         for (int i = 0; i < count; ++i) {
 620             // Map flush_complete_events in the buffer to SensorEventConnections which called flush
 621             // on the hardware sensor. mapFlushEventsToConnections[i] will be the
 622             // SensorEventConnection mapped to the corresponding flush_complete_event in
 623             // mSensorEventBuffer[i] if such a mapping exists (NULL otherwise).
 624             mMapFlushEventsToConnections[i] = NULL;
 625             if (mSensorEventBuffer[i].type == SENSOR_TYPE_META_DATA) {
 626                 const int sensor_handle = mSensorEventBuffer[i].meta_data.sensor;
 627                 SensorRecord* rec = mActiveSensors.valueFor(sensor_handle);
 628                 if (rec != NULL) {
 629                     mMapFlushEventsToConnections[i] = rec->getFirstPendingFlushConnection();
 630                     rec->removeFirstPendingFlushConnection();
 631                 }
 632             }
 633
 634             // handle dynamic sensor meta events, process registration and unregistration of dynamic
 635             // sensor based on content of event.
 636             if (mSensorEventBuffer[i].type == SENSOR_TYPE_DYNAMIC_SENSOR_META) {
 637                 if (mSensorEventBuffer[i].dynamic_sensor_meta.connected) {
 638                     int handle = mSensorEventBuffer[i].dynamic_sensor_meta.handle;
 639                     const sensor_t& dynamicSensor =
 640                             *(mSensorEventBuffer[i].dynamic_sensor_meta.sensor);
 641                     ALOGI("Dynamic sensor handle 0x%x connected, type %d, name %s",
 642                           handle, dynamicSensor.type, dynamicSensor.name);
 643
 644                     if (mSensors.isNewHandle(handle)) {
 645                         const auto& uuid = mSensorEventBuffer[i].dynamic_sensor_meta.uuid;
 646                         sensor_t s = dynamicSensor;
 647                         // make sure the dynamic sensor flag is set
 648                         s.flags |= DYNAMIC_SENSOR_MASK;
 649                         // force the handle to be consistent
 650                         s.handle = handle;
 651
 652                         SensorInterface *si = new HardwareSensor(s, uuid);
 653
 654                         // This will release hold on dynamic sensor meta, so it should be called
 655                         // after Sensor object is created.
 656                         device.handleDynamicSensorConnection(handle, true /*connected*/);
 657                         registerDynamicSensorLocked(si);
 658                     } else {
 659                         ALOGE("Handle %d has been used, cannot use again before reboot.", handle);
 660                     }
 661                 } else {
 662                     int handle = mSensorEventBuffer[i].dynamic_sensor_meta.handle;
 663                     ALOGI("Dynamic sensor handle 0x%x disconnected", handle);
 664
 665                     device.handleDynamicSensorConnection(handle, false /*connected*/);
 666                     if (!unregisterDynamicSensorLocked(handle)) {
 667                         ALOGE("Dynamic sensor release error.");
 668                     }
 669
 670                     size_t numConnections = activeConnections.size();
 671                     for (size_t i=0 ; i < numConnections; ++i) {
 672                         if (activeConnections[i] != NULL) {
 673                             activeConnections[i]->removeSensor(handle);
 674                         }
 675                     }
 676                 }
 677             }
 678         }
 679
 680
 681         // Send our events to clients. Check the state of wake lock for each client and release the
 682         // lock if none of the clients need it.
 683         bool needsWakeLock = false;
 684         size_t numConnections = activeConnections.size();
 685         for (size_t i=0 ; i < numConnections; ++i) {
 686             if (activeConnections[i] != 0) {
 687                 activeConnections[i]->sendEvents(mSensorEventBuffer, count, mSensorEventScratch,
 688                         mMapFlushEventsToConnections);
 689                 needsWakeLock |= activeConnections[i]->needsWakeLock();
 690                 // If the connection has one-shot sensors, it may be cleaned up after first trigger.
 691                 // Early check for one-shot sensors.
 692                 if (activeConnections[i]->hasOneShotSensors()) {
 693                     cleanupAutoDisabledSensorLocked(activeConnections[i], mSensorEventBuffer,
 694                             count);
 695                 }
 696             }
 697         }
 698
 699         if (mWakeLockAcquired && !needsWakeLock) {
 700             setWakeLockAcquiredLocked(false);
 701         }
 702     } while (!Thread::exitPending());
 703
 704     ALOGW("Exiting SensorService::threadLoop => aborting...");
 705     abort();
 706     return false;
 707 }
 708
 709 sp<Looper> SensorService::getLooper() const {
 710     return mLooper;
 711 }
 712
 713 void SensorService::resetAllWakeLockRefCounts() {
 714     SortedVector< sp<SensorEventConnection> > activeConnections;
 715     populateActiveConnections(&activeConnections);
 716     {
 717         Mutex::Autolock _l(mLock);
 718         for (size_t i=0 ; i < activeConnections.size(); ++i) {
 719             if (activeConnections[i] != 0) {
 720                 activeConnections[i]->resetWakeLockRefCount();
 721             }
 722         }
 723         setWakeLockAcquiredLocked(false);
 724     }
 725 }
 726
 727 void SensorService::setWakeLockAcquiredLocked(bool acquire) {
 728     if (acquire) {
 729         if (!mWakeLockAcquired) {
 730             acquire_wake_lock(PARTIAL_WAKE_LOCK, WAKE_LOCK_NAME);
 731             mWakeLockAcquired = true;
 732         }
 733         mLooper->wake();
 734     } else {
 735         if (mWakeLockAcquired) {
 736             release_wake_lock(WAKE_LOCK_NAME);
 737             mWakeLockAcquired = false;
 738         }
 739     }
 740 }
 741
 742 bool SensorService::isWakeLockAcquired() {
 743     Mutex::Autolock _l(mLock);
 744     return mWakeLockAcquired;
 745 }
 746
 747 bool SensorService::SensorEventAckReceiver::threadLoop() {
 748     ALOGD("new thread SensorEventAckReceiver");
 749     sp<Looper> looper = mService->getLooper();
 750     do {
 751         bool wakeLockAcquired = mService->isWakeLockAcquired();
 752         int timeout = -1;
 753         if (wakeLockAcquired) timeout = 5000;
 754         int ret = looper->pollOnce(timeout);
 755         if (ret == ALOOPER_POLL_TIMEOUT) {
 756            mService->resetAllWakeLockRefCounts();
 757         }
 758     } while(!Thread::exitPending());
 759     return false;
 760 }
 761
 762 void SensorService::recordLastValueLocked(
 763         const sensors_event_t* buffer, size_t count) {
 764     for (size_t i = 0; i < count; i++) {
 765         if (buffer[i].type == SENSOR_TYPE_META_DATA ||
 766             buffer[i].type == SENSOR_TYPE_DYNAMIC_SENSOR_META ||
 767             buffer[i].type == SENSOR_TYPE_ADDITIONAL_INFO) {
 768             continue;
 769         }
 770
 771         auto logger = mRecentEvent.find(buffer[i].sensor);
 772         if (logger != mRecentEvent.end()) {
 773             logger->second->addEvent(buffer[i]);
 774         }
 775     }
 776 }
 777
 778 void SensorService::sortEventBuffer(sensors_event_t* buffer, size_t count) {
 779     struct compar {
 780         static int cmp(void const* lhs, void const* rhs) {
 781             sensors_event_t const* l = static_cast<sensors_event_t const*>(lhs);
 782             sensors_event_t const* r = static_cast<sensors_event_t const*>(rhs);
 783             return l->timestamp - r->timestamp;
 784         }
 785     };
 786     qsort(buffer, count, sizeof(sensors_event_t), compar::cmp);
 787 }
 788
 789 String8 SensorService::getSensorName(int handle) const {
 790     return mSensors.getName(handle);
 791 }
 792
 793 bool SensorService::isVirtualSensor(int handle) const {
 794     sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
 795     return sensor != nullptr && sensor->isVirtual();
 796 }
 797
 798 bool SensorService::isWakeUpSensorEvent(const sensors_event_t& event) const {
 799     int handle = event.sensor;
 800     if (event.type == SENSOR_TYPE_META_DATA) {
 801         handle = event.meta_data.sensor;
 802     }
 803     sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
 804     return sensor != nullptr && sensor->getSensor().isWakeUpSensor();
 805 }
 806
 807 int32_t SensorService::getIdFromUuid(const Sensor::uuid_t &uuid) const {
 808     if ((uuid.i64[0] == 0) && (uuid.i64[1] == 0)) {
 809         // UUID is not supported for this device.
 810         return 0;
 811     }
 812     if ((uuid.i64[0] == INT64_C(~0)) && (uuid.i64[1] == INT64_C(~0))) {
 813         // This sensor can be uniquely identified in the system by
 814         // the combination of its type and name.
 815         return -1;
 816     }
 817
 818     // We have a dynamic sensor.
 819
 820     if (!sHmacGlobalKeyIsValid) {
 821         // Rather than risk exposing UUIDs, we cripple dynamic sensors.
 822         ALOGW("HMAC key failure; dynamic sensor getId() will be wrong.");
 823         return 0;
 824     }
 825
 826     // We want each app author/publisher to get a different ID, so that the
 827     // same dynamic sensor cannot be tracked across apps by multiple
 828     // authors/publishers.  So we use both our UUID and our User ID.
 829     // Note potential confusion:
 830     //     UUID => Universally Unique Identifier.
 831     //     UID  => User Identifier.
 832     // We refrain from using "uid" except as needed by API to try to
 833     // keep this distinction clear.
 834
 835     auto appUserId = IPCThreadState::self()->getCallingUid();
 836     uint8_t uuidAndApp[sizeof(uuid) + sizeof(appUserId)];
 837     memcpy(uuidAndApp, &uuid, sizeof(uuid));
 838     memcpy(uuidAndApp + sizeof(uuid), &appUserId, sizeof(appUserId));
 839
 840     // Now we use our key on our UUID/app combo to get the hash.
 841     uint8_t hash[EVP_MAX_MD_SIZE];
 842     unsigned int hashLen;
 843     if (HMAC(EVP_sha256(),
 844              sHmacGlobalKey, sizeof(sHmacGlobalKey),
 845              uuidAndApp, sizeof(uuidAndApp),
 846              hash, &hashLen) == nullptr) {
 847         // Rather than risk exposing UUIDs, we cripple dynamic sensors.
 848         ALOGW("HMAC failure; dynamic sensor getId() will be wrong.");
 849         return 0;
 850     }
 851
 852     int32_t id = 0;
 853     if (hashLen < sizeof(id)) {
 854         // We never expect this case, but out of paranoia, we handle it.
 855         // Our 'id' length is already quite small, we don't want the
 856         // effective length of it to be even smaller.
 857         // Rather than risk exposing UUIDs, we cripple dynamic sensors.
 858         ALOGW("HMAC insufficient; dynamic sensor getId() will be wrong.");
 859         return 0;
 860     }
 861
 862     // This is almost certainly less than all of 'hash', but it's as secure
 863     // as we can be with our current 'id' length.
 864     memcpy(&id, hash, sizeof(id));
 865
 866     // Note at the beginning of the function that we return the values of
 867     // 0 and -1 to represent special cases.  As a result, we can't return
 868     // those as dynamic sensor IDs.  If we happened to hash to one of those
 869     // values, we change 'id' so we report as a dynamic sensor, and not as
 870     // one of those special cases.
 871     if (id == -1) {
 872         id = -2;
 873     } else if (id == 0) {
 874         id = 1;
 875     }
 876     return id;
 877 }
 878
 879 void SensorService::makeUuidsIntoIdsForSensorList(Vector<Sensor> &sensorList) const {
 880     for (auto &sensor : sensorList) {
 881         int32_t id = getIdFromUuid(sensor.getUuid());
 882         sensor.setId(id);
 883     }
 884 }
 885
 886 Vector<Sensor> SensorService::getSensorList(const String16& /* opPackageName */) {
 887     char value[PROPERTY_VALUE_MAX];
 888     property_get("debug.sensors", value, "0");
 889     const Vector<Sensor>& initialSensorList = (atoi(value)) ?
 890             mSensors.getUserDebugSensors() : mSensors.getUserSensors();
 891     Vector<Sensor> accessibleSensorList;
 892     for (size_t i = 0; i < initialSensorList.size(); i++) {
 893         Sensor sensor = initialSensorList[i];
 894         accessibleSensorList.add(sensor);
 895     }
 896     makeUuidsIntoIdsForSensorList(accessibleSensorList);
 897     return accessibleSensorList;
 898 }
 899
 900 Vector<Sensor> SensorService::getDynamicSensorList(const String16& opPackageName) {
 901     Vector<Sensor> accessibleSensorList;
 902     mSensors.forEachSensor(
 903             [&opPackageName, &accessibleSensorList] (const Sensor& sensor) -> bool {
 904                 if (sensor.isDynamicSensor()) {
 905                     if (canAccessSensor(sensor, "getDynamicSensorList", opPackageName)) {
 906                         accessibleSensorList.add(sensor);
 907                     } else {
 908                         ALOGI("Skipped sensor %s because it requires permission %s and app op %" PRId32,
 909                               sensor.getName().string(),
 910                               sensor.getRequiredPermission().string(),
 911                               sensor.getRequiredAppOp());
 912                     }
 913                 }
 914                 return true;
 915             });
 916     makeUuidsIntoIdsForSensorList(accessibleSensorList);
 917     return accessibleSensorList;
 918 }
 919
 920 sp<ISensorEventConnection> SensorService::createSensorEventConnection(const String8& packageName,
 921         int requestedMode, const String16& opPackageName) {
 922     // Only 2 modes supported for a SensorEventConnection ... NORMAL and DATA_INJECTION.
 923     if (requestedMode != NORMAL && requestedMode != DATA_INJECTION) {
 924         return NULL;
 925     }
 926
 927     Mutex::Autolock _l(mLock);
 928     // To create a client in DATA_INJECTION mode to inject data, SensorService should already be
 929     // operating in DI mode.
 930     if (requestedMode == DATA_INJECTION) {
 931         if (mCurrentOperatingMode != DATA_INJECTION) return NULL;
 932         if (!isWhiteListedPackage(packageName)) return NULL;
 933     }
 934
 935     uid_t uid = IPCThreadState::self()->getCallingUid();
 936     sp<SensorEventConnection> result(new SensorEventConnection(this, uid, packageName,
 937             requestedMode == DATA_INJECTION, opPackageName));
 938     if (requestedMode == DATA_INJECTION) {
 939         if (mActiveConnections.indexOf(result) < 0) {
 940             mActiveConnections.add(result);
 941         }
 942         // Add the associated file descriptor to the Looper for polling whenever there is data to
 943         // be injected.
 944         result->updateLooperRegistration(mLooper);
 945     }
 946     return result;
 947 }
 948
 949 int SensorService::isDataInjectionEnabled() {
 950     Mutex::Autolock _l(mLock);
 951     return (mCurrentOperatingMode == DATA_INJECTION);
 952 }
 953
 954 sp<ISensorEventConnection> SensorService::createSensorDirectConnection(
 955         const String16& opPackageName, uint32_t size, int32_t type, int32_t format,
 956         const native_handle *resource) {
 957     Mutex::Autolock _l(mLock);
 958
 959     struct sensors_direct_mem_t mem = {
 960         .type = type,
 961         .format = format,
 962         .size = size,
 963         .handle = resource,
 964     };
 965     uid_t uid = IPCThreadState::self()->getCallingUid();
 966
 967     if (mem.handle == nullptr) {
 968         ALOGE("Failed to clone resource handle");
 969         return nullptr;
 970     }
 971
 972     // check format
 973     if (format != SENSOR_DIRECT_FMT_SENSORS_EVENT) {
 974         ALOGE("Direct channel format %d is unsupported!", format);
 975         return nullptr;
 976     }
 977
 978     // check for duplication
 979     for (auto &i : mDirectConnections) {
 980         sp<SensorDirectConnection> connection(i.promote());
 981         if (connection != nullptr && connection->isEquivalent(&mem)) {
 982             ALOGE("Duplicate create channel request for the same share memory");
 983             return nullptr;
 984         }
 985     }
 986
 987     // check specific to memory type
 988     switch(type) {
 989         case SENSOR_DIRECT_MEM_TYPE_ASHMEM: { // channel backed by ashmem
 990             int fd = resource->data[0];
 991             int size2 = ashmem_get_size_region(fd);
 992             // check size consistency
 993             if (size2 < static_cast<int>(size)) {
 994                 ALOGE("Ashmem direct channel size %" PRIu32 " greater than shared memory size %d",
 995                       size, size2);
 996                 return nullptr;
 997             }
 998             break;
 999         }
1000         case SENSOR_DIRECT_MEM_TYPE_GRALLOC:
1001             // no specific checks for gralloc
1002             break;
1003         default:
1004             ALOGE("Unknown direct connection memory type %d", type);
1005             return nullptr;
1006     }
1007
1008     native_handle_t *clone = native_handle_clone(resource);
1009     if (!clone) {
1010         return nullptr;
1011     }
1012
1013     SensorDirectConnection* conn = nullptr;
1014     SensorDevice& dev(SensorDevice::getInstance());
1015     int channelHandle = dev.registerDirectChannel(&mem);
1016
1017     if (channelHandle <= 0) {
1018         ALOGE("SensorDevice::registerDirectChannel returns %d", channelHandle);
1019     } else {
1020         mem.handle = clone;
1021         conn = new SensorDirectConnection(this, uid, &mem, channelHandle, opPackageName);
1022     }
1023
1024     if (conn == nullptr) {
1025         native_handle_close(clone);
1026         native_handle_delete(clone);
1027     } else {
1028         // add to list of direct connections
1029         // sensor service should never hold pointer or sp of SensorDirectConnection object.
1030         mDirectConnections.add(wp<SensorDirectConnection>(conn));
1031     }
1032     return conn;
1033 }
1034
1035 int SensorService::setOperationParameter(
1036             int32_t handle, int32_t type,
1037             const Vector<float> &floats, const Vector<int32_t> &ints) {
1038     Mutex::Autolock _l(mLock);
1039
1040     if (!checkCallingPermission(sLocationHardwarePermission, nullptr, nullptr)) {
1041         return PERMISSION_DENIED;
1042     }
1043
1044     bool isFloat = true;
1045     bool isCustom = false;
1046     size_t expectSize = INT32_MAX;
1047     switch (type) {
1048         case AINFO_LOCAL_GEOMAGNETIC_FIELD:
1049             isFloat = true;
1050             expectSize = 3;
1051             break;
1052         case AINFO_LOCAL_GRAVITY:
1053             isFloat = true;
1054             expectSize = 1;
1055             break;
1056         case AINFO_DOCK_STATE:
1057         case AINFO_HIGH_PERFORMANCE_MODE:
1058         case AINFO_MAGNETIC_FIELD_CALIBRATION:
1059             isFloat = false;
1060             expectSize = 1;
1061             break;
1062         default:
1063             // CUSTOM events must only contain float data; it may have variable size
1064             if (type < AINFO_CUSTOM_START || type >= AINFO_DEBUGGING_START ||
1065                     ints.size() ||
1066                     sizeof(additional_info_event_t::data_float)/sizeof(float) < floats.size() ||
1067                     handle < 0) {
1068                 return BAD_VALUE;
1069             }
1070             isFloat = true;
1071             isCustom = true;
1072             expectSize = floats.size();
1073             break;
1074     }
1075
1076     if (!isCustom && handle != -1) {
1077         return BAD_VALUE;
1078     }
1079
1080     // three events: first one is begin tag, last one is end tag, the one in the middle
1081     // is the payload.
1082     sensors_event_t event[3];
1083     int64_t timestamp = elapsedRealtimeNano();
1084     for (sensors_event_t* i = event; i < event + 3; i++) {
1085         *i = (sensors_event_t) {
1086             .version = sizeof(sensors_event_t),
1087             .sensor = handle,
1088             .type = SENSOR_TYPE_ADDITIONAL_INFO,
1089             .timestamp = timestamp++,
1090             .additional_info = (additional_info_event_t) {
1091                 .serial = 0
1092             }
1093         };
1094     }
1095
1096     event[0].additional_info.type = AINFO_BEGIN;
1097     event[1].additional_info.type = type;
1098     event[2].additional_info.type = AINFO_END;
1099
1100     if (isFloat) {
1101         if (floats.size() != expectSize) {
1102             return BAD_VALUE;
1103         }
1104         for (size_t i = 0; i < expectSize; ++i) {
1105             event[1].additional_info.data_float[i] = floats[i];
1106         }
1107     } else {
1108         if (ints.size() != expectSize) {
1109             return BAD_VALUE;
1110         }
1111         for (size_t i = 0; i < expectSize; ++i) {
1112             event[1].additional_info.data_int32[i] = ints[i];
1113         }
1114     }
1115
1116     SensorDevice& dev(SensorDevice::getInstance());
1117     for (sensors_event_t* i = event; i < event + 3; i++) {
1118         int ret = dev.injectSensorData(i);
1119         if (ret != NO_ERROR) {
1120             return ret;
1121         }
1122     }
1123     return NO_ERROR;
1124 }
1125
1126 status_t SensorService::resetToNormalMode() {
1127     Mutex::Autolock _l(mLock);
1128     return resetToNormalModeLocked();
1129 }
1130
1131 status_t SensorService::resetToNormalModeLocked() {
1132     SensorDevice& dev(SensorDevice::getInstance());
1133     status_t err = dev.setMode(NORMAL);
1134     if (err == NO_ERROR) {
1135         mCurrentOperatingMode = NORMAL;
1136         dev.enableAllSensors();
1137     }
1138     return err;
1139 }
1140
1141 void SensorService::cleanupConnection(SensorEventConnection* c) {
1142     Mutex::Autolock _l(mLock);
1143     const wp<SensorEventConnection> connection(c);
1144     size_t size = mActiveSensors.size();
1145     ALOGD_IF(DEBUG_CONNECTIONS, "%zu active sensors", size);
1146     for (size_t i=0 ; i<size ; ) {
1147         int handle = mActiveSensors.keyAt(i);
1148         if (c->hasSensor(handle)) {
1149             ALOGD_IF(DEBUG_CONNECTIONS, "%zu: disabling handle=0x%08x", i, handle);
1150             sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
1151             if (sensor != nullptr) {
1152                 sensor->activate(c, false);
1153             } else {
1154                 ALOGE("sensor interface of handle=0x%08x is null!", handle);
1155             }
1156             c->removeSensor(handle);
1157         }
1158         SensorRecord* rec = mActiveSensors.valueAt(i);
1159         ALOGE_IF(!rec, "mActiveSensors[%zu] is null (handle=0x%08x)!", i, handle);
1160         ALOGD_IF(DEBUG_CONNECTIONS,
1161                 "removing connection %p for sensor[%zu].handle=0x%08x",
1162                 c, i, handle);
1163
1164         if (rec && rec->removeConnection(connection)) {
1165             ALOGD_IF(DEBUG_CONNECTIONS, "... and it was the last connection");
1166             mActiveSensors.removeItemsAt(i, 1);
1167             mActiveVirtualSensors.erase(handle);
1168             delete rec;
1169             size--;
1170         } else {
1171             i++;
1172         }
1173     }
1174     c->updateLooperRegistration(mLooper);
1175     mActiveConnections.remove(connection);
1176     BatteryService::cleanup(c->getUid());
1177     if (c->needsWakeLock()) {
1178         checkWakeLockStateLocked();
1179     }
1180
1181     SensorDevice& dev(SensorDevice::getInstance());
1182     dev.notifyConnectionDestroyed(c);
1183 }
1184
1185 void SensorService::cleanupConnection(SensorDirectConnection* c) {
1186     Mutex::Autolock _l(mLock);
1187
1188     SensorDevice& dev(SensorDevice::getInstance());
1189     dev.unregisterDirectChannel(c->getHalChannelHandle());
1190     mDirectConnections.remove(c);
1191 }
1192
1193 sp<SensorInterface> SensorService::getSensorInterfaceFromHandle(int handle) const {
1194     return mSensors.getInterface(handle);
1195 }
1196
1197 status_t SensorService::enable(const sp<SensorEventConnection>& connection,
1198         int handle, nsecs_t samplingPeriodNs, nsecs_t maxBatchReportLatencyNs, int reservedFlags,
1199         const String16& opPackageName) {
1200     if (mInitCheck != NO_ERROR)
1201         return mInitCheck;
1202
1203     sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
1204     if (sensor == nullptr ||
1205         !canAccessSensor(sensor->getSensor(), "Tried enabling", opPackageName)) {
1206         return BAD_VALUE;
1207     }
1208
1209     Mutex::Autolock _l(mLock);
1210     if (mCurrentOperatingMode != NORMAL
1211            && !isWhiteListedPackage(connection->getPackageName())) {
1212         return INVALID_OPERATION;
1213     }
1214
1215     SensorRecord* rec = mActiveSensors.valueFor(handle);
1216     if (rec == 0) {
1217         rec = new SensorRecord(connection);
1218         mActiveSensors.add(handle, rec);
1219         if (sensor->isVirtual()) {
1220             mActiveVirtualSensors.emplace(handle);
1221         }
1222     } else {
1223         if (rec->addConnection(connection)) {
1224             // this sensor is already activated, but we are adding a connection that uses it.
1225             // Immediately send down the last known value of the requested sensor if it's not a
1226             // "continuous" sensor.
1227             if (sensor->getSensor().getReportingMode() == AREPORTING_MODE_ON_CHANGE) {
1228                 // NOTE: The wake_up flag of this event may get set to
1229                 // WAKE_UP_SENSOR_EVENT_NEEDS_ACK if this is a wake_up event.
1230
1231                 auto logger = mRecentEvent.find(handle);
1232                 if (logger != mRecentEvent.end()) {
1233                     sensors_event_t event;
1234                     // It is unlikely that this buffer is empty as the sensor is already active.
1235                     // One possible corner case may be two applications activating an on-change
1236                     // sensor at the same time.
1237                     if(logger->second->populateLastEvent(&event)) {
1238                         event.sensor = handle;
1239                         if (event.version == sizeof(sensors_event_t)) {
1240                             if (isWakeUpSensorEvent(event) && !mWakeLockAcquired) {
1241                                 setWakeLockAcquiredLocked(true);
1242                             }
1243                             connection->sendEvents(&event, 1, NULL);
1244                             if (!connection->needsWakeLock() && mWakeLockAcquired) {
1245                                 checkWakeLockStateLocked();
1246                             }
1247                         }
1248                     }
1249                 }
1250             }
1251         }
1252     }
1253
1254     if (connection->addSensor(handle)) {
1255         BatteryService::enableSensor(connection->getUid(), handle);
1256         // the sensor was added (which means it wasn't already there)
1257         // so, see if this connection becomes active
1258         if (mActiveConnections.indexOf(connection) < 0) {
1259             mActiveConnections.add(connection);
1260         }
1261     } else {
1262         ALOGW("sensor %08x already enabled in connection %p (ignoring)",
1263             handle, connection.get());
1264     }
1265
1266     // Check maximum delay for the sensor.
1267     nsecs_t maxDelayNs = sensor->getSensor().getMaxDelay() * 1000LL;
1268     if (maxDelayNs > 0 && (samplingPeriodNs > maxDelayNs)) {
1269         samplingPeriodNs = maxDelayNs;
1270     }
1271
1272     nsecs_t minDelayNs = sensor->getSensor().getMinDelayNs();
1273     if (samplingPeriodNs < minDelayNs) {
1274         samplingPeriodNs = minDelayNs;
1275     }
1276
1277     ALOGD_IF(DEBUG_CONNECTIONS, "Calling batch handle==%d flags=%d"
1278                                 "rate=%" PRId64 " timeout== %" PRId64"",
1279              handle, reservedFlags, samplingPeriodNs, maxBatchReportLatencyNs);
1280
1281     status_t err = sensor->batch(connection.get(), handle, 0, samplingPeriodNs,
1282                                  maxBatchReportLatencyNs);
1283
1284     // Call flush() before calling activate() on the sensor. Wait for a first
1285     // flush complete event before sending events on this connection. Ignore
1286     // one-shot sensors which don't support flush(). Ignore on-change sensors
1287     // to maintain the on-change logic (any on-change events except the initial
1288     // one should be trigger by a change in value). Also if this sensor isn't
1289     // already active, don't call flush().
1290     if (err == NO_ERROR &&
1291             sensor->getSensor().getReportingMode() == AREPORTING_MODE_CONTINUOUS &&
1292             rec->getNumConnections() > 1) {
1293         connection->setFirstFlushPending(handle, true);
1294         status_t err_flush = sensor->flush(connection.get(), handle);
1295         // Flush may return error if the underlying h/w sensor uses an older HAL.
1296         if (err_flush == NO_ERROR) {
1297             rec->addPendingFlushConnection(connection.get());
1298         } else {
1299             connection->setFirstFlushPending(handle, false);
1300         }
1301     }
1302
1303     if (err == NO_ERROR) {
1304         ALOGD_IF(DEBUG_CONNECTIONS, "Calling activate on %d", handle);
1305         err = sensor->activate(connection.get(), true);
1306     }
1307
1308     if (err == NO_ERROR) {
1309         connection->updateLooperRegistration(mLooper);
1310
1311         mLastNSensorRegistrations.editItemAt(mNextSensorRegIndex) =
1312                 SensorRegistrationInfo(handle, connection->getPackageName(),
1313                                        samplingPeriodNs, maxBatchReportLatencyNs, true);
1314         mNextSensorRegIndex = (mNextSensorRegIndex + 1) % SENSOR_REGISTRATIONS_BUF_SIZE;
1315     }
1316
1317     if (err != NO_ERROR) {
1318         // batch/activate has failed, reset our state.
1319         cleanupWithoutDisableLocked(connection, handle);
1320     }
1321     return err;
1322 }
1323
1324 status_t SensorService::disable(const sp<SensorEventConnection>& connection, int handle) {
1325     if (mInitCheck != NO_ERROR)
1326         return mInitCheck;
1327
1328     Mutex::Autolock _l(mLock);
1329     status_t err = cleanupWithoutDisableLocked(connection, handle);
1330     if (err == NO_ERROR) {
1331         sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
1332         err = sensor != nullptr ? sensor->activate(connection.get(), false) : status_t(BAD_VALUE);
1333
1334     }
1335     if (err == NO_ERROR) {
1336         mLastNSensorRegistrations.editItemAt(mNextSensorRegIndex) =
1337                 SensorRegistrationInfo(handle, connection->getPackageName(), 0, 0, false);
1338         mNextSensorRegIndex = (mNextSensorRegIndex + 1) % SENSOR_REGISTRATIONS_BUF_SIZE;
1339     }
1340     return err;
1341 }
1342
1343 status_t SensorService::cleanupWithoutDisable(
1344         const sp<SensorEventConnection>& connection, int handle) {
1345     Mutex::Autolock _l(mLock);
1346     return cleanupWithoutDisableLocked(connection, handle);
1347 }
1348
1349 status_t SensorService::cleanupWithoutDisableLocked(
1350         const sp<SensorEventConnection>& connection, int handle) {
1351     SensorRecord* rec = mActiveSensors.valueFor(handle);
1352     if (rec) {
1353         // see if this connection becomes inactive
1354         if (connection->removeSensor(handle)) {
1355             BatteryService::disableSensor(connection->getUid(), handle);
1356         }
1357         if (connection->hasAnySensor() == false) {
1358             connection->updateLooperRegistration(mLooper);
1359             mActiveConnections.remove(connection);
1360         }
1361         // see if this sensor becomes inactive
1362         if (rec->removeConnection(connection)) {
1363             mActiveSensors.removeItem(handle);
1364             mActiveVirtualSensors.erase(handle);
1365             delete rec;
1366         }
1367         return NO_ERROR;
1368     }
1369     return BAD_VALUE;
1370 }
1371
1372 status_t SensorService::setEventRate(const sp<SensorEventConnection>& connection,
1373         int handle, nsecs_t ns, const String16& opPackageName) {
1374     if (mInitCheck != NO_ERROR)
1375         return mInitCheck;
1376
1377     sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
1378     if (sensor == nullptr ||
1379         !canAccessSensor(sensor->getSensor(), "Tried configuring", opPackageName)) {
1380         return BAD_VALUE;
1381     }
1382
1383     if (ns < 0)
1384         return BAD_VALUE;
1385
1386     nsecs_t minDelayNs = sensor->getSensor().getMinDelayNs();
1387     if (ns < minDelayNs) {
1388         ns = minDelayNs;
1389     }
1390
1391     return sensor->setDelay(connection.get(), handle, ns);
1392 }
1393
1394 status_t SensorService::flushSensor(const sp<SensorEventConnection>& connection,
1395         const String16& opPackageName) {
1396     if (mInitCheck != NO_ERROR) return mInitCheck;
1397     SensorDevice& dev(SensorDevice::getInstance());
1398     const int halVersion = dev.getHalDeviceVersion();
1399     status_t err(NO_ERROR);
1400     Mutex::Autolock _l(mLock);
1401     // Loop through all sensors for this connection and call flush on each of them.
1402     for (size_t i = 0; i < connection->mSensorInfo.size(); ++i) {
1403         const int handle = connection->mSensorInfo.keyAt(i);
1404         sp<SensorInterface> sensor = getSensorInterfaceFromHandle(handle);
1405         if (sensor == nullptr) {
1406             continue;
1407         }
1408         if (sensor->getSensor().getReportingMode() == AREPORTING_MODE_ONE_SHOT) {
1409             ALOGE("flush called on a one-shot sensor");
1410             err = INVALID_OPERATION;
1411             continue;
1412         }
1413         if (halVersion <= SENSORS_DEVICE_API_VERSION_1_0 || isVirtualSensor(handle)) {
1414             // For older devices just increment pending flush count which will send a trivial
1415             // flush complete event.
1416             connection->incrementPendingFlushCount(handle);
1417         } else {
1418             if (!canAccessSensor(sensor->getSensor(), "Tried flushing", opPackageName)) {
1419                 err = INVALID_OPERATION;
1420                 continue;
1421             }
1422             status_t err_flush = sensor->flush(connection.get(), handle);
1423             if (err_flush == NO_ERROR) {
1424                 SensorRecord* rec = mActiveSensors.valueFor(handle);
1425                 if (rec != NULL) rec->addPendingFlushConnection(connection);
1426             }
1427             err = (err_flush != NO_ERROR) ? err_flush : err;
1428         }
1429     }
1430     return err;
1431 }
1432
1433 bool SensorService::canAccessSensor(const Sensor& sensor, const char* operation,
1434         const String16& opPackageName) {
1435     const String8& requiredPermission = sensor.getRequiredPermission();
1436
1437     if (requiredPermission.length() <= 0) {
1438         return true;
1439     }
1440
1441     bool hasPermission = false;
1442
1443     // Runtime permissions can't use the cache as they may change.
1444     if (sensor.isRequiredPermissionRuntime()) {
1445         hasPermission = checkPermission(String16(requiredPermission),
1446                 IPCThreadState::self()->getCallingPid(), IPCThreadState::self()->getCallingUid());
1447     } else {
1448         hasPermission = PermissionCache::checkCallingPermission(String16(requiredPermission));
1449     }
1450
1451     if (!hasPermission) {
1452         ALOGE("%s a sensor (%s) without holding its required permission: %s",
1453                 operation, sensor.getName().string(), sensor.getRequiredPermission().string());
1454         return false;
1455     }
1456
1457     const int32_t opCode = sensor.getRequiredAppOp();
1458     if (opCode >= 0) {
1459         AppOpsManager appOps;
1460         if (appOps.noteOp(opCode, IPCThreadState::self()->getCallingUid(), opPackageName)
1461                         != AppOpsManager::MODE_ALLOWED) {
1462             ALOGE("%s a sensor (%s) without enabled required app op: %d",
1463                     operation, sensor.getName().string(), opCode);
1464             return false;
1465         }
1466     }
1467
1468     return true;
1469 }
1470
1471 void SensorService::checkWakeLockState() {
1472     Mutex::Autolock _l(mLock);
1473     checkWakeLockStateLocked();
1474 }
1475
1476 void SensorService::checkWakeLockStateLocked() {
1477     if (!mWakeLockAcquired) {
1478         return;
1479     }
1480     bool releaseLock = true;
1481     for (size_t i=0 ; i<mActiveConnections.size() ; i++) {
1482         sp<SensorEventConnection> connection(mActiveConnections[i].promote());
1483         if (connection != 0) {
1484             if (connection->needsWakeLock()) {
1485                 releaseLock = false;
1486                 break;
1487             }
1488         }
1489     }
1490     if (releaseLock) {
1491         setWakeLockAcquiredLocked(false);
1492     }
1493 }
1494
1495 void SensorService::sendEventsFromCache(const sp<SensorEventConnection>& connection) {
1496     Mutex::Autolock _l(mLock);
1497     connection->writeToSocketFromCache();
1498     if (connection->needsWakeLock()) {
1499         setWakeLockAcquiredLocked(true);
1500     }
1501 }
1502
1503 void SensorService::populateActiveConnections(
1504         SortedVector< sp<SensorEventConnection> >* activeConnections) {
1505     Mutex::Autolock _l(mLock);
1506     for (size_t i=0 ; i < mActiveConnections.size(); ++i) {
1507         sp<SensorEventConnection> connection(mActiveConnections[i].promote());
1508         if (connection != 0) {
1509             activeConnections->add(connection);
1510         }
1511     }
1512 }
1513
1514 bool SensorService::isWhiteListedPackage(const String8& packageName) {
1515     return (packageName.contains(mWhiteListedPackage.string()));
1516 }
1517
1518 bool SensorService::isOperationRestricted(const String16& opPackageName) {
1519     Mutex::Autolock _l(mLock);
1520     if (mCurrentOperatingMode != RESTRICTED) {
1521         String8 package(opPackageName);
1522         return !isWhiteListedPackage(package);
1523     }
1524     return false;
1525 }
1526
1527 }; // namespace android