Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 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 | |
| 17 | #include <stdint.h> |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 18 | #include <math.h> |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 19 | #include <sys/types.h> |
| 20 | |
Mathias Agopian | 3301542 | 2011-05-27 18:18:13 -0700 | [diff] [blame] | 21 | #include <cutils/properties.h> |
| 22 | |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 23 | #include <utils/SortedVector.h> |
| 24 | #include <utils/KeyedVector.h> |
| 25 | #include <utils/threads.h> |
| 26 | #include <utils/Atomic.h> |
| 27 | #include <utils/Errors.h> |
| 28 | #include <utils/RefBase.h> |
Mathias Agopian | 451beee | 2010-07-19 15:03:55 -0700 | [diff] [blame] | 29 | #include <utils/Singleton.h> |
Mathias Agopian | c4a930d | 2010-07-22 22:19:43 -0700 | [diff] [blame] | 30 | #include <utils/String16.h> |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 31 | |
| 32 | #include <binder/BinderService.h> |
Mathias Agopian | 451beee | 2010-07-19 15:03:55 -0700 | [diff] [blame] | 33 | #include <binder/IServiceManager.h> |
Mathias Agopian | 1cb1346 | 2011-06-27 16:05:52 -0700 | [diff] [blame] | 34 | #include <binder/PermissionCache.h> |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 35 | |
| 36 | #include <gui/ISensorServer.h> |
| 37 | #include <gui/ISensorEventConnection.h> |
Mathias Agopian | 907103b | 2012-04-02 18:38:02 -0700 | [diff] [blame] | 38 | #include <gui/SensorEventQueue.h> |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 39 | |
| 40 | #include <hardware/sensors.h> |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 41 | #include <hardware_legacy/power.h> |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 42 | |
Mathias Agopian | 787ac1b | 2012-09-18 18:49:18 -0700 | [diff] [blame] | 43 | #include "BatteryService.h" |
Mathias Agopian | 984826c | 2011-05-17 22:54:42 -0700 | [diff] [blame] | 44 | #include "CorrectedGyroSensor.h" |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 45 | #include "GravitySensor.h" |
| 46 | #include "LinearAccelerationSensor.h" |
Mathias Agopian | 984826c | 2011-05-17 22:54:42 -0700 | [diff] [blame] | 47 | #include "OrientationSensor.h" |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 48 | #include "RotationVectorSensor.h" |
Mathias Agopian | 984826c | 2011-05-17 22:54:42 -0700 | [diff] [blame] | 49 | #include "SensorFusion.h" |
| 50 | #include "SensorService.h" |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 51 | |
| 52 | namespace android { |
| 53 | // --------------------------------------------------------------------------- |
| 54 | |
Mathias Agopian | 3301542 | 2011-05-27 18:18:13 -0700 | [diff] [blame] | 55 | /* |
| 56 | * Notes: |
| 57 | * |
| 58 | * - what about a gyro-corrected magnetic-field sensor? |
Mathias Agopian | 3301542 | 2011-05-27 18:18:13 -0700 | [diff] [blame] | 59 | * - run mag sensor from time to time to force calibration |
| 60 | * - gravity sensor length is wrong (=> drift in linear-acc sensor) |
| 61 | * |
| 62 | */ |
| 63 | |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 64 | const char* SensorService::WAKE_LOCK_NAME = "SensorService"; |
| 65 | |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 66 | SensorService::SensorService() |
Mathias Agopian | 1cb1346 | 2011-06-27 16:05:52 -0700 | [diff] [blame] | 67 | : mInitCheck(NO_INIT) |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 68 | { |
| 69 | } |
| 70 | |
| 71 | void SensorService::onFirstRef() |
| 72 | { |
Steve Block | a551237 | 2011-12-20 16:23:08 +0000 | [diff] [blame] | 73 | ALOGD("nuSensorService starting..."); |
Mathias Agopian | 50df295 | 2010-07-19 19:09:10 -0700 | [diff] [blame] | 74 | |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 75 | SensorDevice& dev(SensorDevice::getInstance()); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 76 | |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 77 | if (dev.initCheck() == NO_ERROR) { |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 78 | sensor_t const* list; |
Mathias Agopian | 7b2b32f | 2011-07-14 16:39:46 -0700 | [diff] [blame] | 79 | ssize_t count = dev.getSensorList(&list); |
| 80 | if (count > 0) { |
| 81 | ssize_t orientationIndex = -1; |
| 82 | bool hasGyro = false; |
| 83 | uint32_t virtualSensorsNeeds = |
| 84 | (1<<SENSOR_TYPE_GRAVITY) | |
| 85 | (1<<SENSOR_TYPE_LINEAR_ACCELERATION) | |
| 86 | (1<<SENSOR_TYPE_ROTATION_VECTOR); |
| 87 | |
| 88 | mLastEventSeen.setCapacity(count); |
| 89 | for (ssize_t i=0 ; i<count ; i++) { |
| 90 | registerSensor( new HardwareSensor(list[i]) ); |
| 91 | switch (list[i].type) { |
| 92 | case SENSOR_TYPE_ORIENTATION: |
| 93 | orientationIndex = i; |
| 94 | break; |
| 95 | case SENSOR_TYPE_GYROSCOPE: |
Mathias Agopian | 0319306 | 2013-05-10 19:32:39 -0700 | [diff] [blame] | 96 | case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED: |
Mathias Agopian | 7b2b32f | 2011-07-14 16:39:46 -0700 | [diff] [blame] | 97 | hasGyro = true; |
| 98 | break; |
| 99 | case SENSOR_TYPE_GRAVITY: |
| 100 | case SENSOR_TYPE_LINEAR_ACCELERATION: |
| 101 | case SENSOR_TYPE_ROTATION_VECTOR: |
| 102 | virtualSensorsNeeds &= ~(1<<list[i].type); |
| 103 | break; |
| 104 | } |
Mathias Agopian | 50df295 | 2010-07-19 19:09:10 -0700 | [diff] [blame] | 105 | } |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 106 | |
Mathias Agopian | 7b2b32f | 2011-07-14 16:39:46 -0700 | [diff] [blame] | 107 | // it's safe to instantiate the SensorFusion object here |
| 108 | // (it wants to be instantiated after h/w sensors have been |
| 109 | // registered) |
| 110 | const SensorFusion& fusion(SensorFusion::getInstance()); |
Mathias Agopian | 984826c | 2011-05-17 22:54:42 -0700 | [diff] [blame] | 111 | |
Mathias Agopian | 7b2b32f | 2011-07-14 16:39:46 -0700 | [diff] [blame] | 112 | // build the sensor list returned to users |
| 113 | mUserSensorList = mSensorList; |
Mathias Agopian | 3326486 | 2012-06-28 19:46:54 -0700 | [diff] [blame] | 114 | |
| 115 | if (hasGyro) { |
Mathias Agopian | 0319306 | 2013-05-10 19:32:39 -0700 | [diff] [blame] | 116 | Sensor aSensor; |
| 117 | |
| 118 | // Add Android virtual sensors if they're not already |
| 119 | // available in the HAL |
| 120 | |
| 121 | aSensor = registerVirtualSensor( new RotationVectorSensor() ); |
| 122 | if (virtualSensorsNeeds & (1<<SENSOR_TYPE_ROTATION_VECTOR)) { |
| 123 | mUserSensorList.add(aSensor); |
| 124 | } |
| 125 | |
| 126 | aSensor = registerVirtualSensor( new GravitySensor(list, count) ); |
| 127 | if (virtualSensorsNeeds & (1<<SENSOR_TYPE_GRAVITY)) { |
| 128 | mUserSensorList.add(aSensor); |
| 129 | } |
| 130 | |
| 131 | aSensor = registerVirtualSensor( new LinearAccelerationSensor(list, count) ); |
| 132 | if (virtualSensorsNeeds & (1<<SENSOR_TYPE_LINEAR_ACCELERATION)) { |
| 133 | mUserSensorList.add(aSensor); |
| 134 | } |
| 135 | |
| 136 | aSensor = registerVirtualSensor( new OrientationSensor() ); |
| 137 | if (virtualSensorsNeeds & (1<<SENSOR_TYPE_ROTATION_VECTOR)) { |
| 138 | // if we are doing our own rotation-vector, also add |
| 139 | // the orientation sensor and remove the HAL provided one. |
| 140 | mUserSensorList.replaceAt(aSensor, orientationIndex); |
| 141 | } |
| 142 | |
Mathias Agopian | 3326486 | 2012-06-28 19:46:54 -0700 | [diff] [blame] | 143 | // virtual debugging sensors are not added to mUserSensorList |
Mathias Agopian | 0319306 | 2013-05-10 19:32:39 -0700 | [diff] [blame] | 144 | registerVirtualSensor( new CorrectedGyroSensor(list, count) ); |
Mathias Agopian | 3326486 | 2012-06-28 19:46:54 -0700 | [diff] [blame] | 145 | registerVirtualSensor( new GyroDriftSensor() ); |
| 146 | } |
| 147 | |
Mathias Agopian | 3326486 | 2012-06-28 19:46:54 -0700 | [diff] [blame] | 148 | // debugging sensor list |
Mathias Agopian | 0319306 | 2013-05-10 19:32:39 -0700 | [diff] [blame] | 149 | mUserSensorListDebug = mSensorList; |
Mathias Agopian | 3326486 | 2012-06-28 19:46:54 -0700 | [diff] [blame] | 150 | |
Mathias Agopian | 7b2b32f | 2011-07-14 16:39:46 -0700 | [diff] [blame] | 151 | run("SensorService", PRIORITY_URGENT_DISPLAY); |
| 152 | mInitCheck = NO_ERROR; |
| 153 | } |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 154 | } |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 155 | } |
| 156 | |
Mathias Agopian | 0319306 | 2013-05-10 19:32:39 -0700 | [diff] [blame] | 157 | Sensor SensorService::registerSensor(SensorInterface* s) |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 158 | { |
| 159 | sensors_event_t event; |
| 160 | memset(&event, 0, sizeof(event)); |
| 161 | |
| 162 | const Sensor sensor(s->getSensor()); |
| 163 | // add to the sensor list (returned to clients) |
| 164 | mSensorList.add(sensor); |
| 165 | // add to our handle->SensorInterface mapping |
| 166 | mSensorMap.add(sensor.getHandle(), s); |
| 167 | // create an entry in the mLastEventSeen array |
| 168 | mLastEventSeen.add(sensor.getHandle(), event); |
Mathias Agopian | 0319306 | 2013-05-10 19:32:39 -0700 | [diff] [blame] | 169 | |
| 170 | return sensor; |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 171 | } |
| 172 | |
Mathias Agopian | 0319306 | 2013-05-10 19:32:39 -0700 | [diff] [blame] | 173 | Sensor SensorService::registerVirtualSensor(SensorInterface* s) |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 174 | { |
Mathias Agopian | 0319306 | 2013-05-10 19:32:39 -0700 | [diff] [blame] | 175 | Sensor sensor = registerSensor(s); |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 176 | mVirtualSensorList.add( s ); |
Mathias Agopian | 0319306 | 2013-05-10 19:32:39 -0700 | [diff] [blame] | 177 | return sensor; |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 178 | } |
| 179 | |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 180 | SensorService::~SensorService() |
| 181 | { |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 182 | for (size_t i=0 ; i<mSensorMap.size() ; i++) |
| 183 | delete mSensorMap.valueAt(i); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 184 | } |
| 185 | |
Mathias Agopian | 1cb1346 | 2011-06-27 16:05:52 -0700 | [diff] [blame] | 186 | static const String16 sDump("android.permission.DUMP"); |
| 187 | |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 188 | status_t SensorService::dump(int fd, const Vector<String16>& args) |
| 189 | { |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 190 | String8 result; |
Mathias Agopian | 1cb1346 | 2011-06-27 16:05:52 -0700 | [diff] [blame] | 191 | if (!PermissionCache::checkCallingPermission(sDump)) { |
Mathias Agopian | ba02cd2 | 2013-07-03 16:20:57 -0700 | [diff] [blame^] | 192 | result.appendFormat("Permission Denial: " |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 193 | "can't dump SurfaceFlinger from pid=%d, uid=%d\n", |
| 194 | IPCThreadState::self()->getCallingPid(), |
| 195 | IPCThreadState::self()->getCallingUid()); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 196 | } else { |
| 197 | Mutex::Autolock _l(mLock); |
Mathias Agopian | ba02cd2 | 2013-07-03 16:20:57 -0700 | [diff] [blame^] | 198 | result.append("Sensor List:\n"); |
Mathias Agopian | 3560fb2 | 2010-07-22 21:24:39 -0700 | [diff] [blame] | 199 | for (size_t i=0 ; i<mSensorList.size() ; i++) { |
| 200 | const Sensor& s(mSensorList[i]); |
| 201 | const sensors_event_t& e(mLastEventSeen.valueFor(s.getHandle())); |
Mathias Agopian | ba02cd2 | 2013-07-03 16:20:57 -0700 | [diff] [blame^] | 202 | result.appendFormat( |
| 203 | "%-48s| %-32s | 0x%08x | ", |
Mathias Agopian | 3560fb2 | 2010-07-22 21:24:39 -0700 | [diff] [blame] | 204 | s.getName().string(), |
| 205 | s.getVendor().string(), |
Mathias Agopian | ba02cd2 | 2013-07-03 16:20:57 -0700 | [diff] [blame^] | 206 | s.getHandle()); |
Mathias Agopian | 3560fb2 | 2010-07-22 21:24:39 -0700 | [diff] [blame] | 207 | |
Mathias Agopian | ba02cd2 | 2013-07-03 16:20:57 -0700 | [diff] [blame^] | 208 | if (s.getMinDelay() > 0) { |
| 209 | result.appendFormat( |
| 210 | "maxRate=%7.2fHz | ", 1e6f / s.getMinDelay()); |
| 211 | } else { |
| 212 | result.append(s.getMinDelay() == 0 |
| 213 | ? "on-demand | " |
| 214 | : "one-shot | "); |
| 215 | } |
| 216 | |
| 217 | switch (s.getType()) { |
| 218 | case SENSOR_TYPE_ROTATION_VECTOR: |
| 219 | case SENSOR_TYPE_GEOMAGNETIC_ROTATION_VECTOR: |
| 220 | result.appendFormat( |
| 221 | "last=<%5.1f,%5.1f,%5.1f,%5.1f,%5.1f>\n", |
| 222 | e.data[0], e.data[1], e.data[2], e.data[3], e.data[4]); |
| 223 | break; |
| 224 | case SENSOR_TYPE_MAGNETIC_FIELD_UNCALIBRATED: |
| 225 | case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED: |
| 226 | result.appendFormat( |
| 227 | "last=<%5.1f,%5.1f,%5.1f,%5.1f,%5.1f,%5.1f>\n", |
| 228 | e.data[0], e.data[1], e.data[2], e.data[3], e.data[4], e.data[5]); |
| 229 | break; |
| 230 | case SENSOR_TYPE_GAME_ROTATION_VECTOR: |
| 231 | result.appendFormat( |
| 232 | "last=<%5.1f,%5.1f,%5.1f,%5.1f>\n", |
| 233 | e.data[0], e.data[1], e.data[2], e.data[3]); |
| 234 | break; |
| 235 | case SENSOR_TYPE_SIGNIFICANT_MOTION: |
| 236 | case SENSOR_TYPE_STEP_DETECTOR: |
| 237 | result.appendFormat( "last=<%f>\n", e.data[0]); |
| 238 | break; |
| 239 | case SENSOR_TYPE_STEP_COUNTER: |
| 240 | result.appendFormat( "last=<%llu>\n", e.u64.step_counter); |
| 241 | break; |
| 242 | default: |
| 243 | // default to 3 values |
| 244 | result.appendFormat( |
| 245 | "last=<%5.1f,%5.1f,%5.1f>\n", |
| 246 | e.data[0], e.data[1], e.data[2]); |
| 247 | break; |
| 248 | } |
| 249 | } |
| 250 | SensorFusion::getInstance().dump(result); |
| 251 | SensorDevice::getInstance().dump(result); |
| 252 | |
| 253 | result.appendFormat("%d active connections\n", mActiveConnections.size()); |
| 254 | result.append("Active sensors:\n"); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 255 | for (size_t i=0 ; i<mActiveSensors.size() ; i++) { |
Mathias Agopian | 5d27072 | 2010-07-19 15:20:39 -0700 | [diff] [blame] | 256 | int handle = mActiveSensors.keyAt(i); |
Mathias Agopian | ba02cd2 | 2013-07-03 16:20:57 -0700 | [diff] [blame^] | 257 | result.appendFormat("%s (handle=0x%08x, connections=%d)\n", |
Mathias Agopian | 5d27072 | 2010-07-19 15:20:39 -0700 | [diff] [blame] | 258 | getSensorName(handle).string(), |
| 259 | handle, |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 260 | mActiveSensors.valueAt(i)->getNumConnections()); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 261 | } |
| 262 | } |
| 263 | write(fd, result.string(), result.size()); |
| 264 | return NO_ERROR; |
| 265 | } |
| 266 | |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 267 | void SensorService::cleanupAutoDisabledSensor(const sp<SensorEventConnection>& connection, |
| 268 | sensors_event_t const* buffer, const int count) { |
Jaikumar Ganesh | 4c01b1a | 2013-04-16 15:52:23 -0700 | [diff] [blame] | 269 | SensorInterface* sensor; |
| 270 | status_t err = NO_ERROR; |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 271 | for (int i=0 ; i<count ; i++) { |
| 272 | int handle = buffer[i].sensor; |
Mathias Agopian | 7438fd1 | 2013-07-08 12:50:39 -0700 | [diff] [blame] | 273 | int type = buffer[i].type; |
| 274 | if (type == SENSOR_TYPE_SIGNIFICANT_MOTION) { |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 275 | if (connection->hasSensor(handle)) { |
Jaikumar Ganesh | 4c01b1a | 2013-04-16 15:52:23 -0700 | [diff] [blame] | 276 | sensor = mSensorMap.valueFor(handle); |
| 277 | err = sensor ?sensor->resetStateWithoutActuatingHardware(connection.get(), handle) |
| 278 | : status_t(BAD_VALUE); |
| 279 | if (err != NO_ERROR) { |
| 280 | ALOGE("Sensor Inteface: Resetting state failed with err: %d", err); |
| 281 | } |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 282 | cleanupWithoutDisable(connection, handle); |
| 283 | } |
| 284 | } |
| 285 | } |
| 286 | } |
| 287 | |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 288 | bool SensorService::threadLoop() |
| 289 | { |
Steve Block | a551237 | 2011-12-20 16:23:08 +0000 | [diff] [blame] | 290 | ALOGD("nuSensorService thread starting..."); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 291 | |
Mathias Agopian | d1920ff | 2012-05-29 19:46:14 -0700 | [diff] [blame] | 292 | const size_t numEventMax = 16; |
Mathias Agopian | 8dd4fe8 | 2012-05-30 18:08:30 -0700 | [diff] [blame] | 293 | const size_t minBufferSize = numEventMax + numEventMax * mVirtualSensorList.size(); |
Mathias Agopian | d1920ff | 2012-05-29 19:46:14 -0700 | [diff] [blame] | 294 | sensors_event_t buffer[minBufferSize]; |
| 295 | sensors_event_t scratch[minBufferSize]; |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 296 | SensorDevice& device(SensorDevice::getInstance()); |
| 297 | const size_t vcount = mVirtualSensorList.size(); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 298 | |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 299 | ssize_t count; |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 300 | bool wakeLockAcquired = false; |
| 301 | const int halVersion = device.getHalDeviceVersion(); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 302 | do { |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 303 | count = device.poll(buffer, numEventMax); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 304 | if (count<0) { |
Steve Block | f5a1230 | 2012-01-06 19:20:56 +0000 | [diff] [blame] | 305 | ALOGE("sensor poll failed (%s)", strerror(-count)); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 306 | break; |
| 307 | } |
| 308 | |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 309 | // Poll has returned. Hold a wakelock. |
| 310 | // Todo(): add a flag to the sensors definitions to indicate |
| 311 | // the sensors which can wake up the AP |
| 312 | for (int i = 0; i < count; i++) { |
Mathias Agopian | 7438fd1 | 2013-07-08 12:50:39 -0700 | [diff] [blame] | 313 | if (buffer[i].type == SENSOR_TYPE_SIGNIFICANT_MOTION) { |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 314 | acquire_wake_lock(PARTIAL_WAKE_LOCK, WAKE_LOCK_NAME); |
| 315 | wakeLockAcquired = true; |
| 316 | break; |
| 317 | } |
| 318 | } |
| 319 | |
Mathias Agopian | 94e8f68 | 2010-11-10 17:50:28 -0800 | [diff] [blame] | 320 | recordLastValue(buffer, count); |
| 321 | |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 322 | // handle virtual sensors |
| 323 | if (count && vcount) { |
Mathias Agopian | 984826c | 2011-05-17 22:54:42 -0700 | [diff] [blame] | 324 | sensors_event_t const * const event = buffer; |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 325 | const DefaultKeyedVector<int, SensorInterface*> virtualSensors( |
| 326 | getActiveVirtualSensors()); |
| 327 | const size_t activeVirtualSensorCount = virtualSensors.size(); |
| 328 | if (activeVirtualSensorCount) { |
| 329 | size_t k = 0; |
Mathias Agopian | 984826c | 2011-05-17 22:54:42 -0700 | [diff] [blame] | 330 | SensorFusion& fusion(SensorFusion::getInstance()); |
| 331 | if (fusion.isEnabled()) { |
| 332 | for (size_t i=0 ; i<size_t(count) ; i++) { |
| 333 | fusion.process(event[i]); |
| 334 | } |
| 335 | } |
Mathias Agopian | d1920ff | 2012-05-29 19:46:14 -0700 | [diff] [blame] | 336 | for (size_t i=0 ; i<size_t(count) && k<minBufferSize ; i++) { |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 337 | for (size_t j=0 ; j<activeVirtualSensorCount ; j++) { |
Mathias Agopian | d1920ff | 2012-05-29 19:46:14 -0700 | [diff] [blame] | 338 | if (count + k >= minBufferSize) { |
| 339 | ALOGE("buffer too small to hold all events: " |
| 340 | "count=%u, k=%u, size=%u", |
| 341 | count, k, minBufferSize); |
| 342 | break; |
| 343 | } |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 344 | sensors_event_t out; |
Mathias Agopian | d1920ff | 2012-05-29 19:46:14 -0700 | [diff] [blame] | 345 | SensorInterface* si = virtualSensors.valueAt(j); |
| 346 | if (si->process(&out, event[i])) { |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 347 | buffer[count + k] = out; |
| 348 | k++; |
| 349 | } |
| 350 | } |
| 351 | } |
| 352 | if (k) { |
| 353 | // record the last synthesized values |
| 354 | recordLastValue(&buffer[count], k); |
| 355 | count += k; |
| 356 | // sort the buffer by time-stamps |
| 357 | sortEventBuffer(buffer, count); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 358 | } |
| 359 | } |
| 360 | } |
| 361 | |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 362 | // handle backward compatibility for RotationVector sensor |
| 363 | if (halVersion < SENSORS_DEVICE_API_VERSION_1_0) { |
| 364 | for (int i = 0; i < count; i++) { |
Mathias Agopian | 7438fd1 | 2013-07-08 12:50:39 -0700 | [diff] [blame] | 365 | if (buffer[i].type == SENSOR_TYPE_ROTATION_VECTOR) { |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 366 | // All the 4 components of the quaternion should be available |
| 367 | // No heading accuracy. Set it to -1 |
| 368 | buffer[i].data[4] = -1; |
| 369 | } |
| 370 | } |
| 371 | } |
| 372 | |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 373 | // send our events to clients... |
| 374 | const SortedVector< wp<SensorEventConnection> > activeConnections( |
| 375 | getActiveConnections()); |
| 376 | size_t numConnections = activeConnections.size(); |
| 377 | for (size_t i=0 ; i<numConnections ; i++) { |
| 378 | sp<SensorEventConnection> connection( |
| 379 | activeConnections[i].promote()); |
| 380 | if (connection != 0) { |
| 381 | connection->sendEvents(buffer, count, scratch); |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 382 | // Some sensors need to be auto disabled after the trigger |
| 383 | cleanupAutoDisabledSensor(connection, buffer, count); |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 384 | } |
| 385 | } |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 386 | |
| 387 | // We have read the data, upper layers should hold the wakelock. |
| 388 | if (wakeLockAcquired) release_wake_lock(WAKE_LOCK_NAME); |
| 389 | |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 390 | } while (count >= 0 || Thread::exitPending()); |
| 391 | |
Steve Block | 3c20fbe | 2012-01-05 23:22:43 +0000 | [diff] [blame] | 392 | ALOGW("Exiting SensorService::threadLoop => aborting..."); |
Mathias Agopian | 1a62301 | 2011-11-09 17:50:15 -0800 | [diff] [blame] | 393 | abort(); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 394 | return false; |
| 395 | } |
| 396 | |
Mathias Agopian | 94e8f68 | 2010-11-10 17:50:28 -0800 | [diff] [blame] | 397 | void SensorService::recordLastValue( |
| 398 | sensors_event_t const * buffer, size_t count) |
| 399 | { |
| 400 | Mutex::Autolock _l(mLock); |
| 401 | |
| 402 | // record the last event for each sensor |
| 403 | int32_t prev = buffer[0].sensor; |
| 404 | for (size_t i=1 ; i<count ; i++) { |
| 405 | // record the last event of each sensor type in this buffer |
| 406 | int32_t curr = buffer[i].sensor; |
| 407 | if (curr != prev) { |
| 408 | mLastEventSeen.editValueFor(prev) = buffer[i-1]; |
| 409 | prev = curr; |
| 410 | } |
| 411 | } |
| 412 | mLastEventSeen.editValueFor(prev) = buffer[count-1]; |
| 413 | } |
| 414 | |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 415 | void SensorService::sortEventBuffer(sensors_event_t* buffer, size_t count) |
| 416 | { |
| 417 | struct compar { |
| 418 | static int cmp(void const* lhs, void const* rhs) { |
| 419 | sensors_event_t const* l = static_cast<sensors_event_t const*>(lhs); |
| 420 | sensors_event_t const* r = static_cast<sensors_event_t const*>(rhs); |
Mathias Agopian | a5c106a | 2012-04-19 18:18:24 -0700 | [diff] [blame] | 421 | return l->timestamp - r->timestamp; |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 422 | } |
| 423 | }; |
| 424 | qsort(buffer, count, sizeof(sensors_event_t), compar::cmp); |
| 425 | } |
| 426 | |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 427 | SortedVector< wp<SensorService::SensorEventConnection> > |
| 428 | SensorService::getActiveConnections() const |
| 429 | { |
| 430 | Mutex::Autolock _l(mLock); |
| 431 | return mActiveConnections; |
| 432 | } |
| 433 | |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 434 | DefaultKeyedVector<int, SensorInterface*> |
| 435 | SensorService::getActiveVirtualSensors() const |
| 436 | { |
| 437 | Mutex::Autolock _l(mLock); |
| 438 | return mActiveVirtualSensors; |
| 439 | } |
| 440 | |
Mathias Agopian | 5d27072 | 2010-07-19 15:20:39 -0700 | [diff] [blame] | 441 | String8 SensorService::getSensorName(int handle) const { |
Mathias Agopian | 010e422 | 2011-06-08 20:06:50 -0700 | [diff] [blame] | 442 | size_t count = mUserSensorList.size(); |
Mathias Agopian | 5d27072 | 2010-07-19 15:20:39 -0700 | [diff] [blame] | 443 | for (size_t i=0 ; i<count ; i++) { |
Mathias Agopian | 010e422 | 2011-06-08 20:06:50 -0700 | [diff] [blame] | 444 | const Sensor& sensor(mUserSensorList[i]); |
Mathias Agopian | 5d27072 | 2010-07-19 15:20:39 -0700 | [diff] [blame] | 445 | if (sensor.getHandle() == handle) { |
| 446 | return sensor.getName(); |
| 447 | } |
| 448 | } |
| 449 | String8 result("unknown"); |
| 450 | return result; |
| 451 | } |
| 452 | |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 453 | Vector<Sensor> SensorService::getSensorList() |
| 454 | { |
Mathias Agopian | 3326486 | 2012-06-28 19:46:54 -0700 | [diff] [blame] | 455 | char value[PROPERTY_VALUE_MAX]; |
| 456 | property_get("debug.sensors", value, "0"); |
| 457 | if (atoi(value)) { |
| 458 | return mUserSensorListDebug; |
| 459 | } |
Mathias Agopian | 010e422 | 2011-06-08 20:06:50 -0700 | [diff] [blame] | 460 | return mUserSensorList; |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 461 | } |
| 462 | |
| 463 | sp<ISensorEventConnection> SensorService::createSensorEventConnection() |
| 464 | { |
Mathias Agopian | 5307d17 | 2012-09-18 17:02:43 -0700 | [diff] [blame] | 465 | uid_t uid = IPCThreadState::self()->getCallingUid(); |
| 466 | sp<SensorEventConnection> result(new SensorEventConnection(this, uid)); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 467 | return result; |
| 468 | } |
| 469 | |
Mathias Agopian | db5b4bc | 2011-02-03 14:52:47 -0800 | [diff] [blame] | 470 | void SensorService::cleanupConnection(SensorEventConnection* c) |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 471 | { |
| 472 | Mutex::Autolock _l(mLock); |
Mathias Agopian | db5b4bc | 2011-02-03 14:52:47 -0800 | [diff] [blame] | 473 | const wp<SensorEventConnection> connection(c); |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 474 | size_t size = mActiveSensors.size(); |
Steve Block | a551237 | 2011-12-20 16:23:08 +0000 | [diff] [blame] | 475 | ALOGD_IF(DEBUG_CONNECTIONS, "%d active sensors", size); |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 476 | for (size_t i=0 ; i<size ; ) { |
Mathias Agopian | db5b4bc | 2011-02-03 14:52:47 -0800 | [diff] [blame] | 477 | int handle = mActiveSensors.keyAt(i); |
| 478 | if (c->hasSensor(handle)) { |
Steve Block | a551237 | 2011-12-20 16:23:08 +0000 | [diff] [blame] | 479 | ALOGD_IF(DEBUG_CONNECTIONS, "%i: disabling handle=0x%08x", i, handle); |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 480 | SensorInterface* sensor = mSensorMap.valueFor( handle ); |
Steve Block | f5a1230 | 2012-01-06 19:20:56 +0000 | [diff] [blame] | 481 | ALOGE_IF(!sensor, "mSensorMap[handle=0x%08x] is null!", handle); |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 482 | if (sensor) { |
Mathias Agopian | db5b4bc | 2011-02-03 14:52:47 -0800 | [diff] [blame] | 483 | sensor->activate(c, false); |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 484 | } |
Mathias Agopian | db5b4bc | 2011-02-03 14:52:47 -0800 | [diff] [blame] | 485 | } |
| 486 | SensorRecord* rec = mActiveSensors.valueAt(i); |
Steve Block | f5a1230 | 2012-01-06 19:20:56 +0000 | [diff] [blame] | 487 | ALOGE_IF(!rec, "mActiveSensors[%d] is null (handle=0x%08x)!", i, handle); |
Steve Block | a551237 | 2011-12-20 16:23:08 +0000 | [diff] [blame] | 488 | ALOGD_IF(DEBUG_CONNECTIONS, |
Mathias Agopian | a1b7db9 | 2011-05-27 16:23:58 -0700 | [diff] [blame] | 489 | "removing connection %p for sensor[%d].handle=0x%08x", |
| 490 | c, i, handle); |
| 491 | |
Mathias Agopian | db5b4bc | 2011-02-03 14:52:47 -0800 | [diff] [blame] | 492 | if (rec && rec->removeConnection(connection)) { |
Steve Block | a551237 | 2011-12-20 16:23:08 +0000 | [diff] [blame] | 493 | ALOGD_IF(DEBUG_CONNECTIONS, "... and it was the last connection"); |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 494 | mActiveSensors.removeItemsAt(i, 1); |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 495 | mActiveVirtualSensors.removeItem(handle); |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 496 | delete rec; |
| 497 | size--; |
| 498 | } else { |
| 499 | i++; |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 500 | } |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 501 | } |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 502 | mActiveConnections.remove(connection); |
Mathias Agopian | 787ac1b | 2012-09-18 18:49:18 -0700 | [diff] [blame] | 503 | BatteryService::cleanup(c->getUid()); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 504 | } |
| 505 | |
| 506 | status_t SensorService::enable(const sp<SensorEventConnection>& connection, |
| 507 | int handle) |
| 508 | { |
Mathias Agopian | 50df295 | 2010-07-19 19:09:10 -0700 | [diff] [blame] | 509 | if (mInitCheck != NO_ERROR) |
| 510 | return mInitCheck; |
| 511 | |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 512 | Mutex::Autolock _l(mLock); |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 513 | SensorInterface* sensor = mSensorMap.valueFor(handle); |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 514 | SensorRecord* rec = mActiveSensors.valueFor(handle); |
| 515 | if (rec == 0) { |
| 516 | rec = new SensorRecord(connection); |
| 517 | mActiveSensors.add(handle, rec); |
| 518 | if (sensor->isVirtual()) { |
| 519 | mActiveVirtualSensors.add(handle, sensor); |
| 520 | } |
| 521 | } else { |
| 522 | if (rec->addConnection(connection)) { |
| 523 | // this sensor is already activated, but we are adding a |
| 524 | // connection that uses it. Immediately send down the last |
| 525 | // known value of the requested sensor if it's not a |
| 526 | // "continuous" sensor. |
| 527 | if (sensor->getSensor().getMinDelay() == 0) { |
| 528 | sensors_event_t scratch; |
| 529 | sensors_event_t& event(mLastEventSeen.editValueFor(handle)); |
| 530 | if (event.version == sizeof(sensors_event_t)) { |
| 531 | connection->sendEvents(&event, 1); |
| 532 | } |
| 533 | } |
| 534 | } |
| 535 | } |
| 536 | |
| 537 | if (connection->addSensor(handle)) { |
| 538 | BatteryService::enableSensor(connection->getUid(), handle); |
| 539 | // the sensor was added (which means it wasn't already there) |
| 540 | // so, see if this connection becomes active |
| 541 | if (mActiveConnections.indexOf(connection) < 0) { |
| 542 | mActiveConnections.add(connection); |
| 543 | } |
| 544 | } else { |
| 545 | ALOGW("sensor %08x already enabled in connection %p (ignoring)", |
| 546 | handle, connection.get()); |
| 547 | } |
| 548 | |
| 549 | |
| 550 | // we are setup, now enable the sensor. |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 551 | status_t err = sensor ? sensor->activate(connection.get(), true) : status_t(BAD_VALUE); |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 552 | |
| 553 | if (err != NO_ERROR) { |
Jaikumar Ganesh | 4c01b1a | 2013-04-16 15:52:23 -0700 | [diff] [blame] | 554 | // enable has failed, reset state in SensorDevice. |
| 555 | status_t resetErr = sensor ? sensor->resetStateWithoutActuatingHardware(connection.get(), |
| 556 | handle) : status_t(BAD_VALUE); |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 557 | // enable has failed, reset our state. |
| 558 | cleanupWithoutDisable(connection, handle); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 559 | } |
| 560 | return err; |
| 561 | } |
| 562 | |
| 563 | status_t SensorService::disable(const sp<SensorEventConnection>& connection, |
| 564 | int handle) |
| 565 | { |
Mathias Agopian | 50df295 | 2010-07-19 19:09:10 -0700 | [diff] [blame] | 566 | if (mInitCheck != NO_ERROR) |
| 567 | return mInitCheck; |
| 568 | |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 569 | status_t err = cleanupWithoutDisable(connection, handle); |
| 570 | if (err == NO_ERROR) { |
| 571 | SensorInterface* sensor = mSensorMap.valueFor(handle); |
| 572 | err = sensor ? sensor->activate(connection.get(), false) : status_t(BAD_VALUE); |
| 573 | } |
| 574 | return err; |
| 575 | } |
| 576 | |
| 577 | status_t SensorService::cleanupWithoutDisable(const sp<SensorEventConnection>& connection, |
| 578 | int handle) { |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 579 | Mutex::Autolock _l(mLock); |
| 580 | SensorRecord* rec = mActiveSensors.valueFor(handle); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 581 | if (rec) { |
| 582 | // see if this connection becomes inactive |
Mathias Agopian | 787ac1b | 2012-09-18 18:49:18 -0700 | [diff] [blame] | 583 | if (connection->removeSensor(handle)) { |
| 584 | BatteryService::disableSensor(connection->getUid(), handle); |
| 585 | } |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 586 | if (connection->hasAnySensor() == false) { |
| 587 | mActiveConnections.remove(connection); |
| 588 | } |
| 589 | // see if this sensor becomes inactive |
| 590 | if (rec->removeConnection(connection)) { |
| 591 | mActiveSensors.removeItem(handle); |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 592 | mActiveVirtualSensors.removeItem(handle); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 593 | delete rec; |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 594 | } |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 595 | return NO_ERROR; |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 596 | } |
Jaikumar Ganesh | 4342fdf | 2013-04-08 16:43:12 -0700 | [diff] [blame] | 597 | return BAD_VALUE; |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 598 | } |
| 599 | |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 600 | status_t SensorService::setEventRate(const sp<SensorEventConnection>& connection, |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 601 | int handle, nsecs_t ns) |
| 602 | { |
Mathias Agopian | 50df295 | 2010-07-19 19:09:10 -0700 | [diff] [blame] | 603 | if (mInitCheck != NO_ERROR) |
| 604 | return mInitCheck; |
| 605 | |
Mathias Agopian | ae09d65 | 2011-11-01 17:37:49 -0700 | [diff] [blame] | 606 | SensorInterface* sensor = mSensorMap.valueFor(handle); |
| 607 | if (!sensor) |
| 608 | return BAD_VALUE; |
| 609 | |
Mathias Agopian | 1cd7000 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 610 | if (ns < 0) |
| 611 | return BAD_VALUE; |
| 612 | |
Mathias Agopian | 62569ec | 2011-11-07 21:21:47 -0800 | [diff] [blame] | 613 | nsecs_t minDelayNs = sensor->getSensor().getMinDelayNs(); |
| 614 | if (ns < minDelayNs) { |
| 615 | ns = minDelayNs; |
Mathias Agopian | ae09d65 | 2011-11-01 17:37:49 -0700 | [diff] [blame] | 616 | } |
| 617 | |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 618 | if (ns < MINIMUM_EVENTS_PERIOD) |
| 619 | ns = MINIMUM_EVENTS_PERIOD; |
Mathias Agopian | 1cd7000 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 620 | |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 621 | return sensor->setDelay(connection.get(), handle, ns); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 622 | } |
| 623 | |
| 624 | // --------------------------------------------------------------------------- |
| 625 | |
| 626 | SensorService::SensorRecord::SensorRecord( |
| 627 | const sp<SensorEventConnection>& connection) |
| 628 | { |
| 629 | mConnections.add(connection); |
| 630 | } |
| 631 | |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 632 | bool SensorService::SensorRecord::addConnection( |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 633 | const sp<SensorEventConnection>& connection) |
| 634 | { |
| 635 | if (mConnections.indexOf(connection) < 0) { |
| 636 | mConnections.add(connection); |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 637 | return true; |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 638 | } |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 639 | return false; |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 640 | } |
| 641 | |
| 642 | bool SensorService::SensorRecord::removeConnection( |
| 643 | const wp<SensorEventConnection>& connection) |
| 644 | { |
| 645 | ssize_t index = mConnections.indexOf(connection); |
| 646 | if (index >= 0) { |
| 647 | mConnections.removeItemsAt(index, 1); |
| 648 | } |
| 649 | return mConnections.size() ? false : true; |
| 650 | } |
| 651 | |
| 652 | // --------------------------------------------------------------------------- |
| 653 | |
| 654 | SensorService::SensorEventConnection::SensorEventConnection( |
Mathias Agopian | 5307d17 | 2012-09-18 17:02:43 -0700 | [diff] [blame] | 655 | const sp<SensorService>& service, uid_t uid) |
| 656 | : mService(service), mChannel(new BitTube()), mUid(uid) |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 657 | { |
| 658 | } |
| 659 | |
| 660 | SensorService::SensorEventConnection::~SensorEventConnection() |
| 661 | { |
Steve Block | a551237 | 2011-12-20 16:23:08 +0000 | [diff] [blame] | 662 | ALOGD_IF(DEBUG_CONNECTIONS, "~SensorEventConnection(%p)", this); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 663 | mService->cleanupConnection(this); |
| 664 | } |
| 665 | |
| 666 | void SensorService::SensorEventConnection::onFirstRef() |
| 667 | { |
| 668 | } |
| 669 | |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 670 | bool SensorService::SensorEventConnection::addSensor(int32_t handle) { |
Mathias Agopian | 71d7a5c | 2010-11-14 20:55:25 -0800 | [diff] [blame] | 671 | Mutex::Autolock _l(mConnectionLock); |
Mathias Agopian | a5b8e8b | 2012-09-18 17:18:54 -0700 | [diff] [blame] | 672 | if (mSensorInfo.indexOf(handle) < 0) { |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 673 | mSensorInfo.add(handle); |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 674 | return true; |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 675 | } |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 676 | return false; |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 677 | } |
| 678 | |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 679 | bool SensorService::SensorEventConnection::removeSensor(int32_t handle) { |
Mathias Agopian | 71d7a5c | 2010-11-14 20:55:25 -0800 | [diff] [blame] | 680 | Mutex::Autolock _l(mConnectionLock); |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 681 | if (mSensorInfo.remove(handle) >= 0) { |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 682 | return true; |
| 683 | } |
| 684 | return false; |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 685 | } |
| 686 | |
| 687 | bool SensorService::SensorEventConnection::hasSensor(int32_t handle) const { |
Mathias Agopian | 71d7a5c | 2010-11-14 20:55:25 -0800 | [diff] [blame] | 688 | Mutex::Autolock _l(mConnectionLock); |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 689 | return mSensorInfo.indexOf(handle) >= 0; |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 690 | } |
| 691 | |
| 692 | bool SensorService::SensorEventConnection::hasAnySensor() const { |
Mathias Agopian | 71d7a5c | 2010-11-14 20:55:25 -0800 | [diff] [blame] | 693 | Mutex::Autolock _l(mConnectionLock); |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 694 | return mSensorInfo.size() ? true : false; |
| 695 | } |
| 696 | |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 697 | status_t SensorService::SensorEventConnection::sendEvents( |
Mathias Agopian | cf51001 | 2010-07-22 16:18:10 -0700 | [diff] [blame] | 698 | sensors_event_t const* buffer, size_t numEvents, |
| 699 | sensors_event_t* scratch) |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 700 | { |
Mathias Agopian | cf51001 | 2010-07-22 16:18:10 -0700 | [diff] [blame] | 701 | // filter out events not for this connection |
Mathias Agopian | 3560fb2 | 2010-07-22 21:24:39 -0700 | [diff] [blame] | 702 | size_t count = 0; |
| 703 | if (scratch) { |
Mathias Agopian | 71d7a5c | 2010-11-14 20:55:25 -0800 | [diff] [blame] | 704 | Mutex::Autolock _l(mConnectionLock); |
Mathias Agopian | 3560fb2 | 2010-07-22 21:24:39 -0700 | [diff] [blame] | 705 | size_t i=0; |
| 706 | while (i<numEvents) { |
| 707 | const int32_t curr = buffer[i].sensor; |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 708 | if (mSensorInfo.indexOf(curr) >= 0) { |
Mathias Agopian | 3560fb2 | 2010-07-22 21:24:39 -0700 | [diff] [blame] | 709 | do { |
| 710 | scratch[count++] = buffer[i++]; |
| 711 | } while ((i<numEvents) && (buffer[i].sensor == curr)); |
| 712 | } else { |
| 713 | i++; |
| 714 | } |
Mathias Agopian | cf51001 | 2010-07-22 16:18:10 -0700 | [diff] [blame] | 715 | } |
Mathias Agopian | 3560fb2 | 2010-07-22 21:24:39 -0700 | [diff] [blame] | 716 | } else { |
| 717 | scratch = const_cast<sensors_event_t *>(buffer); |
| 718 | count = numEvents; |
Mathias Agopian | cf51001 | 2010-07-22 16:18:10 -0700 | [diff] [blame] | 719 | } |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 720 | |
Mathias Agopian | 907103b | 2012-04-02 18:38:02 -0700 | [diff] [blame] | 721 | // NOTE: ASensorEvent and sensors_event_t are the same type |
| 722 | ssize_t size = SensorEventQueue::write(mChannel, |
| 723 | reinterpret_cast<ASensorEvent const*>(scratch), count); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 724 | if (size == -EAGAIN) { |
| 725 | // the destination doesn't accept events anymore, it's probably |
| 726 | // full. For now, we just drop the events on the floor. |
Steve Block | 3c20fbe | 2012-01-05 23:22:43 +0000 | [diff] [blame] | 727 | //ALOGW("dropping %d events on the floor", count); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 728 | return size; |
| 729 | } |
| 730 | |
Jeff Brown | 1e0b1e8 | 2010-09-13 23:17:30 -0700 | [diff] [blame] | 731 | return size < 0 ? status_t(size) : status_t(NO_ERROR); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 732 | } |
| 733 | |
Mathias Agopian | b398927 | 2011-10-20 18:42:02 -0700 | [diff] [blame] | 734 | sp<BitTube> SensorService::SensorEventConnection::getSensorChannel() const |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 735 | { |
| 736 | return mChannel; |
| 737 | } |
| 738 | |
| 739 | status_t SensorService::SensorEventConnection::enableDisable( |
| 740 | int handle, bool enabled) |
| 741 | { |
| 742 | status_t err; |
| 743 | if (enabled) { |
| 744 | err = mService->enable(this, handle); |
| 745 | } else { |
| 746 | err = mService->disable(this, handle); |
| 747 | } |
| 748 | return err; |
| 749 | } |
| 750 | |
| 751 | status_t SensorService::SensorEventConnection::setEventRate( |
| 752 | int handle, nsecs_t ns) |
| 753 | { |
Mathias Agopian | 7c1c531 | 2010-07-21 15:59:50 -0700 | [diff] [blame] | 754 | return mService->setEventRate(this, handle, ns); |
Mathias Agopian | fc32881 | 2010-07-14 23:41:37 -0700 | [diff] [blame] | 755 | } |
| 756 | |
| 757 | // --------------------------------------------------------------------------- |
| 758 | }; // namespace android |
| 759 | |