blob: ef87e5c9fa295a61387edeb80e95a4bba4409f81 [file] [log] [blame]
Mathias Agopianfc328812010-07-14 23:41:37 -07001/*
2 * Copyright (C) 2010 The Android Open Source Project
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
Mark Salyzyn92dc3fc2014-03-12 13:12:44 -070017#include <inttypes.h>
Mathias Agopianf001c922010-11-11 17:58:51 -080018#include <math.h>
Mark Salyzyn92dc3fc2014-03-12 13:12:44 -070019#include <stdint.h>
Mathias Agopianfc328812010-07-14 23:41:37 -070020#include <sys/types.h>
Aravind Akella56ae4262014-07-10 16:01:10 -070021#include <sys/socket.h>
Mathias Agopianfc328812010-07-14 23:41:37 -070022
Mathias Agopian33015422011-05-27 18:18:13 -070023#include <cutils/properties.h>
24
Mathias Agopianfc328812010-07-14 23:41:37 -070025#include <utils/SortedVector.h>
26#include <utils/KeyedVector.h>
27#include <utils/threads.h>
28#include <utils/Atomic.h>
29#include <utils/Errors.h>
30#include <utils/RefBase.h>
Mathias Agopian451beee2010-07-19 15:03:55 -070031#include <utils/Singleton.h>
Mathias Agopianc4a930d2010-07-22 22:19:43 -070032#include <utils/String16.h>
Mathias Agopianfc328812010-07-14 23:41:37 -070033
34#include <binder/BinderService.h>
Mathias Agopian451beee2010-07-19 15:03:55 -070035#include <binder/IServiceManager.h>
Mathias Agopian1cb13462011-06-27 16:05:52 -070036#include <binder/PermissionCache.h>
Mathias Agopianfc328812010-07-14 23:41:37 -070037
38#include <gui/ISensorServer.h>
39#include <gui/ISensorEventConnection.h>
Mathias Agopian907103b2012-04-02 18:38:02 -070040#include <gui/SensorEventQueue.h>
Mathias Agopianfc328812010-07-14 23:41:37 -070041
42#include <hardware/sensors.h>
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -070043#include <hardware_legacy/power.h>
Mathias Agopianfc328812010-07-14 23:41:37 -070044
Mathias Agopian787ac1b2012-09-18 18:49:18 -070045#include "BatteryService.h"
Mathias Agopian984826c2011-05-17 22:54:42 -070046#include "CorrectedGyroSensor.h"
Mathias Agopianf001c922010-11-11 17:58:51 -080047#include "GravitySensor.h"
48#include "LinearAccelerationSensor.h"
Mathias Agopian984826c2011-05-17 22:54:42 -070049#include "OrientationSensor.h"
Mathias Agopianf001c922010-11-11 17:58:51 -080050#include "RotationVectorSensor.h"
Mathias Agopian984826c2011-05-17 22:54:42 -070051#include "SensorFusion.h"
52#include "SensorService.h"
Mathias Agopianfc328812010-07-14 23:41:37 -070053
54namespace android {
55// ---------------------------------------------------------------------------
56
Mathias Agopian33015422011-05-27 18:18:13 -070057/*
58 * Notes:
59 *
60 * - what about a gyro-corrected magnetic-field sensor?
Mathias Agopian33015422011-05-27 18:18:13 -070061 * - run mag sensor from time to time to force calibration
62 * - gravity sensor length is wrong (=> drift in linear-acc sensor)
63 *
64 */
65
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -070066const char* SensorService::WAKE_LOCK_NAME = "SensorService";
67
Mathias Agopianfc328812010-07-14 23:41:37 -070068SensorService::SensorService()
Mathias Agopian1cb13462011-06-27 16:05:52 -070069 : mInitCheck(NO_INIT)
Mathias Agopianfc328812010-07-14 23:41:37 -070070{
71}
72
73void SensorService::onFirstRef()
74{
Steve Blocka5512372011-12-20 16:23:08 +000075 ALOGD("nuSensorService starting...");
Mathias Agopian50df2952010-07-19 19:09:10 -070076
Mathias Agopianf001c922010-11-11 17:58:51 -080077 SensorDevice& dev(SensorDevice::getInstance());
Mathias Agopianfc328812010-07-14 23:41:37 -070078
Mathias Agopianf001c922010-11-11 17:58:51 -080079 if (dev.initCheck() == NO_ERROR) {
Mathias Agopianf001c922010-11-11 17:58:51 -080080 sensor_t const* list;
Mathias Agopian7b2b32f2011-07-14 16:39:46 -070081 ssize_t count = dev.getSensorList(&list);
82 if (count > 0) {
83 ssize_t orientationIndex = -1;
84 bool hasGyro = false;
85 uint32_t virtualSensorsNeeds =
86 (1<<SENSOR_TYPE_GRAVITY) |
87 (1<<SENSOR_TYPE_LINEAR_ACCELERATION) |
88 (1<<SENSOR_TYPE_ROTATION_VECTOR);
89
90 mLastEventSeen.setCapacity(count);
91 for (ssize_t i=0 ; i<count ; i++) {
92 registerSensor( new HardwareSensor(list[i]) );
93 switch (list[i].type) {
94 case SENSOR_TYPE_ORIENTATION:
95 orientationIndex = i;
96 break;
97 case SENSOR_TYPE_GYROSCOPE:
Mathias Agopian03193062013-05-10 19:32:39 -070098 case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
Mathias Agopian7b2b32f2011-07-14 16:39:46 -070099 hasGyro = true;
100 break;
101 case SENSOR_TYPE_GRAVITY:
102 case SENSOR_TYPE_LINEAR_ACCELERATION:
103 case SENSOR_TYPE_ROTATION_VECTOR:
104 virtualSensorsNeeds &= ~(1<<list[i].type);
105 break;
106 }
Mathias Agopian50df2952010-07-19 19:09:10 -0700107 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700108
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700109 // it's safe to instantiate the SensorFusion object here
110 // (it wants to be instantiated after h/w sensors have been
111 // registered)
112 const SensorFusion& fusion(SensorFusion::getInstance());
Mathias Agopian984826c2011-05-17 22:54:42 -0700113
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700114 // build the sensor list returned to users
115 mUserSensorList = mSensorList;
Mathias Agopian33264862012-06-28 19:46:54 -0700116
117 if (hasGyro) {
Mathias Agopian03193062013-05-10 19:32:39 -0700118 Sensor aSensor;
119
120 // Add Android virtual sensors if they're not already
121 // available in the HAL
122
123 aSensor = registerVirtualSensor( new RotationVectorSensor() );
124 if (virtualSensorsNeeds & (1<<SENSOR_TYPE_ROTATION_VECTOR)) {
125 mUserSensorList.add(aSensor);
126 }
127
128 aSensor = registerVirtualSensor( new GravitySensor(list, count) );
129 if (virtualSensorsNeeds & (1<<SENSOR_TYPE_GRAVITY)) {
130 mUserSensorList.add(aSensor);
131 }
132
133 aSensor = registerVirtualSensor( new LinearAccelerationSensor(list, count) );
134 if (virtualSensorsNeeds & (1<<SENSOR_TYPE_LINEAR_ACCELERATION)) {
135 mUserSensorList.add(aSensor);
136 }
137
138 aSensor = registerVirtualSensor( new OrientationSensor() );
139 if (virtualSensorsNeeds & (1<<SENSOR_TYPE_ROTATION_VECTOR)) {
140 // if we are doing our own rotation-vector, also add
141 // the orientation sensor and remove the HAL provided one.
142 mUserSensorList.replaceAt(aSensor, orientationIndex);
143 }
144
Mathias Agopian33264862012-06-28 19:46:54 -0700145 // virtual debugging sensors are not added to mUserSensorList
Mathias Agopian03193062013-05-10 19:32:39 -0700146 registerVirtualSensor( new CorrectedGyroSensor(list, count) );
Mathias Agopian33264862012-06-28 19:46:54 -0700147 registerVirtualSensor( new GyroDriftSensor() );
148 }
149
Mathias Agopian33264862012-06-28 19:46:54 -0700150 // debugging sensor list
Mathias Agopian03193062013-05-10 19:32:39 -0700151 mUserSensorListDebug = mSensorList;
Mathias Agopian33264862012-06-28 19:46:54 -0700152
Aravind Akella5466c3d2014-08-22 16:11:10 -0700153 // Check if the device really supports batching by looking at the FIFO event
154 // counts for each sensor.
155 bool batchingSupported = false;
156 for (int i = 0; i < mSensorList.size(); ++i) {
157 if (mSensorList[i].getFifoMaxEventCount() > 0) {
158 batchingSupported = true;
159 break;
160 }
161 }
162
163 if (batchingSupported) {
164 // Increase socket buffer size to a max of 100 KB for batching capabilities.
165 mSocketBufferSize = MAX_SOCKET_BUFFER_SIZE_BATCHED;
166 } else {
167 mSocketBufferSize = SOCKET_BUFFER_SIZE_NON_BATCHED;
168 }
169
170 // Compare the socketBufferSize value against the system limits and limit
171 // it to maxSystemSocketBufferSize if necessary.
Aravind Akella4c8b9512013-09-05 17:03:38 -0700172 FILE *fp = fopen("/proc/sys/net/core/wmem_max", "r");
173 char line[128];
174 if (fp != NULL && fgets(line, sizeof(line), fp) != NULL) {
175 line[sizeof(line) - 1] = '\0';
Aravind Akella5466c3d2014-08-22 16:11:10 -0700176 size_t maxSystemSocketBufferSize;
177 sscanf(line, "%zu", &maxSystemSocketBufferSize);
178 if (mSocketBufferSize > maxSystemSocketBufferSize) {
179 mSocketBufferSize = maxSystemSocketBufferSize;
Aravind Akella4c8b9512013-09-05 17:03:38 -0700180 }
181 }
Aravind Akella4c8b9512013-09-05 17:03:38 -0700182 if (fp) {
183 fclose(fp);
184 }
185
Aravind Akella9a844cf2014-02-11 18:58:52 -0800186 mWakeLockAcquired = false;
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700187 run("SensorService", PRIORITY_URGENT_DISPLAY);
Aravind Akella56ae4262014-07-10 16:01:10 -0700188 mLooper = new Looper(false);
Mathias Agopian7b2b32f2011-07-14 16:39:46 -0700189 mInitCheck = NO_ERROR;
190 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700191 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700192}
193
Mathias Agopian03193062013-05-10 19:32:39 -0700194Sensor SensorService::registerSensor(SensorInterface* s)
Mathias Agopianf001c922010-11-11 17:58:51 -0800195{
196 sensors_event_t event;
197 memset(&event, 0, sizeof(event));
198
199 const Sensor sensor(s->getSensor());
200 // add to the sensor list (returned to clients)
201 mSensorList.add(sensor);
202 // add to our handle->SensorInterface mapping
203 mSensorMap.add(sensor.getHandle(), s);
204 // create an entry in the mLastEventSeen array
205 mLastEventSeen.add(sensor.getHandle(), event);
Mathias Agopian03193062013-05-10 19:32:39 -0700206
207 return sensor;
Mathias Agopianf001c922010-11-11 17:58:51 -0800208}
209
Mathias Agopian03193062013-05-10 19:32:39 -0700210Sensor SensorService::registerVirtualSensor(SensorInterface* s)
Mathias Agopianf001c922010-11-11 17:58:51 -0800211{
Mathias Agopian03193062013-05-10 19:32:39 -0700212 Sensor sensor = registerSensor(s);
Mathias Agopianf001c922010-11-11 17:58:51 -0800213 mVirtualSensorList.add( s );
Mathias Agopian03193062013-05-10 19:32:39 -0700214 return sensor;
Mathias Agopianf001c922010-11-11 17:58:51 -0800215}
216
Mathias Agopianfc328812010-07-14 23:41:37 -0700217SensorService::~SensorService()
218{
Mathias Agopianf001c922010-11-11 17:58:51 -0800219 for (size_t i=0 ; i<mSensorMap.size() ; i++)
220 delete mSensorMap.valueAt(i);
Mathias Agopianfc328812010-07-14 23:41:37 -0700221}
222
Mathias Agopian1cb13462011-06-27 16:05:52 -0700223static const String16 sDump("android.permission.DUMP");
224
Mark Salyzyn92dc3fc2014-03-12 13:12:44 -0700225status_t SensorService::dump(int fd, const Vector<String16>& /*args*/)
Mathias Agopianfc328812010-07-14 23:41:37 -0700226{
Mathias Agopianfc328812010-07-14 23:41:37 -0700227 String8 result;
Mathias Agopian1cb13462011-06-27 16:05:52 -0700228 if (!PermissionCache::checkCallingPermission(sDump)) {
Mathias Agopianba02cd22013-07-03 16:20:57 -0700229 result.appendFormat("Permission Denial: "
Aravind Akella70018042014-04-07 22:52:37 +0000230 "can't dump SensorService from pid=%d, uid=%d\n",
Mathias Agopianfc328812010-07-14 23:41:37 -0700231 IPCThreadState::self()->getCallingPid(),
232 IPCThreadState::self()->getCallingUid());
Mathias Agopianfc328812010-07-14 23:41:37 -0700233 } else {
234 Mutex::Autolock _l(mLock);
Mathias Agopianba02cd22013-07-03 16:20:57 -0700235 result.append("Sensor List:\n");
Mathias Agopian3560fb22010-07-22 21:24:39 -0700236 for (size_t i=0 ; i<mSensorList.size() ; i++) {
237 const Sensor& s(mSensorList[i]);
238 const sensors_event_t& e(mLastEventSeen.valueFor(s.getHandle()));
Mathias Agopianba02cd22013-07-03 16:20:57 -0700239 result.appendFormat(
Aravind Akella6c2664a2014-08-13 12:24:50 -0700240 "%-15s| %-10s| %-20s| 0x%08x | \"%s\" | type=%d |",
Mathias Agopian3560fb22010-07-22 21:24:39 -0700241 s.getName().string(),
242 s.getVendor().string(),
Aravind Akella70018042014-04-07 22:52:37 +0000243 s.getStringType().string(),
244 s.getHandle(),
Aravind Akella6c2664a2014-08-13 12:24:50 -0700245 s.getRequiredPermission().string(),
246 s.getType());
Mathias Agopian3560fb22010-07-22 21:24:39 -0700247
Aravind Akella0e025c52014-06-03 19:19:57 -0700248 const int reportingMode = s.getReportingMode();
249 if (reportingMode == AREPORTING_MODE_CONTINUOUS) {
Aravind Akella6c2664a2014-08-13 12:24:50 -0700250 result.append(" continuous | ");
Aravind Akella0e025c52014-06-03 19:19:57 -0700251 } else if (reportingMode == AREPORTING_MODE_ON_CHANGE) {
Aravind Akella6c2664a2014-08-13 12:24:50 -0700252 result.append(" on-change | ");
Aravind Akella0e025c52014-06-03 19:19:57 -0700253 } else if (reportingMode == AREPORTING_MODE_ONE_SHOT) {
Aravind Akella6c2664a2014-08-13 12:24:50 -0700254 result.append(" one-shot | ");
Mathias Agopianba02cd22013-07-03 16:20:57 -0700255 } else {
Aravind Akella6c2664a2014-08-13 12:24:50 -0700256 result.append(" special-trigger | ");
257 }
258
259 if (s.getMaxDelay() > 0) {
260 result.appendFormat("minRate=%.2fHz | ", 1e6f / s.getMaxDelay());
261 } else {
262 result.appendFormat("maxDelay=%dus |", s.getMaxDelay());
Mathias Agopianba02cd22013-07-03 16:20:57 -0700263 }
Aravind Akella0e025c52014-06-03 19:19:57 -0700264
265 if (s.getMinDelay() > 0) {
Aravind Akella6c2664a2014-08-13 12:24:50 -0700266 result.appendFormat("maxRate=%.2fHz | ", 1e6f / s.getMinDelay());
Aravind Akella0e025c52014-06-03 19:19:57 -0700267 } else {
Aravind Akella6c2664a2014-08-13 12:24:50 -0700268 result.appendFormat("minDelay=%dus |", s.getMinDelay());
Aravind Akella0e025c52014-06-03 19:19:57 -0700269 }
270
Aravind Akella724d91d2013-06-27 12:04:23 -0700271 if (s.getFifoMaxEventCount() > 0) {
Aravind Akella70018042014-04-07 22:52:37 +0000272 result.appendFormat("FifoMax=%d events | ",
273 s.getFifoMaxEventCount());
Aravind Akella724d91d2013-06-27 12:04:23 -0700274 } else {
Aravind Akella6c2664a2014-08-13 12:24:50 -0700275 result.append("no batching | ");
276 }
277
278 if (s.isWakeUpSensor()) {
279 result.appendFormat("wakeUp | ");
280 } else {
281 result.appendFormat("non-wakeUp | ");
Aravind Akella724d91d2013-06-27 12:04:23 -0700282 }
Mathias Agopianba02cd22013-07-03 16:20:57 -0700283
284 switch (s.getType()) {
285 case SENSOR_TYPE_ROTATION_VECTOR:
286 case SENSOR_TYPE_GEOMAGNETIC_ROTATION_VECTOR:
287 result.appendFormat(
Aravind Akella6c2664a2014-08-13 12:24:50 -0700288 "last=<%5.1f,%5.1f,%5.1f,%5.1f,%5.1f, %" PRId64 ">\n",
289 e.data[0], e.data[1], e.data[2], e.data[3], e.data[4], e.timestamp);
Mathias Agopianba02cd22013-07-03 16:20:57 -0700290 break;
291 case SENSOR_TYPE_MAGNETIC_FIELD_UNCALIBRATED:
292 case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
293 result.appendFormat(
Aravind Akella6c2664a2014-08-13 12:24:50 -0700294 "last=<%5.1f,%5.1f,%5.1f,%5.1f,%5.1f,%5.1f, %" PRId64 ">\n",
295 e.data[0], e.data[1], e.data[2], e.data[3], e.data[4], e.data[5],
296 e.timestamp);
Mathias Agopianba02cd22013-07-03 16:20:57 -0700297 break;
298 case SENSOR_TYPE_GAME_ROTATION_VECTOR:
299 result.appendFormat(
Aravind Akella6c2664a2014-08-13 12:24:50 -0700300 "last=<%5.1f,%5.1f,%5.1f,%5.1f, %" PRId64 ">\n",
301 e.data[0], e.data[1], e.data[2], e.data[3], e.timestamp);
Mathias Agopianba02cd22013-07-03 16:20:57 -0700302 break;
303 case SENSOR_TYPE_SIGNIFICANT_MOTION:
304 case SENSOR_TYPE_STEP_DETECTOR:
Aravind Akella6c2664a2014-08-13 12:24:50 -0700305 result.appendFormat( "last=<%f %" PRId64 ">\n", e.data[0], e.timestamp);
Mathias Agopianba02cd22013-07-03 16:20:57 -0700306 break;
307 case SENSOR_TYPE_STEP_COUNTER:
Aravind Akella6c2664a2014-08-13 12:24:50 -0700308 result.appendFormat( "last=<%" PRIu64 ", %" PRId64 ">\n", e.u64.step_counter,
309 e.timestamp);
Mathias Agopianba02cd22013-07-03 16:20:57 -0700310 break;
311 default:
312 // default to 3 values
313 result.appendFormat(
Aravind Akella6c2664a2014-08-13 12:24:50 -0700314 "last=<%5.1f,%5.1f,%5.1f, %" PRId64 ">\n",
315 e.data[0], e.data[1], e.data[2], e.timestamp);
Mathias Agopianba02cd22013-07-03 16:20:57 -0700316 break;
317 }
Aravind Akella6c2664a2014-08-13 12:24:50 -0700318 result.append("\n");
Mathias Agopianba02cd22013-07-03 16:20:57 -0700319 }
320 SensorFusion::getInstance().dump(result);
321 SensorDevice::getInstance().dump(result);
322
Mathias Agopianba02cd22013-07-03 16:20:57 -0700323 result.append("Active sensors:\n");
Mathias Agopianfc328812010-07-14 23:41:37 -0700324 for (size_t i=0 ; i<mActiveSensors.size() ; i++) {
Mathias Agopian5d270722010-07-19 15:20:39 -0700325 int handle = mActiveSensors.keyAt(i);
Mark Salyzyn92dc3fc2014-03-12 13:12:44 -0700326 result.appendFormat("%s (handle=0x%08x, connections=%zu)\n",
Mathias Agopian5d270722010-07-19 15:20:39 -0700327 getSensorName(handle).string(),
328 handle,
Mathias Agopianfc328812010-07-14 23:41:37 -0700329 mActiveSensors.valueAt(i)->getNumConnections());
Mathias Agopianfc328812010-07-14 23:41:37 -0700330 }
Aravind Akella4c8b9512013-09-05 17:03:38 -0700331
Aravind Akella5466c3d2014-08-22 16:11:10 -0700332 result.appendFormat("Socket Buffer size = %d events\n",
Aravind Akella6c2664a2014-08-13 12:24:50 -0700333 mSocketBufferSize/sizeof(sensors_event_t));
Aravind Akella9a844cf2014-02-11 18:58:52 -0800334 result.appendFormat("WakeLock Status: %s \n", mWakeLockAcquired ? "acquired" : "not held");
Mark Salyzyn92dc3fc2014-03-12 13:12:44 -0700335 result.appendFormat("%zd active connections\n", mActiveConnections.size());
Aravind Akella4c8b9512013-09-05 17:03:38 -0700336
337 for (size_t i=0 ; i < mActiveConnections.size() ; i++) {
338 sp<SensorEventConnection> connection(mActiveConnections[i].promote());
339 if (connection != 0) {
Mark Salyzyn92dc3fc2014-03-12 13:12:44 -0700340 result.appendFormat("Connection Number: %zu \n", i);
Aravind Akella4c8b9512013-09-05 17:03:38 -0700341 connection->dump(result);
342 }
343 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700344 }
345 write(fd, result.string(), result.size());
346 return NO_ERROR;
347}
348
Aravind Akella9a844cf2014-02-11 18:58:52 -0800349void SensorService::cleanupAutoDisabledSensorLocked(const sp<SensorEventConnection>& connection,
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700350 sensors_event_t const* buffer, const int count) {
351 for (int i=0 ; i<count ; i++) {
352 int handle = buffer[i].sensor;
Aravind Akella0e025c52014-06-03 19:19:57 -0700353 if (connection->hasSensor(handle)) {
354 SensorInterface* sensor = mSensorMap.valueFor(handle);
355 // If this buffer has an event from a one_shot sensor and this connection is registered
356 // for this particular one_shot sensor, try cleaning up the connection.
357 if (sensor != NULL &&
358 sensor->getSensor().getReportingMode() == AREPORTING_MODE_ONE_SHOT) {
359 sensor->autoDisable(connection.get(), handle);
Aravind Akella9a844cf2014-02-11 18:58:52 -0800360 cleanupWithoutDisableLocked(connection, handle);
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700361 }
362 }
363 }
364}
365
Mathias Agopianfc328812010-07-14 23:41:37 -0700366bool SensorService::threadLoop()
367{
Steve Blocka5512372011-12-20 16:23:08 +0000368 ALOGD("nuSensorService thread starting...");
Mathias Agopianfc328812010-07-14 23:41:37 -0700369
Mathias Agopian90ed3e82013-09-09 23:36:25 -0700370 // each virtual sensor could generate an event per "real" event, that's why we need
371 // to size numEventMax much smaller than MAX_RECEIVE_BUFFER_EVENT_COUNT.
372 // in practice, this is too aggressive, but guaranteed to be enough.
373 const size_t minBufferSize = SensorEventQueue::MAX_RECEIVE_BUFFER_EVENT_COUNT;
374 const size_t numEventMax = minBufferSize / (1 + mVirtualSensorList.size());
375
Mathias Agopiand1920ff2012-05-29 19:46:14 -0700376 sensors_event_t buffer[minBufferSize];
377 sensors_event_t scratch[minBufferSize];
Mathias Agopianf001c922010-11-11 17:58:51 -0800378 SensorDevice& device(SensorDevice::getInstance());
379 const size_t vcount = mVirtualSensorList.size();
Mathias Agopianfc328812010-07-14 23:41:37 -0700380
Aravind Akella56ae4262014-07-10 16:01:10 -0700381 SensorEventAckReceiver sender(this);
382 sender.run("SensorEventAckReceiver", PRIORITY_URGENT_DISPLAY);
Mathias Agopianf001c922010-11-11 17:58:51 -0800383 ssize_t count;
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700384 const int halVersion = device.getHalDeviceVersion();
Mathias Agopianfc328812010-07-14 23:41:37 -0700385 do {
Mathias Agopianf001c922010-11-11 17:58:51 -0800386 count = device.poll(buffer, numEventMax);
Mathias Agopianfc328812010-07-14 23:41:37 -0700387 if (count<0) {
Steve Blockf5a12302012-01-06 19:20:56 +0000388 ALOGE("sensor poll failed (%s)", strerror(-count));
Mathias Agopianfc328812010-07-14 23:41:37 -0700389 break;
390 }
Aravind Akella56ae4262014-07-10 16:01:10 -0700391
392 // Reset sensors_event_t.flags to zero for all events in the buffer.
393 for (int i = 0; i < count; i++) {
394 buffer[i].flags = 0;
395 }
Aravind Akella9a844cf2014-02-11 18:58:52 -0800396 Mutex::Autolock _l(mLock);
397 // Poll has returned. Hold a wakelock if one of the events is from a wake up sensor. The
398 // rest of this loop is under a critical section protected by mLock. Acquiring a wakeLock,
399 // sending events to clients (incrementing SensorEventConnection::mWakeLockRefCount) should
400 // not be interleaved with decrementing SensorEventConnection::mWakeLockRefCount and
401 // releasing the wakelock.
402 bool bufferHasWakeUpEvent = false;
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700403 for (int i = 0; i < count; i++) {
Aravind Akella9a844cf2014-02-11 18:58:52 -0800404 if (isWakeUpSensorEvent(buffer[i])) {
405 bufferHasWakeUpEvent = true;
406 break;
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700407 }
408 }
409
Aravind Akella9a844cf2014-02-11 18:58:52 -0800410 if (bufferHasWakeUpEvent && !mWakeLockAcquired) {
411 acquire_wake_lock(PARTIAL_WAKE_LOCK, WAKE_LOCK_NAME);
412 mWakeLockAcquired = true;
413 ALOGD_IF(DEBUG_CONNECTIONS, "acquired wakelock %s", WAKE_LOCK_NAME);
414 }
415 recordLastValueLocked(buffer, count);
Mathias Agopian94e8f682010-11-10 17:50:28 -0800416
Mathias Agopianf001c922010-11-11 17:58:51 -0800417 // handle virtual sensors
418 if (count && vcount) {
Mathias Agopian984826c2011-05-17 22:54:42 -0700419 sensors_event_t const * const event = buffer;
Aravind Akella9a844cf2014-02-11 18:58:52 -0800420 const size_t activeVirtualSensorCount = mActiveVirtualSensors.size();
Mathias Agopianf001c922010-11-11 17:58:51 -0800421 if (activeVirtualSensorCount) {
422 size_t k = 0;
Mathias Agopian984826c2011-05-17 22:54:42 -0700423 SensorFusion& fusion(SensorFusion::getInstance());
424 if (fusion.isEnabled()) {
425 for (size_t i=0 ; i<size_t(count) ; i++) {
426 fusion.process(event[i]);
427 }
428 }
Mathias Agopiand1920ff2012-05-29 19:46:14 -0700429 for (size_t i=0 ; i<size_t(count) && k<minBufferSize ; i++) {
Mathias Agopianf001c922010-11-11 17:58:51 -0800430 for (size_t j=0 ; j<activeVirtualSensorCount ; j++) {
Mathias Agopiand1920ff2012-05-29 19:46:14 -0700431 if (count + k >= minBufferSize) {
432 ALOGE("buffer too small to hold all events: "
Mark Salyzyndb458612014-06-10 14:50:02 -0700433 "count=%zd, k=%zu, size=%zu",
Mathias Agopiand1920ff2012-05-29 19:46:14 -0700434 count, k, minBufferSize);
435 break;
436 }
Mathias Agopianf001c922010-11-11 17:58:51 -0800437 sensors_event_t out;
Aravind Akella9a844cf2014-02-11 18:58:52 -0800438 SensorInterface* si = mActiveVirtualSensors.valueAt(j);
Mathias Agopiand1920ff2012-05-29 19:46:14 -0700439 if (si->process(&out, event[i])) {
Mathias Agopianf001c922010-11-11 17:58:51 -0800440 buffer[count + k] = out;
441 k++;
442 }
443 }
444 }
445 if (k) {
446 // record the last synthesized values
Aravind Akella9a844cf2014-02-11 18:58:52 -0800447 recordLastValueLocked(&buffer[count], k);
Mathias Agopianf001c922010-11-11 17:58:51 -0800448 count += k;
449 // sort the buffer by time-stamps
450 sortEventBuffer(buffer, count);
Mathias Agopianfc328812010-07-14 23:41:37 -0700451 }
452 }
453 }
454
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700455 // handle backward compatibility for RotationVector sensor
456 if (halVersion < SENSORS_DEVICE_API_VERSION_1_0) {
457 for (int i = 0; i < count; i++) {
Mathias Agopian7438fd12013-07-08 12:50:39 -0700458 if (buffer[i].type == SENSOR_TYPE_ROTATION_VECTOR) {
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700459 // All the 4 components of the quaternion should be available
460 // No heading accuracy. Set it to -1
461 buffer[i].data[4] = -1;
462 }
463 }
464 }
465
Aravind Akella9a844cf2014-02-11 18:58:52 -0800466 // Send our events to clients. Check the state of wake lock for each client and release the
467 // lock if none of the clients need it.
468 bool needsWakeLock = false;
469 for (size_t i=0 ; i < mActiveConnections.size(); i++) {
470 sp<SensorEventConnection> connection(mActiveConnections[i].promote());
Mathias Agopianf001c922010-11-11 17:58:51 -0800471 if (connection != 0) {
472 connection->sendEvents(buffer, count, scratch);
Aravind Akella9a844cf2014-02-11 18:58:52 -0800473 needsWakeLock |= connection->needsWakeLock();
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700474 // Some sensors need to be auto disabled after the trigger
Aravind Akella9a844cf2014-02-11 18:58:52 -0800475 cleanupAutoDisabledSensorLocked(connection, buffer, count);
Mathias Agopianf001c922010-11-11 17:58:51 -0800476 }
477 }
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700478
Aravind Akella9a844cf2014-02-11 18:58:52 -0800479 if (mWakeLockAcquired && !needsWakeLock) {
480 release_wake_lock(WAKE_LOCK_NAME);
481 mWakeLockAcquired = false;
482 ALOGD_IF(DEBUG_CONNECTIONS, "released wakelock %s", WAKE_LOCK_NAME);
483 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700484 } while (count >= 0 || Thread::exitPending());
485
Steve Block3c20fbe2012-01-05 23:22:43 +0000486 ALOGW("Exiting SensorService::threadLoop => aborting...");
Mathias Agopian1a623012011-11-09 17:50:15 -0800487 abort();
Mathias Agopianfc328812010-07-14 23:41:37 -0700488 return false;
489}
490
Aravind Akella56ae4262014-07-10 16:01:10 -0700491sp<Looper> SensorService::getLooper() const {
492 return mLooper;
493}
494
495bool SensorService::SensorEventAckReceiver::threadLoop() {
496 ALOGD("new thread SensorEventAckReceiver");
497 do {
498 sp<Looper> looper = mService->getLooper();
499 looper->pollOnce(-1);
500 } while(!Thread::exitPending());
501 return false;
502}
503
Aravind Akella9a844cf2014-02-11 18:58:52 -0800504void SensorService::recordLastValueLocked(
Aravind Akella4b847042014-03-03 19:02:46 -0800505 const sensors_event_t* buffer, size_t count) {
Aravind Akella4b847042014-03-03 19:02:46 -0800506 const sensors_event_t* last = NULL;
507 for (size_t i = 0; i < count; i++) {
508 const sensors_event_t* event = &buffer[i];
509 if (event->type != SENSOR_TYPE_META_DATA) {
510 if (last && event->sensor != last->sensor) {
511 mLastEventSeen.editValueFor(last->sensor) = *last;
512 }
513 last = event;
Mathias Agopian94e8f682010-11-10 17:50:28 -0800514 }
515 }
Aravind Akella4b847042014-03-03 19:02:46 -0800516 if (last) {
517 mLastEventSeen.editValueFor(last->sensor) = *last;
518 }
Mathias Agopian94e8f682010-11-10 17:50:28 -0800519}
520
Mathias Agopianf001c922010-11-11 17:58:51 -0800521void SensorService::sortEventBuffer(sensors_event_t* buffer, size_t count)
522{
523 struct compar {
524 static int cmp(void const* lhs, void const* rhs) {
525 sensors_event_t const* l = static_cast<sensors_event_t const*>(lhs);
526 sensors_event_t const* r = static_cast<sensors_event_t const*>(rhs);
Mathias Agopiana5c106a2012-04-19 18:18:24 -0700527 return l->timestamp - r->timestamp;
Mathias Agopianf001c922010-11-11 17:58:51 -0800528 }
529 };
530 qsort(buffer, count, sizeof(sensors_event_t), compar::cmp);
531}
532
Mathias Agopian5d270722010-07-19 15:20:39 -0700533String8 SensorService::getSensorName(int handle) const {
Mathias Agopian010e4222011-06-08 20:06:50 -0700534 size_t count = mUserSensorList.size();
Mathias Agopian5d270722010-07-19 15:20:39 -0700535 for (size_t i=0 ; i<count ; i++) {
Mathias Agopian010e4222011-06-08 20:06:50 -0700536 const Sensor& sensor(mUserSensorList[i]);
Mathias Agopian5d270722010-07-19 15:20:39 -0700537 if (sensor.getHandle() == handle) {
538 return sensor.getName();
539 }
540 }
541 String8 result("unknown");
542 return result;
543}
544
Aravind Akellab4099e72013-10-15 15:43:10 -0700545bool SensorService::isVirtualSensor(int handle) const {
546 SensorInterface* sensor = mSensorMap.valueFor(handle);
547 return sensor->isVirtual();
548}
549
Aravind Akella9a844cf2014-02-11 18:58:52 -0800550bool SensorService::isWakeUpSensorEvent(const sensors_event_t& event) const {
Sean Wan7869e222014-07-14 17:07:33 -0700551 int handle = event.sensor;
552 if (event.type == SENSOR_TYPE_META_DATA) {
553 handle = event.meta_data.sensor;
554 }
555 SensorInterface* sensor = mSensorMap.valueFor(handle);
556 return sensor != NULL && sensor->getSensor().isWakeUpSensor();
Aravind Akella9a844cf2014-02-11 18:58:52 -0800557}
558
Aravind Akella6c2664a2014-08-13 12:24:50 -0700559
560SensorService::SensorRecord * SensorService::getSensorRecord(int handle) {
561 return mActiveSensors.valueFor(handle);
562}
563
Mathias Agopianfc328812010-07-14 23:41:37 -0700564Vector<Sensor> SensorService::getSensorList()
565{
Mathias Agopian33264862012-06-28 19:46:54 -0700566 char value[PROPERTY_VALUE_MAX];
567 property_get("debug.sensors", value, "0");
Aravind Akella70018042014-04-07 22:52:37 +0000568 const Vector<Sensor>& initialSensorList = (atoi(value)) ?
569 mUserSensorListDebug : mUserSensorList;
570 Vector<Sensor> accessibleSensorList;
571 for (size_t i = 0; i < initialSensorList.size(); i++) {
572 Sensor sensor = initialSensorList[i];
573 if (canAccessSensor(sensor)) {
574 accessibleSensorList.add(sensor);
575 } else {
576 String8 infoMessage;
577 infoMessage.appendFormat(
578 "Skipped sensor %s because it requires permission %s",
579 sensor.getName().string(),
580 sensor.getRequiredPermission().string());
581 ALOGI(infoMessage.string());
582 }
Mathias Agopian33264862012-06-28 19:46:54 -0700583 }
Aravind Akella70018042014-04-07 22:52:37 +0000584 return accessibleSensorList;
Mathias Agopianfc328812010-07-14 23:41:37 -0700585}
586
587sp<ISensorEventConnection> SensorService::createSensorEventConnection()
588{
Mathias Agopian5307d172012-09-18 17:02:43 -0700589 uid_t uid = IPCThreadState::self()->getCallingUid();
590 sp<SensorEventConnection> result(new SensorEventConnection(this, uid));
Mathias Agopianfc328812010-07-14 23:41:37 -0700591 return result;
592}
593
Mathias Agopiandb5b4bc2011-02-03 14:52:47 -0800594void SensorService::cleanupConnection(SensorEventConnection* c)
Mathias Agopianfc328812010-07-14 23:41:37 -0700595{
596 Mutex::Autolock _l(mLock);
Mathias Agopiandb5b4bc2011-02-03 14:52:47 -0800597 const wp<SensorEventConnection> connection(c);
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700598 size_t size = mActiveSensors.size();
Mark Salyzyndb458612014-06-10 14:50:02 -0700599 ALOGD_IF(DEBUG_CONNECTIONS, "%zu active sensors", size);
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700600 for (size_t i=0 ; i<size ; ) {
Mathias Agopiandb5b4bc2011-02-03 14:52:47 -0800601 int handle = mActiveSensors.keyAt(i);
602 if (c->hasSensor(handle)) {
Mark Salyzyndb458612014-06-10 14:50:02 -0700603 ALOGD_IF(DEBUG_CONNECTIONS, "%zu: disabling handle=0x%08x", i, handle);
Mathias Agopianf001c922010-11-11 17:58:51 -0800604 SensorInterface* sensor = mSensorMap.valueFor( handle );
Steve Blockf5a12302012-01-06 19:20:56 +0000605 ALOGE_IF(!sensor, "mSensorMap[handle=0x%08x] is null!", handle);
Mathias Agopianf001c922010-11-11 17:58:51 -0800606 if (sensor) {
Mathias Agopiandb5b4bc2011-02-03 14:52:47 -0800607 sensor->activate(c, false);
Mathias Agopianf001c922010-11-11 17:58:51 -0800608 }
Mathias Agopiandb5b4bc2011-02-03 14:52:47 -0800609 }
610 SensorRecord* rec = mActiveSensors.valueAt(i);
Mark Salyzyndb458612014-06-10 14:50:02 -0700611 ALOGE_IF(!rec, "mActiveSensors[%zu] is null (handle=0x%08x)!", i, handle);
Steve Blocka5512372011-12-20 16:23:08 +0000612 ALOGD_IF(DEBUG_CONNECTIONS,
Mark Salyzyndb458612014-06-10 14:50:02 -0700613 "removing connection %p for sensor[%zu].handle=0x%08x",
Mathias Agopiana1b7db92011-05-27 16:23:58 -0700614 c, i, handle);
615
Mathias Agopiandb5b4bc2011-02-03 14:52:47 -0800616 if (rec && rec->removeConnection(connection)) {
Steve Blocka5512372011-12-20 16:23:08 +0000617 ALOGD_IF(DEBUG_CONNECTIONS, "... and it was the last connection");
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700618 mActiveSensors.removeItemsAt(i, 1);
Mathias Agopianf001c922010-11-11 17:58:51 -0800619 mActiveVirtualSensors.removeItem(handle);
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700620 delete rec;
621 size--;
622 } else {
623 i++;
Mathias Agopianfc328812010-07-14 23:41:37 -0700624 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700625 }
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700626 mActiveConnections.remove(connection);
Mathias Agopian787ac1b2012-09-18 18:49:18 -0700627 BatteryService::cleanup(c->getUid());
Aravind Akella9a844cf2014-02-11 18:58:52 -0800628 if (c->needsWakeLock()) {
629 checkWakeLockStateLocked();
630 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700631}
632
Aravind Akella70018042014-04-07 22:52:37 +0000633Sensor SensorService::getSensorFromHandle(int handle) const {
634 return mSensorMap.valueFor(handle)->getSensor();
635}
636
Mathias Agopianfc328812010-07-14 23:41:37 -0700637status_t SensorService::enable(const sp<SensorEventConnection>& connection,
Aravind Akella724d91d2013-06-27 12:04:23 -0700638 int handle, nsecs_t samplingPeriodNs, nsecs_t maxBatchReportLatencyNs, int reservedFlags)
Mathias Agopianfc328812010-07-14 23:41:37 -0700639{
Mathias Agopian50df2952010-07-19 19:09:10 -0700640 if (mInitCheck != NO_ERROR)
641 return mInitCheck;
642
Mathias Agopianf001c922010-11-11 17:58:51 -0800643 SensorInterface* sensor = mSensorMap.valueFor(handle);
Mathias Agopianac9a96d2013-07-12 02:01:16 -0700644 if (sensor == NULL) {
645 return BAD_VALUE;
646 }
Aravind Akella70018042014-04-07 22:52:37 +0000647
648 if (!verifyCanAccessSensor(sensor->getSensor(), "Tried enabling")) {
649 return BAD_VALUE;
650 }
651
Mathias Agopianac9a96d2013-07-12 02:01:16 -0700652 Mutex::Autolock _l(mLock);
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700653 SensorRecord* rec = mActiveSensors.valueFor(handle);
654 if (rec == 0) {
655 rec = new SensorRecord(connection);
656 mActiveSensors.add(handle, rec);
657 if (sensor->isVirtual()) {
658 mActiveVirtualSensors.add(handle, sensor);
659 }
660 } else {
661 if (rec->addConnection(connection)) {
Aravind Akella9a844cf2014-02-11 18:58:52 -0800662 // this sensor is already activated, but we are adding a connection that uses it.
663 // Immediately send down the last known value of the requested sensor if it's not a
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700664 // "continuous" sensor.
Aravind Akella0e025c52014-06-03 19:19:57 -0700665 if (sensor->getSensor().getReportingMode() == AREPORTING_MODE_ON_CHANGE) {
Aravind Akella9a844cf2014-02-11 18:58:52 -0800666 // NOTE: The wake_up flag of this event may get set to
667 // WAKE_UP_SENSOR_EVENT_NEEDS_ACK if this is a wake_up event.
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700668 sensors_event_t& event(mLastEventSeen.editValueFor(handle));
669 if (event.version == sizeof(sensors_event_t)) {
Aravind Akella9a844cf2014-02-11 18:58:52 -0800670 if (isWakeUpSensorEvent(event) && !mWakeLockAcquired) {
671 acquire_wake_lock(PARTIAL_WAKE_LOCK, WAKE_LOCK_NAME);
672 mWakeLockAcquired = true;
673 ALOGD_IF(DEBUG_CONNECTIONS, "acquired wakelock for on_change sensor %s",
674 WAKE_LOCK_NAME);
675 }
676 connection->sendEvents(&event, 1, NULL);
677 if (!connection->needsWakeLock() && mWakeLockAcquired) {
678 checkWakeLockStateLocked();
679 }
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700680 }
681 }
682 }
683 }
684
685 if (connection->addSensor(handle)) {
686 BatteryService::enableSensor(connection->getUid(), handle);
687 // the sensor was added (which means it wasn't already there)
688 // so, see if this connection becomes active
689 if (mActiveConnections.indexOf(connection) < 0) {
690 mActiveConnections.add(connection);
691 }
692 } else {
693 ALOGW("sensor %08x already enabled in connection %p (ignoring)",
694 handle, connection.get());
695 }
696
Aravind Akella724d91d2013-06-27 12:04:23 -0700697 nsecs_t minDelayNs = sensor->getSensor().getMinDelayNs();
698 if (samplingPeriodNs < minDelayNs) {
699 samplingPeriodNs = minDelayNs;
700 }
701
Aravind Akella6c2664a2014-08-13 12:24:50 -0700702 ALOGD_IF(DEBUG_CONNECTIONS, "Calling batch handle==%d flags=%d"
703 "rate=%" PRId64 " timeout== %" PRId64"",
Aravind Akella724d91d2013-06-27 12:04:23 -0700704 handle, reservedFlags, samplingPeriodNs, maxBatchReportLatencyNs);
705
706 status_t err = sensor->batch(connection.get(), handle, reservedFlags, samplingPeriodNs,
707 maxBatchReportLatencyNs);
Aravind Akella6c2664a2014-08-13 12:24:50 -0700708
Aravind Akella5466c3d2014-08-22 16:11:10 -0700709 // Call flush() before calling activate() on the sensor. Wait for a first flush complete
710 // event before sending events on this connection. Ignore one-shot sensors which don't
711 // support flush(). Also if this sensor isn't already active, don't call flush().
712 if (err == NO_ERROR && sensor->getSensor().getReportingMode() != AREPORTING_MODE_ONE_SHOT &&
713 rec->getNumConnections() > 1) {
714 connection->setFirstFlushPending(handle, true);
Aravind Akella4c8b9512013-09-05 17:03:38 -0700715 status_t err_flush = sensor->flush(connection.get(), handle);
Aravind Akella5466c3d2014-08-22 16:11:10 -0700716 // Flush may return error if the underlying h/w sensor uses an older HAL.
Aravind Akella6c2664a2014-08-13 12:24:50 -0700717 if (err_flush == NO_ERROR) {
Aravind Akella6c2664a2014-08-13 12:24:50 -0700718 rec->addPendingFlushConnection(connection.get());
Aravind Akella5466c3d2014-08-22 16:11:10 -0700719 } else {
720 connection->setFirstFlushPending(handle, false);
Aravind Akella4c8b9512013-09-05 17:03:38 -0700721 }
722 }
Aravind Akella724d91d2013-06-27 12:04:23 -0700723
724 if (err == NO_ERROR) {
725 ALOGD_IF(DEBUG_CONNECTIONS, "Calling activate on %d", handle);
726 err = sensor->activate(connection.get(), true);
727 }
728
Aravind Akella56ae4262014-07-10 16:01:10 -0700729 if (err == NO_ERROR && sensor->getSensor().isWakeUpSensor()) {
730 // Add the file descriptor to the Looper for receiving acknowledgments;
731 int ret = mLooper->addFd(connection->getSensorChannel()->getSendFd(), 0,
732 ALOOPER_EVENT_INPUT, connection.get(), NULL);
733 }
734
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700735 if (err != NO_ERROR) {
Aravind Akella724d91d2013-06-27 12:04:23 -0700736 // batch/activate has failed, reset our state.
Mathias Agopianac9a96d2013-07-12 02:01:16 -0700737 cleanupWithoutDisableLocked(connection, handle);
Mathias Agopianfc328812010-07-14 23:41:37 -0700738 }
739 return err;
740}
741
742status_t SensorService::disable(const sp<SensorEventConnection>& connection,
743 int handle)
744{
Mathias Agopian50df2952010-07-19 19:09:10 -0700745 if (mInitCheck != NO_ERROR)
746 return mInitCheck;
747
Mathias Agopianac9a96d2013-07-12 02:01:16 -0700748 Mutex::Autolock _l(mLock);
749 status_t err = cleanupWithoutDisableLocked(connection, handle);
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700750 if (err == NO_ERROR) {
751 SensorInterface* sensor = mSensorMap.valueFor(handle);
752 err = sensor ? sensor->activate(connection.get(), false) : status_t(BAD_VALUE);
753 }
754 return err;
755}
756
Mathias Agopianac9a96d2013-07-12 02:01:16 -0700757status_t SensorService::cleanupWithoutDisable(
758 const sp<SensorEventConnection>& connection, int handle) {
Mathias Agopianfc328812010-07-14 23:41:37 -0700759 Mutex::Autolock _l(mLock);
Mathias Agopianac9a96d2013-07-12 02:01:16 -0700760 return cleanupWithoutDisableLocked(connection, handle);
761}
762
763status_t SensorService::cleanupWithoutDisableLocked(
764 const sp<SensorEventConnection>& connection, int handle) {
Mathias Agopianfc328812010-07-14 23:41:37 -0700765 SensorRecord* rec = mActiveSensors.valueFor(handle);
Mathias Agopianfc328812010-07-14 23:41:37 -0700766 if (rec) {
767 // see if this connection becomes inactive
Mathias Agopian787ac1b2012-09-18 18:49:18 -0700768 if (connection->removeSensor(handle)) {
769 BatteryService::disableSensor(connection->getUid(), handle);
770 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700771 if (connection->hasAnySensor() == false) {
772 mActiveConnections.remove(connection);
773 }
774 // see if this sensor becomes inactive
775 if (rec->removeConnection(connection)) {
776 mActiveSensors.removeItem(handle);
Mathias Agopianf001c922010-11-11 17:58:51 -0800777 mActiveVirtualSensors.removeItem(handle);
Mathias Agopianfc328812010-07-14 23:41:37 -0700778 delete rec;
Mathias Agopianfc328812010-07-14 23:41:37 -0700779 }
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700780 return NO_ERROR;
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700781 }
Jaikumar Ganesh4342fdf2013-04-08 16:43:12 -0700782 return BAD_VALUE;
Mathias Agopianfc328812010-07-14 23:41:37 -0700783}
784
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700785status_t SensorService::setEventRate(const sp<SensorEventConnection>& connection,
Mathias Agopianfc328812010-07-14 23:41:37 -0700786 int handle, nsecs_t ns)
787{
Mathias Agopian50df2952010-07-19 19:09:10 -0700788 if (mInitCheck != NO_ERROR)
789 return mInitCheck;
790
Mathias Agopianae09d652011-11-01 17:37:49 -0700791 SensorInterface* sensor = mSensorMap.valueFor(handle);
792 if (!sensor)
793 return BAD_VALUE;
794
Aravind Akella70018042014-04-07 22:52:37 +0000795 if (!verifyCanAccessSensor(sensor->getSensor(), "Tried configuring")) {
796 return BAD_VALUE;
797 }
798
Mathias Agopian1cd70002010-07-21 15:59:50 -0700799 if (ns < 0)
800 return BAD_VALUE;
801
Mathias Agopian62569ec2011-11-07 21:21:47 -0800802 nsecs_t minDelayNs = sensor->getSensor().getMinDelayNs();
803 if (ns < minDelayNs) {
804 ns = minDelayNs;
Mathias Agopianae09d652011-11-01 17:37:49 -0700805 }
806
Mathias Agopianf001c922010-11-11 17:58:51 -0800807 return sensor->setDelay(connection.get(), handle, ns);
Mathias Agopianfc328812010-07-14 23:41:37 -0700808}
809
Aravind Akella9e3adfc2014-09-03 15:48:05 -0700810status_t SensorService::flushSensor(const sp<SensorEventConnection>& connection) {
Aravind Akella70018042014-04-07 22:52:37 +0000811 if (mInitCheck != NO_ERROR) return mInitCheck;
Aravind Akella9e3adfc2014-09-03 15:48:05 -0700812 SensorDevice& dev(SensorDevice::getInstance());
813 const int halVersion = dev.getHalDeviceVersion();
814 status_t err(NO_ERROR);
815 Mutex::Autolock _l(mLock);
816 // Loop through all sensors for this connection and call flush on each of them.
817 for (size_t i = 0; i < connection->mSensorInfo.size(); ++i) {
818 const int handle = connection->mSensorInfo.keyAt(i);
819 SensorInterface* sensor = mSensorMap.valueFor(handle);
820 if (sensor->getSensor().getReportingMode() == AREPORTING_MODE_ONE_SHOT) {
821 ALOGE("flush called on a one-shot sensor");
822 err = INVALID_OPERATION;
823 continue;
824 }
825 SensorEventConnection::FlushInfo& flushInfo = connection->mSensorInfo.editValueFor(handle);
826 if (halVersion < SENSORS_DEVICE_API_VERSION_1_1 || isVirtualSensor(handle)) {
827 // For older devices just increment pending flush count which will send a trivial
828 // flush complete event.
829 flushInfo.mPendingFlushEventsToSend++;
830 } else {
831 status_t err_flush = sensor->flush(connection.get(), handle);
832 if (err_flush == NO_ERROR) {
833 SensorRecord* rec = mActiveSensors.valueFor(handle);
834 if (rec != NULL) rec->addPendingFlushConnection(connection);
835 }
836 err = (err_flush != NO_ERROR) ? err_flush : err;
837 }
Aravind Akella70018042014-04-07 22:52:37 +0000838 }
Aravind Akella9e3adfc2014-09-03 15:48:05 -0700839 return err;
Aravind Akella724d91d2013-06-27 12:04:23 -0700840}
Aravind Akella70018042014-04-07 22:52:37 +0000841
Aravind Akella70018042014-04-07 22:52:37 +0000842bool SensorService::canAccessSensor(const Sensor& sensor) {
Aravind Akella56ae4262014-07-10 16:01:10 -0700843 return (sensor.getRequiredPermission().isEmpty()) ||
844 PermissionCache::checkCallingPermission(String16(sensor.getRequiredPermission()));
Aravind Akella70018042014-04-07 22:52:37 +0000845}
846
847bool SensorService::verifyCanAccessSensor(const Sensor& sensor, const char* operation) {
848 if (canAccessSensor(sensor)) {
849 return true;
850 } else {
851 String8 errorMessage;
852 errorMessage.appendFormat(
853 "%s a sensor (%s) without holding its required permission: %s",
854 operation,
855 sensor.getName().string(),
856 sensor.getRequiredPermission().string());
857 return false;
858 }
859}
860
Aravind Akella9a844cf2014-02-11 18:58:52 -0800861void SensorService::checkWakeLockState() {
862 Mutex::Autolock _l(mLock);
863 checkWakeLockStateLocked();
864}
865
866void SensorService::checkWakeLockStateLocked() {
867 if (!mWakeLockAcquired) {
868 return;
869 }
870 bool releaseLock = true;
871 for (size_t i=0 ; i<mActiveConnections.size() ; i++) {
872 sp<SensorEventConnection> connection(mActiveConnections[i].promote());
873 if (connection != 0) {
874 if (connection->needsWakeLock()) {
875 releaseLock = false;
876 break;
877 }
878 }
879 }
880 if (releaseLock) {
881 ALOGD_IF(DEBUG_CONNECTIONS, "releasing wakelock %s", WAKE_LOCK_NAME);
882 release_wake_lock(WAKE_LOCK_NAME);
883 mWakeLockAcquired = false;
884 }
885}
Aravind Akella6c2664a2014-08-13 12:24:50 -0700886
Mathias Agopianfc328812010-07-14 23:41:37 -0700887// ---------------------------------------------------------------------------
Mathias Agopianfc328812010-07-14 23:41:37 -0700888SensorService::SensorRecord::SensorRecord(
889 const sp<SensorEventConnection>& connection)
890{
891 mConnections.add(connection);
892}
893
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700894bool SensorService::SensorRecord::addConnection(
Mathias Agopianfc328812010-07-14 23:41:37 -0700895 const sp<SensorEventConnection>& connection)
896{
897 if (mConnections.indexOf(connection) < 0) {
898 mConnections.add(connection);
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700899 return true;
Mathias Agopianfc328812010-07-14 23:41:37 -0700900 }
Mathias Agopian7c1c5312010-07-21 15:59:50 -0700901 return false;
Mathias Agopianfc328812010-07-14 23:41:37 -0700902}
903
904bool SensorService::SensorRecord::removeConnection(
905 const wp<SensorEventConnection>& connection)
906{
907 ssize_t index = mConnections.indexOf(connection);
908 if (index >= 0) {
909 mConnections.removeItemsAt(index, 1);
910 }
Aravind Akella6c2664a2014-08-13 12:24:50 -0700911 // Remove this connections from the queue of flush() calls made on this sensor.
912 for (Vector< wp<SensorEventConnection> >::iterator it =
913 mPendingFlushConnections.begin(); it != mPendingFlushConnections.end();) {
914 if (it->unsafe_get() == connection.unsafe_get()) {
915 it = mPendingFlushConnections.erase(it);
916 } else {
917 ++it;
918 }
919 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700920 return mConnections.size() ? false : true;
921}
922
Aravind Akella6c2664a2014-08-13 12:24:50 -0700923void SensorService::SensorRecord::addPendingFlushConnection(
924 const sp<SensorEventConnection>& connection) {
925 mPendingFlushConnections.add(connection);
926}
927
928void SensorService::SensorRecord::removeFirstPendingFlushConnection() {
929 if (mPendingFlushConnections.size() > 0) {
930 mPendingFlushConnections.removeAt(0);
931 }
932}
933
934SensorService::SensorEventConnection *
935SensorService::SensorRecord::getFirstPendingFlushConnection() {
936 if (mPendingFlushConnections.size() > 0) {
937 return mPendingFlushConnections[0].unsafe_get();
938 }
939 return NULL;
940}
941
Mathias Agopianfc328812010-07-14 23:41:37 -0700942// ---------------------------------------------------------------------------
943
944SensorService::SensorEventConnection::SensorEventConnection(
Mathias Agopian5307d172012-09-18 17:02:43 -0700945 const sp<SensorService>& service, uid_t uid)
Aravind Akella56ae4262014-07-10 16:01:10 -0700946 : mService(service), mUid(uid), mWakeLockRefCount(0), mEventCache(NULL), mCacheSize(0),
947 mMaxCacheSize(0) {
Aravind Akella4c8b9512013-09-05 17:03:38 -0700948 const SensorDevice& device(SensorDevice::getInstance());
Aravind Akella5466c3d2014-08-22 16:11:10 -0700949 mChannel = new BitTube(mService->mSocketBufferSize);
Aravind Akella56ae4262014-07-10 16:01:10 -0700950#if DEBUG_CONNECTIONS
951 mEventsReceived = mEventsSentFromCache = mEventsSent = 0;
Aravind Akellae74baf62014-08-21 12:28:35 -0700952 mTotalAcksNeeded = mTotalAcksReceived = 0;
Aravind Akella56ae4262014-07-10 16:01:10 -0700953#endif
Mathias Agopianfc328812010-07-14 23:41:37 -0700954}
955
Aravind Akella56ae4262014-07-10 16:01:10 -0700956SensorService::SensorEventConnection::~SensorEventConnection() {
Steve Blocka5512372011-12-20 16:23:08 +0000957 ALOGD_IF(DEBUG_CONNECTIONS, "~SensorEventConnection(%p)", this);
Aravind Akella56ae4262014-07-10 16:01:10 -0700958 if (mEventCache != NULL) {
959 delete mEventCache;
960 }
Mathias Agopianfc328812010-07-14 23:41:37 -0700961 mService->cleanupConnection(this);
962}
963
Aravind Akella56ae4262014-07-10 16:01:10 -0700964void SensorService::SensorEventConnection::onFirstRef() {
965 LooperCallback::onFirstRef();
Mathias Agopianfc328812010-07-14 23:41:37 -0700966}
967
Aravind Akella9a844cf2014-02-11 18:58:52 -0800968bool SensorService::SensorEventConnection::needsWakeLock() {
969 Mutex::Autolock _l(mConnectionLock);
970 return mWakeLockRefCount > 0;
971}
972
Aravind Akella4c8b9512013-09-05 17:03:38 -0700973void SensorService::SensorEventConnection::dump(String8& result) {
974 Mutex::Autolock _l(mConnectionLock);
Aravind Akella56ae4262014-07-10 16:01:10 -0700975 result.appendFormat("\t %d WakeLockRefCount \n", mWakeLockRefCount);
Aravind Akella4c8b9512013-09-05 17:03:38 -0700976 for (size_t i = 0; i < mSensorInfo.size(); ++i) {
977 const FlushInfo& flushInfo = mSensorInfo.valueAt(i);
Aravind Akella6c2664a2014-08-13 12:24:50 -0700978 result.appendFormat("\t %s 0x%08x | status: %s | pending flush events %d | uid %d|"
Aravind Akella56ae4262014-07-10 16:01:10 -0700979 "cache size: %d max cache size %d\n",
Aravind Akella4c8b9512013-09-05 17:03:38 -0700980 mService->getSensorName(mSensorInfo.keyAt(i)).string(),
Aravind Akella6c2664a2014-08-13 12:24:50 -0700981 mSensorInfo.keyAt(i),
Aravind Akella4c8b9512013-09-05 17:03:38 -0700982 flushInfo.mFirstFlushPending ? "First flush pending" :
983 "active",
Patrick Tjineefced12014-02-05 15:06:03 -0800984 flushInfo.mPendingFlushEventsToSend,
Aravind Akella56ae4262014-07-10 16:01:10 -0700985 mUid,
986 mCacheSize,
987 mMaxCacheSize);
988#if DEBUG_CONNECTIONS
Aravind Akellae74baf62014-08-21 12:28:35 -0700989 result.appendFormat("\t events recvd: %d | sent %d | cache %d | dropped %d |"
990 " total_acks_needed %d | total_acks_recvd %d\n",
Aravind Akella56ae4262014-07-10 16:01:10 -0700991 mEventsReceived,
992 mEventsSent,
993 mEventsSentFromCache,
Aravind Akellae74baf62014-08-21 12:28:35 -0700994 mEventsReceived - (mEventsSentFromCache +
995 mEventsSent + mCacheSize),
996 mTotalAcksNeeded,
997 mTotalAcksReceived);
Aravind Akella56ae4262014-07-10 16:01:10 -0700998#endif
999
Aravind Akella4c8b9512013-09-05 17:03:38 -07001000 }
1001}
1002
Mathias Agopian7c1c5312010-07-21 15:59:50 -07001003bool SensorService::SensorEventConnection::addSensor(int32_t handle) {
Mathias Agopian71d7a5c2010-11-14 20:55:25 -08001004 Mutex::Autolock _l(mConnectionLock);
Aravind Akella70018042014-04-07 22:52:37 +00001005 if (!verifyCanAccessSensor(mService->getSensorFromHandle(handle), "Tried adding")) {
1006 return false;
1007 }
Aravind Akella4c8b9512013-09-05 17:03:38 -07001008 if (mSensorInfo.indexOfKey(handle) < 0) {
1009 mSensorInfo.add(handle, FlushInfo());
Mathias Agopian7c1c5312010-07-21 15:59:50 -07001010 return true;
Mathias Agopianfc328812010-07-14 23:41:37 -07001011 }
Mathias Agopian7c1c5312010-07-21 15:59:50 -07001012 return false;
Mathias Agopianfc328812010-07-14 23:41:37 -07001013}
1014
Mathias Agopian7c1c5312010-07-21 15:59:50 -07001015bool SensorService::SensorEventConnection::removeSensor(int32_t handle) {
Mathias Agopian71d7a5c2010-11-14 20:55:25 -08001016 Mutex::Autolock _l(mConnectionLock);
Aravind Akella4c8b9512013-09-05 17:03:38 -07001017 if (mSensorInfo.removeItem(handle) >= 0) {
Mathias Agopian7c1c5312010-07-21 15:59:50 -07001018 return true;
1019 }
1020 return false;
Mathias Agopianfc328812010-07-14 23:41:37 -07001021}
1022
1023bool SensorService::SensorEventConnection::hasSensor(int32_t handle) const {
Mathias Agopian71d7a5c2010-11-14 20:55:25 -08001024 Mutex::Autolock _l(mConnectionLock);
Aravind Akella4c8b9512013-09-05 17:03:38 -07001025 return mSensorInfo.indexOfKey(handle) >= 0;
Mathias Agopianfc328812010-07-14 23:41:37 -07001026}
1027
1028bool SensorService::SensorEventConnection::hasAnySensor() const {
Mathias Agopian71d7a5c2010-11-14 20:55:25 -08001029 Mutex::Autolock _l(mConnectionLock);
Mathias Agopian7c1c5312010-07-21 15:59:50 -07001030 return mSensorInfo.size() ? true : false;
1031}
1032
Aravind Akella4c8b9512013-09-05 17:03:38 -07001033void SensorService::SensorEventConnection::setFirstFlushPending(int32_t handle,
1034 bool value) {
1035 Mutex::Autolock _l(mConnectionLock);
1036 ssize_t index = mSensorInfo.indexOfKey(handle);
1037 if (index >= 0) {
1038 FlushInfo& flushInfo = mSensorInfo.editValueAt(index);
1039 flushInfo.mFirstFlushPending = value;
1040 }
1041}
1042
Mathias Agopianfc328812010-07-14 23:41:37 -07001043status_t SensorService::SensorEventConnection::sendEvents(
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001044 sensors_event_t* buffer, size_t numEvents,
Aravind Akella56ae4262014-07-10 16:01:10 -07001045 sensors_event_t* scratch) {
Mathias Agopiancf510012010-07-22 16:18:10 -07001046 // filter out events not for this connection
Mathias Agopian3560fb22010-07-22 21:24:39 -07001047 size_t count = 0;
Aravind Akella9a844cf2014-02-11 18:58:52 -08001048 Mutex::Autolock _l(mConnectionLock);
Mathias Agopian3560fb22010-07-22 21:24:39 -07001049 if (scratch) {
1050 size_t i=0;
1051 while (i<numEvents) {
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001052 // Flush complete events can be invalidated. If this event has been invalidated
1053 // before, ignore and proceed to the next event.
1054 if (buffer[i].flags & SENSOR_EVENT_INVALID_FLAG) {
1055 ++i;
1056 continue;
1057 }
Aravind Akella6c2664a2014-08-13 12:24:50 -07001058 int32_t sensor_handle = buffer[i].sensor;
Aravind Akella724d91d2013-06-27 12:04:23 -07001059 if (buffer[i].type == SENSOR_TYPE_META_DATA) {
1060 ALOGD_IF(DEBUG_CONNECTIONS, "flush complete event sensor==%d ",
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001061 buffer[i].meta_data.sensor);
Aravind Akella6c2664a2014-08-13 12:24:50 -07001062 // Setting sensor_handle to the correct sensor to ensure the sensor events per connection are
Aravind Akella724d91d2013-06-27 12:04:23 -07001063 // filtered correctly. buffer[i].sensor is zero for meta_data events.
Aravind Akella6c2664a2014-08-13 12:24:50 -07001064 sensor_handle = buffer[i].meta_data.sensor;
Aravind Akella724d91d2013-06-27 12:04:23 -07001065 }
Aravind Akella6c2664a2014-08-13 12:24:50 -07001066 ssize_t index = mSensorInfo.indexOfKey(sensor_handle);
Aravind Akella56ae4262014-07-10 16:01:10 -07001067 // Check if this connection has registered for this sensor. If not continue to the
1068 // next sensor_event.
1069 if (index < 0) {
1070 ++i;
1071 continue;
Aravind Akella4c8b9512013-09-05 17:03:38 -07001072 }
Aravind Akella56ae4262014-07-10 16:01:10 -07001073
Aravind Akella56ae4262014-07-10 16:01:10 -07001074 FlushInfo& flushInfo = mSensorInfo.editValueAt(index);
Aravind Akella6c2664a2014-08-13 12:24:50 -07001075 // Check if there is a pending flush_complete event for this sensor on this connection.
1076 if (buffer[i].type == SENSOR_TYPE_META_DATA && flushInfo.mFirstFlushPending == true) {
1077 SensorService::SensorRecord *rec = mService->getSensorRecord(sensor_handle);
1078 if (rec && rec->getFirstPendingFlushConnection() == this) {
1079 rec->removeFirstPendingFlushConnection();
Aravind Akella56ae4262014-07-10 16:01:10 -07001080 flushInfo.mFirstFlushPending = false;
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001081 // Invalidate this flush_complete_event so that it cannot be used by other
1082 // connections.
1083 buffer[i].flags |= SENSOR_EVENT_INVALID_FLAG;
Aravind Akella6c2664a2014-08-13 12:24:50 -07001084 ALOGD_IF(DEBUG_CONNECTIONS, "First flush event for sensor==%d ",
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001085 buffer[i].meta_data.sensor);
1086 ++i;
Aravind Akella56ae4262014-07-10 16:01:10 -07001087 continue;
1088 }
1089 }
1090
1091 // If there is a pending flush complete event for this sensor on this connection,
1092 // ignore the event and proceed to the next.
1093 if (flushInfo.mFirstFlushPending) {
1094 ++i;
1095 continue;
1096 }
1097
1098 do {
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001099 if (buffer[i].flags & SENSOR_EVENT_INVALID_FLAG) {
1100 ++i;
1101 continue;
1102 }
Aravind Akella56ae4262014-07-10 16:01:10 -07001103 if (buffer[i].type == SENSOR_TYPE_META_DATA) {
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001104 // Check if this connection has called flush() on this sensor. Only if
1105 // a flush() has been explicitly called, send a flush_complete_event.
1106 SensorService::SensorRecord *rec = mService->getSensorRecord(sensor_handle);
1107 if (rec && rec->getFirstPendingFlushConnection() == this) {
Aravind Akella6c2664a2014-08-13 12:24:50 -07001108 rec->removeFirstPendingFlushConnection();
Aravind Akella56ae4262014-07-10 16:01:10 -07001109 scratch[count++] = buffer[i];
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001110 // Invalidate this flush_complete_event so that it cannot be used by
1111 // other connections.
1112 buffer[i].flags |= SENSOR_EVENT_INVALID_FLAG;
Aravind Akella56ae4262014-07-10 16:01:10 -07001113 }
1114 ++i;
1115 } else {
1116 // Regular sensor event, just copy it to the scratch buffer.
Aravind Akella4c8b9512013-09-05 17:03:38 -07001117 scratch[count++] = buffer[i++];
Aravind Akella56ae4262014-07-10 16:01:10 -07001118 }
Aravind Akella6c2664a2014-08-13 12:24:50 -07001119 } while ((i<numEvents) && ((buffer[i].sensor == sensor_handle) ||
Aravind Akella56ae4262014-07-10 16:01:10 -07001120 (buffer[i].type == SENSOR_TYPE_META_DATA &&
Aravind Akella6c2664a2014-08-13 12:24:50 -07001121 buffer[i].meta_data.sensor == sensor_handle)));
Mathias Agopiancf510012010-07-22 16:18:10 -07001122 }
Mathias Agopian3560fb22010-07-22 21:24:39 -07001123 } else {
1124 scratch = const_cast<sensors_event_t *>(buffer);
1125 count = numEvents;
Mathias Agopiancf510012010-07-22 16:18:10 -07001126 }
Mathias Agopianfc328812010-07-14 23:41:37 -07001127
Aravind Akella6c2664a2014-08-13 12:24:50 -07001128 sendPendingFlushEventsLocked();
Aravind Akella56ae4262014-07-10 16:01:10 -07001129 // Early return if there are no events for this connection.
1130 if (count == 0) {
1131 return status_t(NO_ERROR);
1132 }
1133
1134#if DEBUG_CONNECTIONS
1135 mEventsReceived += count;
1136#endif
1137 if (mCacheSize != 0) {
1138 // There are some events in the cache which need to be sent first. Copy this buffer to
1139 // the end of cache.
1140 if (mCacheSize + count <= mMaxCacheSize) {
1141 memcpy(&mEventCache[mCacheSize], scratch, count * sizeof(sensors_event_t));
1142 mCacheSize += count;
1143 } else {
Aravind Akella6c2664a2014-08-13 12:24:50 -07001144 // Check if any new sensors have registered on this connection which may have increased
1145 // the max cache size that is desired.
1146 if (mCacheSize + count < computeMaxCacheSizeLocked()) {
1147 reAllocateCacheLocked(scratch, count);
1148 return status_t(NO_ERROR);
1149 }
Aravind Akella56ae4262014-07-10 16:01:10 -07001150 // Some events need to be dropped.
1151 int remaningCacheSize = mMaxCacheSize - mCacheSize;
1152 if (remaningCacheSize != 0) {
1153 memcpy(&mEventCache[mCacheSize], scratch,
1154 remaningCacheSize * sizeof(sensors_event_t));
1155 }
1156 int numEventsDropped = count - remaningCacheSize;
1157 countFlushCompleteEventsLocked(mEventCache, numEventsDropped);
1158 // Drop the first "numEventsDropped" in the cache.
1159 memmove(mEventCache, &mEventCache[numEventsDropped],
1160 (mCacheSize - numEventsDropped) * sizeof(sensors_event_t));
1161
1162 // Copy the remainingEvents in scratch buffer to the end of cache.
1163 memcpy(&mEventCache[mCacheSize - numEventsDropped], scratch + remaningCacheSize,
1164 numEventsDropped * sizeof(sensors_event_t));
1165 }
1166 return status_t(NO_ERROR);
1167 }
1168
Aravind Akella6c2664a2014-08-13 12:24:50 -07001169 int index_wake_up_event = findWakeUpSensorEventLocked(scratch, count);
1170 if (index_wake_up_event >= 0) {
1171 scratch[index_wake_up_event].flags |= WAKE_UP_SENSOR_EVENT_NEEDS_ACK;
1172 ++mWakeLockRefCount;
Aravind Akellae74baf62014-08-21 12:28:35 -07001173#if DEBUG_CONNECTIONS
1174 ++mTotalAcksNeeded;
1175#endif
Aravind Akella6c2664a2014-08-13 12:24:50 -07001176 }
Aravind Akella56ae4262014-07-10 16:01:10 -07001177
1178 // NOTE: ASensorEvent and sensors_event_t are the same type.
1179 ssize_t size = SensorEventQueue::write(mChannel,
1180 reinterpret_cast<ASensorEvent const*>(scratch), count);
1181 if (size < 0) {
1182 // Write error, copy events to local cache.
Aravind Akella6c2664a2014-08-13 12:24:50 -07001183 if (index_wake_up_event >= 0) {
1184 // If there was a wake_up sensor_event, reset the flag.
1185 scratch[index_wake_up_event].flags &= ~WAKE_UP_SENSOR_EVENT_NEEDS_ACK;
1186 --mWakeLockRefCount;
Aravind Akellae74baf62014-08-21 12:28:35 -07001187#if DEBUG_CONNECTIONS
1188 --mTotalAcksNeeded;
1189#endif
Aravind Akella6c2664a2014-08-13 12:24:50 -07001190 }
Aravind Akella56ae4262014-07-10 16:01:10 -07001191 if (mEventCache == NULL) {
1192 mMaxCacheSize = computeMaxCacheSizeLocked();
1193 mEventCache = new sensors_event_t[mMaxCacheSize];
1194 mCacheSize = 0;
1195 }
1196 memcpy(&mEventCache[mCacheSize], scratch, count * sizeof(sensors_event_t));
1197 mCacheSize += count;
1198
1199 // Add this file descriptor to the looper to get a callback when this fd is available for
1200 // writing.
1201 mService->getLooper()->addFd(mChannel->getSendFd(), 0,
1202 ALOOPER_EVENT_OUTPUT | ALOOPER_EVENT_INPUT, this, NULL);
1203 return size;
1204 }
1205
1206#if DEBUG_CONNECTIONS
1207 if (size > 0) {
1208 mEventsSent += count;
1209 }
1210#endif
1211
1212 return size < 0 ? status_t(size) : status_t(NO_ERROR);
1213}
1214
Aravind Akella6c2664a2014-08-13 12:24:50 -07001215void SensorService::SensorEventConnection::reAllocateCacheLocked(sensors_event_t const* scratch,
1216 int count) {
1217 sensors_event_t *eventCache_new;
1218 const int new_cache_size = computeMaxCacheSizeLocked();
1219 // Allocate new cache, copy over events from the old cache & scratch, free up memory.
1220 eventCache_new = new sensors_event_t[new_cache_size];
1221 memcpy(eventCache_new, mEventCache, mCacheSize * sizeof(sensors_event_t));
1222 memcpy(&eventCache_new[mCacheSize], scratch, count * sizeof(sensors_event_t));
1223
1224 ALOGD_IF(DEBUG_CONNECTIONS, "reAllocateCacheLocked maxCacheSize=%d %d", mMaxCacheSize,
1225 new_cache_size);
1226
1227 delete mEventCache;
1228 mEventCache = eventCache_new;
1229 mCacheSize += count;
1230 mMaxCacheSize = new_cache_size;
1231}
1232
1233void SensorService::SensorEventConnection::sendPendingFlushEventsLocked() {
1234 ASensorEvent flushCompleteEvent;
1235 flushCompleteEvent.type = SENSOR_TYPE_META_DATA;
1236 flushCompleteEvent.sensor = 0;
1237 // Loop through all the sensors for this connection and check if there are any pending
1238 // flush complete events to be sent.
1239 for (size_t i = 0; i < mSensorInfo.size(); ++i) {
1240 FlushInfo& flushInfo = mSensorInfo.editValueAt(i);
1241 while (flushInfo.mPendingFlushEventsToSend > 0) {
1242 flushCompleteEvent.meta_data.sensor = mSensorInfo.keyAt(i);
1243 ssize_t size = SensorEventQueue::write(mChannel, &flushCompleteEvent, 1);
1244 if (size < 0) {
1245 return;
1246 }
1247 ALOGD_IF(DEBUG_CONNECTIONS, "sent dropped flush complete event==%d ",
1248 flushCompleteEvent.meta_data.sensor);
1249 flushInfo.mPendingFlushEventsToSend--;
1250 }
1251 }
1252}
1253
Aravind Akella56ae4262014-07-10 16:01:10 -07001254void SensorService::SensorEventConnection::writeToSocketFromCacheLocked() {
Aravind Akella5466c3d2014-08-22 16:11:10 -07001255 // At a time write at most half the size of the receiver buffer in SensorEventQueue OR
1256 // half the size of the socket buffer allocated in BitTube whichever is smaller.
1257 const int maxWriteSize = helpers::min(SensorEventQueue::MAX_RECEIVE_BUFFER_EVENT_COUNT/2,
1258 int(mService->mSocketBufferSize/(sizeof(sensors_event_t)*2)));
1259 // Send pending flush complete events (if any)
Aravind Akella6c2664a2014-08-13 12:24:50 -07001260 sendPendingFlushEventsLocked();
Aravind Akella56ae4262014-07-10 16:01:10 -07001261 for (int numEventsSent = 0; numEventsSent < mCacheSize;) {
Aravind Akella5466c3d2014-08-22 16:11:10 -07001262 const int numEventsToWrite = helpers::min(mCacheSize - numEventsSent, maxWriteSize);
Aravind Akella6c2664a2014-08-13 12:24:50 -07001263 int index_wake_up_event =
1264 findWakeUpSensorEventLocked(mEventCache + numEventsSent, numEventsToWrite);
1265 if (index_wake_up_event >= 0) {
1266 mEventCache[index_wake_up_event + numEventsSent].flags |=
1267 WAKE_UP_SENSOR_EVENT_NEEDS_ACK;
1268 ++mWakeLockRefCount;
Aravind Akellae74baf62014-08-21 12:28:35 -07001269#if DEBUG_CONNECTIONS
1270 ++mTotalAcksNeeded;
1271#endif
Aravind Akella6c2664a2014-08-13 12:24:50 -07001272 }
Aravind Akella4c8b9512013-09-05 17:03:38 -07001273
Aravind Akella56ae4262014-07-10 16:01:10 -07001274 ssize_t size = SensorEventQueue::write(mChannel,
1275 reinterpret_cast<ASensorEvent const*>(mEventCache + numEventsSent),
Aravind Akella6c2664a2014-08-13 12:24:50 -07001276 numEventsToWrite);
Aravind Akella56ae4262014-07-10 16:01:10 -07001277 if (size < 0) {
Aravind Akella6c2664a2014-08-13 12:24:50 -07001278 if (index_wake_up_event >= 0) {
1279 // If there was a wake_up sensor_event, reset the flag.
1280 mEventCache[index_wake_up_event + numEventsSent].flags &=
1281 ~WAKE_UP_SENSOR_EVENT_NEEDS_ACK;
1282 --mWakeLockRefCount;
Aravind Akellae74baf62014-08-21 12:28:35 -07001283#if DEBUG_CONNECTIONS
1284 --mTotalAcksNeeded;
1285#endif
Aravind Akella6c2664a2014-08-13 12:24:50 -07001286 }
Aravind Akella56ae4262014-07-10 16:01:10 -07001287 memmove(mEventCache, &mEventCache[numEventsSent],
1288 (mCacheSize - numEventsSent) * sizeof(sensors_event_t));
1289 ALOGD_IF(DEBUG_CONNECTIONS, "wrote %d events from cache size==%d ",
Aravind Akella6c2664a2014-08-13 12:24:50 -07001290 numEventsSent, mCacheSize);
Aravind Akella56ae4262014-07-10 16:01:10 -07001291 mCacheSize -= numEventsSent;
Aravind Akella56ae4262014-07-10 16:01:10 -07001292 return;
1293 }
Aravind Akella6c2664a2014-08-13 12:24:50 -07001294 numEventsSent += numEventsToWrite;
Aravind Akella56ae4262014-07-10 16:01:10 -07001295#if DEBUG_CONNECTIONS
Aravind Akella6c2664a2014-08-13 12:24:50 -07001296 mEventsSentFromCache += numEventsToWrite;
Aravind Akella56ae4262014-07-10 16:01:10 -07001297#endif
Aravind Akellab4099e72013-10-15 15:43:10 -07001298 }
Aravind Akella56ae4262014-07-10 16:01:10 -07001299 ALOGD_IF(DEBUG_CONNECTIONS, "wrote all events from cache size=%d ", mCacheSize);
1300 // All events from the cache have been sent. Reset cache size to zero.
1301 mCacheSize = 0;
1302 // Poll only for ALOOPER_EVENT_INPUT(read) on the file descriptor.
1303 mService->getLooper()->addFd(mChannel->getSendFd(), 0, ALOOPER_EVENT_INPUT, this, NULL);
Mathias Agopianfc328812010-07-14 23:41:37 -07001304}
1305
Aravind Akellac551eac2013-10-14 17:04:42 -07001306void SensorService::SensorEventConnection::countFlushCompleteEventsLocked(
Aravind Akella4c8b9512013-09-05 17:03:38 -07001307 sensors_event_t* scratch, const int numEventsDropped) {
1308 ALOGD_IF(DEBUG_CONNECTIONS, "dropping %d events ", numEventsDropped);
Aravind Akella4c8b9512013-09-05 17:03:38 -07001309 // Count flushComplete events in the events that are about to the dropped. These will be sent
1310 // separately before the next batch of events.
1311 for (int j = 0; j < numEventsDropped; ++j) {
1312 if (scratch[j].type == SENSOR_TYPE_META_DATA) {
1313 FlushInfo& flushInfo = mSensorInfo.editValueFor(scratch[j].meta_data.sensor);
1314 flushInfo.mPendingFlushEventsToSend++;
1315 ALOGD_IF(DEBUG_CONNECTIONS, "increment pendingFlushCount %d",
1316 flushInfo.mPendingFlushEventsToSend);
1317 }
1318 }
1319 return;
1320}
1321
Aravind Akella6c2664a2014-08-13 12:24:50 -07001322int SensorService::SensorEventConnection::findWakeUpSensorEventLocked(
1323 sensors_event_t const* scratch, const int count) {
Aravind Akella9a844cf2014-02-11 18:58:52 -08001324 for (int i = 0; i < count; ++i) {
1325 if (mService->isWakeUpSensorEvent(scratch[i])) {
Aravind Akella6c2664a2014-08-13 12:24:50 -07001326 return i;
Aravind Akella9a844cf2014-02-11 18:58:52 -08001327 }
1328 }
Aravind Akella6c2664a2014-08-13 12:24:50 -07001329 return -1;
Aravind Akella9a844cf2014-02-11 18:58:52 -08001330}
1331
Mathias Agopianb3989272011-10-20 18:42:02 -07001332sp<BitTube> SensorService::SensorEventConnection::getSensorChannel() const
Mathias Agopianfc328812010-07-14 23:41:37 -07001333{
1334 return mChannel;
1335}
1336
1337status_t SensorService::SensorEventConnection::enableDisable(
Aravind Akella724d91d2013-06-27 12:04:23 -07001338 int handle, bool enabled, nsecs_t samplingPeriodNs, nsecs_t maxBatchReportLatencyNs,
1339 int reservedFlags)
Mathias Agopianfc328812010-07-14 23:41:37 -07001340{
1341 status_t err;
1342 if (enabled) {
Aravind Akella724d91d2013-06-27 12:04:23 -07001343 err = mService->enable(this, handle, samplingPeriodNs, maxBatchReportLatencyNs,
1344 reservedFlags);
Aravind Akella56ae4262014-07-10 16:01:10 -07001345
Mathias Agopianfc328812010-07-14 23:41:37 -07001346 } else {
1347 err = mService->disable(this, handle);
1348 }
1349 return err;
1350}
1351
1352status_t SensorService::SensorEventConnection::setEventRate(
Aravind Akella724d91d2013-06-27 12:04:23 -07001353 int handle, nsecs_t samplingPeriodNs)
Mathias Agopianfc328812010-07-14 23:41:37 -07001354{
Aravind Akella724d91d2013-06-27 12:04:23 -07001355 return mService->setEventRate(this, handle, samplingPeriodNs);
Mathias Agopianfc328812010-07-14 23:41:37 -07001356}
1357
Aravind Akella701166d2013-10-08 14:59:26 -07001358status_t SensorService::SensorEventConnection::flush() {
Aravind Akella9e3adfc2014-09-03 15:48:05 -07001359 return mService->flushSensor(this);
Aravind Akella724d91d2013-06-27 12:04:23 -07001360}
Aravind Akella4c8b9512013-09-05 17:03:38 -07001361
Aravind Akella56ae4262014-07-10 16:01:10 -07001362int SensorService::SensorEventConnection::handleEvent(int fd, int events, void* data) {
1363 if (events & ALOOPER_EVENT_HANGUP || events & ALOOPER_EVENT_ERROR) {
1364 return 0;
1365 }
1366
1367 if (events & ALOOPER_EVENT_INPUT) {
1368 char buf;
1369 ssize_t ret = ::recv(fd, &buf, sizeof(buf), MSG_DONTWAIT);
1370
1371 {
1372 Mutex::Autolock _l(mConnectionLock);
1373 --mWakeLockRefCount;
Aravind Akellae74baf62014-08-21 12:28:35 -07001374#if DEBUG_CONNECTIONS
1375 ++mTotalAcksReceived;
1376#endif
Aravind Akella56ae4262014-07-10 16:01:10 -07001377 }
1378 // Check if wakelock can be released by sensorservice. mConnectionLock needs to be released
1379 // here as checkWakeLockState() will need it.
1380 if (mWakeLockRefCount == 0) {
1381 mService->checkWakeLockState();
1382 }
1383 // continue getting callbacks.
1384 return 1;
1385 }
1386
1387 if (events & ALOOPER_EVENT_OUTPUT) {
1388 // send sensor data that is stored in mEventCache.
Aravind Akella9a844cf2014-02-11 18:58:52 -08001389 Mutex::Autolock _l(mConnectionLock);
Aravind Akella56ae4262014-07-10 16:01:10 -07001390 writeToSocketFromCacheLocked();
Aravind Akella9a844cf2014-02-11 18:58:52 -08001391 }
Aravind Akella56ae4262014-07-10 16:01:10 -07001392 return 1;
1393}
1394
1395int SensorService::SensorEventConnection::computeMaxCacheSizeLocked() const {
1396 int fifoWakeUpSensors = 0;
1397 int fifoNonWakeUpSensors = 0;
1398 for (size_t i = 0; i < mSensorInfo.size(); ++i) {
1399 const Sensor& sensor = mService->getSensorFromHandle(mSensorInfo.keyAt(i));
1400 if (sensor.getFifoReservedEventCount() == sensor.getFifoMaxEventCount()) {
1401 // Each sensor has a reserved fifo. Sum up the fifo sizes for all wake up sensors and
1402 // non wake_up sensors.
1403 if (sensor.isWakeUpSensor()) {
1404 fifoWakeUpSensors += sensor.getFifoReservedEventCount();
1405 } else {
1406 fifoNonWakeUpSensors += sensor.getFifoReservedEventCount();
1407 }
1408 } else {
1409 // Shared fifo. Compute the max of the fifo sizes for wake_up and non_wake up sensors.
1410 if (sensor.isWakeUpSensor()) {
1411 fifoWakeUpSensors = fifoWakeUpSensors > sensor.getFifoMaxEventCount() ?
1412 fifoWakeUpSensors : sensor.getFifoMaxEventCount();
1413
1414 } else {
1415 fifoNonWakeUpSensors = fifoNonWakeUpSensors > sensor.getFifoMaxEventCount() ?
1416 fifoNonWakeUpSensors : sensor.getFifoMaxEventCount();
1417
1418 }
1419 }
1420 }
1421 if (fifoWakeUpSensors + fifoNonWakeUpSensors == 0) {
1422 // It is extremely unlikely that there is a write failure in non batch mode. Return a cache
Aravind Akella6c2664a2014-08-13 12:24:50 -07001423 // size that is equal to that of the batch mode.
Aravind Akellae74baf62014-08-21 12:28:35 -07001424 // ALOGW("Write failure in non-batch mode");
Aravind Akella6c2664a2014-08-13 12:24:50 -07001425 return MAX_SOCKET_BUFFER_SIZE_BATCHED/sizeof(sensors_event_t);
Aravind Akella56ae4262014-07-10 16:01:10 -07001426 }
1427 return fifoWakeUpSensors + fifoNonWakeUpSensors;
Aravind Akella9a844cf2014-02-11 18:58:52 -08001428}
1429
Mathias Agopianfc328812010-07-14 23:41:37 -07001430// ---------------------------------------------------------------------------
1431}; // namespace android
1432