blob: 38a627fbecdb0de01c6960a8f1dcd3998a43f203 [file] [log] [blame]
Anthony Stangea689f8a2019-07-30 11:35:48 -04001/*
2 * Copyright (C) 2019 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 "HalProxy.h"
18
Stan Rokita537c0272019-09-13 10:36:07 -070019#include "SubHal.h"
20
Anthony Stangea689f8a2019-07-30 11:35:48 -040021#include <android/hardware/sensors/2.0/types.h>
22
Stan Rokitad0cd57d2019-09-17 15:52:51 -070023#include "hardware_legacy/power.h"
24
Stan Rokita28790672019-08-20 14:32:15 -070025#include <dlfcn.h>
26
Stan Rokita75cc7bf2019-09-26 13:17:01 -070027#include <cinttypes>
Stan Rokita28790672019-08-20 14:32:15 -070028#include <fstream>
29#include <functional>
Stan Rokita537c0272019-09-13 10:36:07 -070030#include <thread>
Stan Rokita28790672019-08-20 14:32:15 -070031
Anthony Stangea689f8a2019-07-30 11:35:48 -040032namespace android {
33namespace hardware {
34namespace sensors {
35namespace V2_0 {
36namespace implementation {
37
Stan Rokita537c0272019-09-13 10:36:07 -070038using ::android::hardware::sensors::V2_0::EventQueueFlagBits;
Stan Rokita75cc7bf2019-09-26 13:17:01 -070039using ::android::hardware::sensors::V2_0::WakeLockQueueFlagBits;
40using ::android::hardware::sensors::V2_0::implementation::getTimeNow;
41using ::android::hardware::sensors::V2_0::implementation::kWakelockTimeoutNs;
Stan Rokita537c0272019-09-13 10:36:07 -070042
Stan Rokita28790672019-08-20 14:32:15 -070043typedef ISensorsSubHal*(SensorsHalGetSubHalFunc)(uint32_t*);
44
Stan Rokitae0721532019-10-17 11:58:02 -070045static constexpr int32_t kBitsAfterSubHalIndex = 24;
46
Stan Rokitae93fdf92019-09-24 11:58:51 -070047/**
48 * Set the subhal index as first byte of sensor handle and return this modified version.
49 *
50 * @param sensorHandle The sensor handle to modify.
51 * @param subHalIndex The index in the hal proxy of the sub hal this sensor belongs to.
52 *
53 * @return The modified sensor handle.
54 */
Stan Rokitae0721532019-10-17 11:58:02 -070055int32_t setSubHalIndex(int32_t sensorHandle, size_t subHalIndex) {
56 return sensorHandle | (static_cast<int32_t>(subHalIndex) << kBitsAfterSubHalIndex);
57}
58
59/**
60 * Extract the subHalIndex from sensorHandle.
61 *
62 * @param sensorHandle The sensorHandle to extract from.
63 *
64 * @return The subhal index.
65 */
66size_t extractSubHalIndex(int32_t sensorHandle) {
67 return static_cast<size_t>(sensorHandle >> kBitsAfterSubHalIndex);
Stan Rokitae93fdf92019-09-24 11:58:51 -070068}
69
Anthony Stangea689f8a2019-07-30 11:35:48 -040070HalProxy::HalProxy() {
Stan Rokita7a723542019-08-29 15:47:50 -070071 const char* kMultiHalConfigFile = "/vendor/etc/sensors/hals.conf";
72 initializeSubHalListFromConfigFile(kMultiHalConfigFile);
Stan Rokita75cc7bf2019-09-26 13:17:01 -070073 init();
Anthony Stangea689f8a2019-07-30 11:35:48 -040074}
75
Anthony Stangeaacbf942019-08-30 15:21:34 -040076HalProxy::HalProxy(std::vector<ISensorsSubHal*>& subHalList) : mSubHalList(subHalList) {
Stan Rokita75cc7bf2019-09-26 13:17:01 -070077 init();
Anthony Stangeaacbf942019-08-30 15:21:34 -040078}
79
Anthony Stangea689f8a2019-07-30 11:35:48 -040080HalProxy::~HalProxy() {
Stan Rokita336c1c72019-10-14 15:30:57 -070081 stopThreads();
Anthony Stangea689f8a2019-07-30 11:35:48 -040082}
83
Stan Rokitadc7a8e72019-08-23 12:35:40 -070084Return<void> HalProxy::getSensorsList(getSensorsList_cb _hidl_cb) {
Stan Rokita537c0272019-09-13 10:36:07 -070085 std::vector<SensorInfo> sensors;
86 for (const auto& iter : mSensors) {
87 sensors.push_back(iter.second);
88 }
89 _hidl_cb(sensors);
Anthony Stangea689f8a2019-07-30 11:35:48 -040090 return Void();
91}
92
Stan Rokita7a723542019-08-29 15:47:50 -070093Return<Result> HalProxy::setOperationMode(OperationMode mode) {
94 Result result = Result::OK;
95 size_t subHalIndex;
96 for (subHalIndex = 0; subHalIndex < mSubHalList.size(); subHalIndex++) {
97 ISensorsSubHal* subHal = mSubHalList[subHalIndex];
98 result = subHal->setOperationMode(mode);
99 if (result != Result::OK) {
100 ALOGE("setOperationMode failed for SubHal: %s", subHal->getName().c_str());
101 break;
102 }
103 }
104 if (result != Result::OK) {
105 // Reset the subhal operation modes that have been flipped
106 for (size_t i = 0; i < subHalIndex; i++) {
107 ISensorsSubHal* subHal = mSubHalList[i];
108 subHal->setOperationMode(mCurrentOperationMode);
109 }
110 } else {
111 mCurrentOperationMode = mode;
112 }
113 return result;
Anthony Stangea689f8a2019-07-30 11:35:48 -0400114}
115
Stan Rokita4b4c7b72019-09-10 15:07:59 -0700116Return<Result> HalProxy::activate(int32_t sensorHandle, bool enabled) {
Stan Rokitae0721532019-10-17 11:58:02 -0700117 if (!isSubHalIndexValid(sensorHandle)) {
118 return Result::BAD_VALUE;
119 }
Stan Rokita4b4c7b72019-09-10 15:07:59 -0700120 return getSubHalForSensorHandle(sensorHandle)
Stan Rokitaf97a3f32019-09-13 09:58:47 -0700121 ->activate(clearSubHalIndex(sensorHandle), enabled);
Anthony Stangea689f8a2019-07-30 11:35:48 -0400122}
123
124Return<Result> HalProxy::initialize(
125 const ::android::hardware::MQDescriptorSync<Event>& eventQueueDescriptor,
126 const ::android::hardware::MQDescriptorSync<uint32_t>& wakeLockDescriptor,
127 const sp<ISensorsCallback>& sensorsCallback) {
128 Result result = Result::OK;
129
Stan Rokita336c1c72019-10-14 15:30:57 -0700130 stopThreads();
131 resetSharedWakelock();
132
133 // So that the pending write events queue can be cleared safely and when we start threads
134 // again we do not get new events until after initialize resets the subhals.
135 disableAllSensors();
136
137 // Clears the queue if any events were pending write before.
138 mPendingWriteEventsQueue = std::queue<std::pair<std::vector<Event>, size_t>>();
139
140 // Clears previously connected dynamic sensors
141 mDynamicSensors.clear();
Anthony Stangea689f8a2019-07-30 11:35:48 -0400142
143 mDynamicSensorsCallback = sensorsCallback;
144
145 // Create the Event FMQ from the eventQueueDescriptor. Reset the read/write positions.
146 mEventQueue =
147 std::make_unique<EventMessageQueue>(eventQueueDescriptor, true /* resetPointers */);
148
Anthony Stangea689f8a2019-07-30 11:35:48 -0400149 // Create the Wake Lock FMQ that is used by the framework to communicate whenever WAKE_UP
150 // events have been successfully read and handled by the framework.
151 mWakeLockQueue =
152 std::make_unique<WakeLockMessageQueue>(wakeLockDescriptor, true /* resetPointers */);
153
Stan Rokita336c1c72019-10-14 15:30:57 -0700154 if (mEventQueueFlag != nullptr) {
155 EventFlag::deleteEventFlag(&mEventQueueFlag);
156 }
157 if (mWakelockQueueFlag != nullptr) {
158 EventFlag::deleteEventFlag(&mWakelockQueueFlag);
159 }
160 if (EventFlag::createEventFlag(mEventQueue->getEventFlagWord(), &mEventQueueFlag) != OK) {
161 result = Result::BAD_VALUE;
162 }
163 if (EventFlag::createEventFlag(mWakeLockQueue->getEventFlagWord(), &mWakelockQueueFlag) != OK) {
164 result = Result::BAD_VALUE;
165 }
Anthony Stangea689f8a2019-07-30 11:35:48 -0400166 if (!mDynamicSensorsCallback || !mEventQueue || !mWakeLockQueue || mEventQueueFlag == nullptr) {
167 result = Result::BAD_VALUE;
168 }
169
Stan Rokita336c1c72019-10-14 15:30:57 -0700170 mThreadsRun.store(true);
171
Stan Rokita59714262019-09-20 10:55:30 -0700172 mPendingWritesThread = std::thread(startPendingWritesThread, this);
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700173 mWakelockThread = std::thread(startWakelockThread, this);
Anthony Stangea689f8a2019-07-30 11:35:48 -0400174
Stan Rokita537c0272019-09-13 10:36:07 -0700175 for (size_t i = 0; i < mSubHalList.size(); i++) {
176 auto subHal = mSubHalList[i];
177 const auto& subHalCallback = mSubHalCallbacks[i];
178 Result currRes = subHal->initialize(subHalCallback);
179 if (currRes != Result::OK) {
180 result = currRes;
181 ALOGE("Subhal '%s' failed to initialize.", subHal->getName().c_str());
182 break;
183 }
184 }
185
Stan Rokita336c1c72019-10-14 15:30:57 -0700186 mCurrentOperationMode = OperationMode::NORMAL;
187
Anthony Stangea689f8a2019-07-30 11:35:48 -0400188 return result;
189}
190
Stan Rokita4b4c7b72019-09-10 15:07:59 -0700191Return<Result> HalProxy::batch(int32_t sensorHandle, int64_t samplingPeriodNs,
192 int64_t maxReportLatencyNs) {
Stan Rokitae0721532019-10-17 11:58:02 -0700193 if (!isSubHalIndexValid(sensorHandle)) {
194 return Result::BAD_VALUE;
195 }
Stan Rokita4b4c7b72019-09-10 15:07:59 -0700196 return getSubHalForSensorHandle(sensorHandle)
Stan Rokitaf97a3f32019-09-13 09:58:47 -0700197 ->batch(clearSubHalIndex(sensorHandle), samplingPeriodNs, maxReportLatencyNs);
Anthony Stangea689f8a2019-07-30 11:35:48 -0400198}
199
Stan Rokita4b4c7b72019-09-10 15:07:59 -0700200Return<Result> HalProxy::flush(int32_t sensorHandle) {
Stan Rokitae0721532019-10-17 11:58:02 -0700201 if (!isSubHalIndexValid(sensorHandle)) {
202 return Result::BAD_VALUE;
203 }
Stan Rokitaf97a3f32019-09-13 09:58:47 -0700204 return getSubHalForSensorHandle(sensorHandle)->flush(clearSubHalIndex(sensorHandle));
Anthony Stangea689f8a2019-07-30 11:35:48 -0400205}
206
Stan Rokita83e43702019-09-24 10:16:08 -0700207Return<Result> HalProxy::injectSensorData(const Event& event) {
208 Result result = Result::OK;
209 if (mCurrentOperationMode == OperationMode::NORMAL &&
210 event.sensorType != V1_0::SensorType::ADDITIONAL_INFO) {
211 ALOGE("An event with type != ADDITIONAL_INFO passed to injectSensorData while operation"
212 " mode was NORMAL.");
213 result = Result::BAD_VALUE;
214 }
215 if (result == Result::OK) {
216 Event subHalEvent = event;
Stan Rokitae0721532019-10-17 11:58:02 -0700217 if (!isSubHalIndexValid(event.sensorHandle)) {
218 return Result::BAD_VALUE;
219 }
Stan Rokita83e43702019-09-24 10:16:08 -0700220 subHalEvent.sensorHandle = clearSubHalIndex(event.sensorHandle);
221 result = getSubHalForSensorHandle(event.sensorHandle)->injectSensorData(subHalEvent);
222 }
223 return result;
Anthony Stangea689f8a2019-07-30 11:35:48 -0400224}
225
Stan Rokitadb23aa82019-09-24 11:08:27 -0700226Return<void> HalProxy::registerDirectChannel(const SharedMemInfo& mem,
Anthony Stangea689f8a2019-07-30 11:35:48 -0400227 registerDirectChannel_cb _hidl_cb) {
Stan Rokitadb23aa82019-09-24 11:08:27 -0700228 if (mDirectChannelSubHal == nullptr) {
229 _hidl_cb(Result::INVALID_OPERATION, -1 /* channelHandle */);
230 } else {
231 mDirectChannelSubHal->registerDirectChannel(mem, _hidl_cb);
232 }
Anthony Stangea689f8a2019-07-30 11:35:48 -0400233 return Return<void>();
234}
235
Stan Rokitadb23aa82019-09-24 11:08:27 -0700236Return<Result> HalProxy::unregisterDirectChannel(int32_t channelHandle) {
237 Result result;
238 if (mDirectChannelSubHal == nullptr) {
239 result = Result::INVALID_OPERATION;
240 } else {
241 result = mDirectChannelSubHal->unregisterDirectChannel(channelHandle);
242 }
243 return result;
Anthony Stangea689f8a2019-07-30 11:35:48 -0400244}
245
Stan Rokitadb23aa82019-09-24 11:08:27 -0700246Return<void> HalProxy::configDirectReport(int32_t sensorHandle, int32_t channelHandle,
247 RateLevel rate, configDirectReport_cb _hidl_cb) {
248 if (mDirectChannelSubHal == nullptr) {
249 _hidl_cb(Result::INVALID_OPERATION, -1 /* reportToken */);
250 } else {
251 mDirectChannelSubHal->configDirectReport(clearSubHalIndex(sensorHandle), channelHandle,
252 rate, _hidl_cb);
253 }
Anthony Stangea689f8a2019-07-30 11:35:48 -0400254 return Return<void>();
255}
256
257Return<void> HalProxy::debug(const hidl_handle& /* fd */, const hidl_vec<hidl_string>& /* args */) {
258 // TODO: output debug information
259 return Return<void>();
260}
261
Stan Rokitae93fdf92019-09-24 11:58:51 -0700262Return<void> HalProxy::onDynamicSensorsConnected(const hidl_vec<SensorInfo>& dynamicSensorsAdded,
263 int32_t subHalIndex) {
264 std::vector<SensorInfo> sensors;
265 {
266 std::lock_guard<std::mutex> lock(mDynamicSensorsMutex);
267 for (SensorInfo sensor : dynamicSensorsAdded) {
268 if (!subHalIndexIsClear(sensor.sensorHandle)) {
269 ALOGE("Dynamic sensor added %s had sensorHandle with first byte not 0.",
270 sensor.name.c_str());
271 } else {
272 sensor.sensorHandle = setSubHalIndex(sensor.sensorHandle, subHalIndex);
273 mDynamicSensors[sensor.sensorHandle] = sensor;
274 sensors.push_back(sensor);
275 }
276 }
277 }
278 mDynamicSensorsCallback->onDynamicSensorsConnected(sensors);
Anthony Stangea689f8a2019-07-30 11:35:48 -0400279 return Return<void>();
280}
281
282Return<void> HalProxy::onDynamicSensorsDisconnected(
Stan Rokitae93fdf92019-09-24 11:58:51 -0700283 const hidl_vec<int32_t>& dynamicSensorHandlesRemoved, int32_t subHalIndex) {
284 // TODO: Block this call until all pending events are flushed from queue
285 std::vector<int32_t> sensorHandles;
286 {
287 std::lock_guard<std::mutex> lock(mDynamicSensorsMutex);
288 for (int32_t sensorHandle : dynamicSensorHandlesRemoved) {
289 if (!subHalIndexIsClear(sensorHandle)) {
290 ALOGE("Dynamic sensorHandle removed had first byte not 0.");
291 } else {
292 sensorHandle = setSubHalIndex(sensorHandle, subHalIndex);
293 if (mDynamicSensors.find(sensorHandle) != mDynamicSensors.end()) {
294 mDynamicSensors.erase(sensorHandle);
295 sensorHandles.push_back(sensorHandle);
296 }
297 }
298 }
299 }
300 mDynamicSensorsCallback->onDynamicSensorsDisconnected(sensorHandles);
Anthony Stangea689f8a2019-07-30 11:35:48 -0400301 return Return<void>();
302}
303
Stan Rokitadc7a8e72019-08-23 12:35:40 -0700304void HalProxy::initializeSubHalListFromConfigFile(const char* configFileName) {
305 std::ifstream subHalConfigStream(configFileName);
306 if (!subHalConfigStream) {
Stan Rokita7a723542019-08-29 15:47:50 -0700307 ALOGE("Failed to load subHal config file: %s", configFileName);
Stan Rokitadc7a8e72019-08-23 12:35:40 -0700308 } else {
309 std::string subHalLibraryFile;
310 while (subHalConfigStream >> subHalLibraryFile) {
311 void* handle = dlopen(subHalLibraryFile.c_str(), RTLD_NOW);
312 if (handle == nullptr) {
Stan Rokita7a723542019-08-29 15:47:50 -0700313 ALOGE("dlopen failed for library: %s", subHalLibraryFile.c_str());
Stan Rokitadc7a8e72019-08-23 12:35:40 -0700314 } else {
315 SensorsHalGetSubHalFunc* sensorsHalGetSubHalPtr =
316 (SensorsHalGetSubHalFunc*)dlsym(handle, "sensorsHalGetSubHal");
317 if (sensorsHalGetSubHalPtr == nullptr) {
Stan Rokita7a723542019-08-29 15:47:50 -0700318 ALOGE("Failed to locate sensorsHalGetSubHal function for library: %s",
319 subHalLibraryFile.c_str());
Stan Rokitadc7a8e72019-08-23 12:35:40 -0700320 } else {
321 std::function<SensorsHalGetSubHalFunc> sensorsHalGetSubHal =
322 *sensorsHalGetSubHalPtr;
323 uint32_t version;
324 ISensorsSubHal* subHal = sensorsHalGetSubHal(&version);
325 if (version != SUB_HAL_2_0_VERSION) {
Stan Rokita7a723542019-08-29 15:47:50 -0700326 ALOGE("SubHal version was not 2.0 for library: %s",
327 subHalLibraryFile.c_str());
Stan Rokitadc7a8e72019-08-23 12:35:40 -0700328 } else {
329 ALOGV("Loaded SubHal from library: %s", subHalLibraryFile.c_str());
330 mSubHalList.push_back(subHal);
331 }
332 }
333 }
334 }
335 }
336}
337
Stan Rokita537c0272019-09-13 10:36:07 -0700338void HalProxy::initializeSubHalCallbacks() {
339 for (size_t subHalIndex = 0; subHalIndex < mSubHalList.size(); subHalIndex++) {
340 sp<IHalProxyCallback> callback = new HalProxyCallback(this, subHalIndex);
341 mSubHalCallbacks.push_back(callback);
342 }
343}
344
Stan Rokitadc7a8e72019-08-23 12:35:40 -0700345void HalProxy::initializeSensorList() {
346 for (size_t subHalIndex = 0; subHalIndex < mSubHalList.size(); subHalIndex++) {
347 ISensorsSubHal* subHal = mSubHalList[subHalIndex];
348 auto result = subHal->getSensorsList([&](const auto& list) {
349 for (SensorInfo sensor : list) {
Stan Rokitae93fdf92019-09-24 11:58:51 -0700350 if (!subHalIndexIsClear(sensor.sensorHandle)) {
Stan Rokitadc7a8e72019-08-23 12:35:40 -0700351 ALOGE("SubHal sensorHandle's first byte was not 0");
352 } else {
353 ALOGV("Loaded sensor: %s", sensor.name.c_str());
Stan Rokitae0721532019-10-17 11:58:02 -0700354 sensor.sensorHandle = setSubHalIndex(sensor.sensorHandle, subHalIndex);
Stan Rokita7a723542019-08-29 15:47:50 -0700355 setDirectChannelFlags(&sensor, subHal);
Stan Rokita537c0272019-09-13 10:36:07 -0700356 mSensors[sensor.sensorHandle] = sensor;
Stan Rokitadc7a8e72019-08-23 12:35:40 -0700357 }
358 }
359 });
360 if (!result.isOk()) {
361 ALOGE("getSensorsList call failed for SubHal: %s", subHal->getName().c_str());
362 }
363 }
364}
365
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700366void HalProxy::init() {
Stan Rokita537c0272019-09-13 10:36:07 -0700367 initializeSubHalCallbacks();
368 initializeSensorList();
369}
370
Stan Rokita336c1c72019-10-14 15:30:57 -0700371void HalProxy::stopThreads() {
372 mThreadsRun.store(false);
373 if (mEventQueueFlag != nullptr && mEventQueue != nullptr) {
374 size_t numToRead = mEventQueue->availableToRead();
375 std::vector<Event> events(numToRead);
376 mEventQueue->read(events.data(), numToRead);
377 mEventQueueFlag->wake(static_cast<uint32_t>(EventQueueFlagBits::EVENTS_READ));
378 }
379 if (mWakelockQueueFlag != nullptr && mWakeLockQueue != nullptr) {
380 uint32_t kZero = 0;
381 mWakeLockQueue->write(&kZero);
382 mWakelockQueueFlag->wake(static_cast<uint32_t>(WakeLockQueueFlagBits::DATA_WRITTEN));
383 }
384 mWakelockCV.notify_one();
385 mEventQueueWriteCV.notify_one();
386 if (mPendingWritesThread.joinable()) {
387 mPendingWritesThread.join();
388 }
389 if (mWakelockThread.joinable()) {
390 mWakelockThread.join();
391 }
392}
393
394void HalProxy::disableAllSensors() {
395 for (const auto& sensorEntry : mSensors) {
396 int32_t sensorHandle = sensorEntry.first;
397 activate(sensorHandle, false /* enabled */);
398 }
399 std::lock_guard<std::mutex> dynamicSensorsLock(mDynamicSensorsMutex);
400 for (const auto& sensorEntry : mDynamicSensors) {
401 int32_t sensorHandle = sensorEntry.first;
402 activate(sensorHandle, false /* enabled */);
403 }
404}
405
Stan Rokita59714262019-09-20 10:55:30 -0700406void HalProxy::startPendingWritesThread(HalProxy* halProxy) {
407 halProxy->handlePendingWrites();
408}
409
410void HalProxy::handlePendingWrites() {
411 // TODO: Find a way to optimize locking strategy maybe using two mutexes instead of one.
412 std::unique_lock<std::mutex> lock(mEventQueueWriteMutex);
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700413 while (mThreadsRun.load()) {
Stan Rokita59714262019-09-20 10:55:30 -0700414 mEventQueueWriteCV.wait(
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700415 lock, [&] { return !mPendingWriteEventsQueue.empty() || !mThreadsRun.load(); });
416 if (mThreadsRun.load()) {
417 std::vector<Event>& pendingWriteEvents = mPendingWriteEventsQueue.front().first;
418 size_t numWakeupEvents = mPendingWriteEventsQueue.front().second;
Stan Rokita59714262019-09-20 10:55:30 -0700419 size_t eventQueueSize = mEventQueue->getQuantumCount();
420 size_t numToWrite = std::min(pendingWriteEvents.size(), eventQueueSize);
421 lock.unlock();
Stan Rokita59714262019-09-20 10:55:30 -0700422 if (!mEventQueue->writeBlocking(
423 pendingWriteEvents.data(), numToWrite,
424 static_cast<uint32_t>(EventQueueFlagBits::EVENTS_READ),
425 static_cast<uint32_t>(EventQueueFlagBits::READ_AND_PROCESS),
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700426 kPendingWriteTimeoutNs, mEventQueueFlag)) {
Stan Rokita59714262019-09-20 10:55:30 -0700427 ALOGE("Dropping %zu events after blockingWrite failed.", numToWrite);
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700428 if (numWakeupEvents > 0) {
429 if (pendingWriteEvents.size() > eventQueueSize) {
430 decrementRefCountAndMaybeReleaseWakelock(
431 countNumWakeupEvents(pendingWriteEvents, eventQueueSize));
432 } else {
433 decrementRefCountAndMaybeReleaseWakelock(numWakeupEvents);
434 }
435 }
Stan Rokita59714262019-09-20 10:55:30 -0700436 }
437 lock.lock();
438 if (pendingWriteEvents.size() > eventQueueSize) {
439 // TODO: Check if this erase operation is too inefficient. It will copy all the
440 // events ahead of it down to fill gap off array at front after the erase.
441 pendingWriteEvents.erase(pendingWriteEvents.begin(),
442 pendingWriteEvents.begin() + eventQueueSize);
443 } else {
444 mPendingWriteEventsQueue.pop();
445 }
446 }
447 }
448}
449
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700450void HalProxy::startWakelockThread(HalProxy* halProxy) {
451 halProxy->handleWakelocks();
452}
453
454void HalProxy::handleWakelocks() {
455 std::unique_lock<std::recursive_mutex> lock(mWakelockMutex);
456 while (mThreadsRun.load()) {
457 mWakelockCV.wait(lock, [&] { return mWakelockRefCount > 0 || !mThreadsRun.load(); });
458 if (mThreadsRun.load()) {
459 int64_t timeLeft;
460 if (sharedWakelockDidTimeout(&timeLeft)) {
461 resetSharedWakelock();
462 } else {
463 uint32_t numWakeLocksProcessed;
464 lock.unlock();
465 bool success = mWakeLockQueue->readBlocking(
466 &numWakeLocksProcessed, 1, 0,
467 static_cast<uint32_t>(WakeLockQueueFlagBits::DATA_WRITTEN), timeLeft);
468 lock.lock();
469 if (success) {
470 decrementRefCountAndMaybeReleaseWakelock(
471 static_cast<size_t>(numWakeLocksProcessed));
472 }
473 }
474 }
475 }
476 resetSharedWakelock();
477}
478
479bool HalProxy::sharedWakelockDidTimeout(int64_t* timeLeft) {
480 bool didTimeout;
481 int64_t duration = getTimeNow() - mWakelockTimeoutStartTime;
482 if (duration > kWakelockTimeoutNs) {
483 didTimeout = true;
484 } else {
485 didTimeout = false;
486 *timeLeft = kWakelockTimeoutNs - duration;
487 }
488 return didTimeout;
489}
490
491void HalProxy::resetSharedWakelock() {
492 std::lock_guard<std::recursive_mutex> lockGuard(mWakelockMutex);
493 decrementRefCountAndMaybeReleaseWakelock(mWakelockRefCount);
494 mWakelockTimeoutResetTime = getTimeNow();
495}
496
497void HalProxy::postEventsToMessageQueue(const std::vector<Event>& events, size_t numWakeupEvents,
498 ScopedWakelock wakelock) {
Stan Rokita59714262019-09-20 10:55:30 -0700499 size_t numToWrite = 0;
500 std::lock_guard<std::mutex> lock(mEventQueueWriteMutex);
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700501 if (wakelock.isLocked()) {
502 incrementRefCountAndMaybeAcquireWakelock(numWakeupEvents);
503 }
Stan Rokita59714262019-09-20 10:55:30 -0700504 if (mPendingWriteEventsQueue.empty()) {
505 numToWrite = std::min(events.size(), mEventQueue->availableToWrite());
506 if (numToWrite > 0) {
507 if (mEventQueue->write(events.data(), numToWrite)) {
508 // TODO: While loop if mEventQueue->avaiableToWrite > 0 to possibly fit in more
509 // writes immediately
510 mEventQueueFlag->wake(static_cast<uint32_t>(EventQueueFlagBits::READ_AND_PROCESS));
511 } else {
512 numToWrite = 0;
513 }
Stan Rokita537c0272019-09-13 10:36:07 -0700514 }
515 }
516 if (numToWrite < events.size()) {
Stan Rokita59714262019-09-20 10:55:30 -0700517 // TODO: Bound the mPendingWriteEventsQueue so that we do not trigger OOMs if framework
518 // stalls
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700519 std::vector<Event> eventsLeft(events.begin() + numToWrite, events.end());
520 mPendingWriteEventsQueue.push({eventsLeft, numWakeupEvents});
Stan Rokita59714262019-09-20 10:55:30 -0700521 mEventQueueWriteCV.notify_one();
Stan Rokita537c0272019-09-13 10:36:07 -0700522 }
523}
524
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700525bool HalProxy::incrementRefCountAndMaybeAcquireWakelock(size_t delta,
526 int64_t* timeoutStart /* = nullptr */) {
527 if (!mThreadsRun.load()) return false;
528 std::lock_guard<std::recursive_mutex> lockGuard(mWakelockMutex);
Stan Rokitad0cd57d2019-09-17 15:52:51 -0700529 if (mWakelockRefCount == 0) {
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700530 acquire_wake_lock(PARTIAL_WAKE_LOCK, kWakelockName);
531 mWakelockCV.notify_one();
Stan Rokitad0cd57d2019-09-17 15:52:51 -0700532 }
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700533 mWakelockTimeoutStartTime = getTimeNow();
534 mWakelockRefCount += delta;
535 if (timeoutStart != nullptr) {
536 *timeoutStart = mWakelockTimeoutStartTime;
537 }
538 return true;
Stan Rokitad0cd57d2019-09-17 15:52:51 -0700539}
540
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700541void HalProxy::decrementRefCountAndMaybeReleaseWakelock(size_t delta,
542 int64_t timeoutStart /* = -1 */) {
543 if (!mThreadsRun.load()) return;
544 std::lock_guard<std::recursive_mutex> lockGuard(mWakelockMutex);
545 if (timeoutStart == -1) timeoutStart = mWakelockTimeoutResetTime;
546 if (mWakelockRefCount == 0 || timeoutStart < mWakelockTimeoutResetTime) return;
547 mWakelockRefCount -= std::min(mWakelockRefCount, delta);
Stan Rokitad0cd57d2019-09-17 15:52:51 -0700548 if (mWakelockRefCount == 0) {
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700549 release_wake_lock(kWakelockName);
Stan Rokitad0cd57d2019-09-17 15:52:51 -0700550 }
551}
552
Stan Rokita7a723542019-08-29 15:47:50 -0700553void HalProxy::setDirectChannelFlags(SensorInfo* sensorInfo, ISensorsSubHal* subHal) {
554 bool sensorSupportsDirectChannel =
555 (sensorInfo->flags & (V1_0::SensorFlagBits::MASK_DIRECT_REPORT |
556 V1_0::SensorFlagBits::MASK_DIRECT_CHANNEL)) != 0;
557 if (mDirectChannelSubHal == nullptr && sensorSupportsDirectChannel) {
558 mDirectChannelSubHal = subHal;
559 } else if (mDirectChannelSubHal != nullptr && subHal != mDirectChannelSubHal) {
560 // disable direct channel capability for sensors in subHals that are not
561 // the only one we will enable
562 sensorInfo->flags &= ~(V1_0::SensorFlagBits::MASK_DIRECT_REPORT |
563 V1_0::SensorFlagBits::MASK_DIRECT_CHANNEL);
564 }
565}
566
Stan Rokitae0721532019-10-17 11:58:02 -0700567ISensorsSubHal* HalProxy::getSubHalForSensorHandle(int32_t sensorHandle) {
568 return mSubHalList[extractSubHalIndex(sensorHandle)];
569}
570
571bool HalProxy::isSubHalIndexValid(int32_t sensorHandle) {
572 return extractSubHalIndex(sensorHandle) < mSubHalList.size();
Stan Rokita16385312019-09-10 14:54:36 -0700573}
574
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700575size_t HalProxy::countNumWakeupEvents(const std::vector<Event>& events, size_t n) {
576 size_t numWakeupEvents = 0;
577 for (size_t i = 0; i < n; i++) {
578 int32_t sensorHandle = events[i].sensorHandle;
579 if (mSensors[sensorHandle].flags & static_cast<uint32_t>(V1_0::SensorFlagBits::WAKE_UP)) {
580 numWakeupEvents++;
581 }
582 }
583 return numWakeupEvents;
584}
585
Stan Rokitae0721532019-10-17 11:58:02 -0700586int32_t HalProxy::clearSubHalIndex(int32_t sensorHandle) {
Stan Rokitaf97a3f32019-09-13 09:58:47 -0700587 return sensorHandle & (~kSensorHandleSubHalIndexMask);
Stan Rokita16385312019-09-10 14:54:36 -0700588}
589
Stan Rokitae0721532019-10-17 11:58:02 -0700590bool HalProxy::subHalIndexIsClear(int32_t sensorHandle) {
Stan Rokitae93fdf92019-09-24 11:58:51 -0700591 return (sensorHandle & kSensorHandleSubHalIndexMask) == 0;
592}
593
Stan Rokita537c0272019-09-13 10:36:07 -0700594void HalProxyCallback::postEvents(const std::vector<Event>& events, ScopedWakelock wakelock) {
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700595 if (events.empty() || !mHalProxy->areThreadsRunning()) return;
Stan Rokita537c0272019-09-13 10:36:07 -0700596 size_t numWakeupEvents;
597 std::vector<Event> processedEvents = processEvents(events, &numWakeupEvents);
598 if (numWakeupEvents > 0) {
599 ALOG_ASSERT(wakelock.isLocked(),
600 "Wakeup events posted while wakelock unlocked for subhal"
601 " w/ index %zu.",
602 mSubHalIndex);
603 } else {
604 ALOG_ASSERT(!wakelock.isLocked(),
605 "No Wakeup events posted but wakelock locked for subhal"
606 " w/ index %zu.",
607 mSubHalIndex);
608 }
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700609 mHalProxy->postEventsToMessageQueue(events, numWakeupEvents, std::move(wakelock));
Stan Rokita537c0272019-09-13 10:36:07 -0700610}
611
612ScopedWakelock HalProxyCallback::createScopedWakelock(bool lock) {
Stan Rokitad0cd57d2019-09-17 15:52:51 -0700613 ScopedWakelock wakelock(mHalProxy, lock);
Stan Rokita537c0272019-09-13 10:36:07 -0700614 return wakelock;
615}
616
617std::vector<Event> HalProxyCallback::processEvents(const std::vector<Event>& events,
618 size_t* numWakeupEvents) const {
Stan Rokita537c0272019-09-13 10:36:07 -0700619 *numWakeupEvents = 0;
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700620 std::vector<Event> eventsOut;
Stan Rokita537c0272019-09-13 10:36:07 -0700621 for (Event event : events) {
Stan Rokitae93fdf92019-09-24 11:58:51 -0700622 event.sensorHandle = setSubHalIndex(event.sensorHandle, mSubHalIndex);
Stan Rokita537c0272019-09-13 10:36:07 -0700623 eventsOut.push_back(event);
Stan Rokita75cc7bf2019-09-26 13:17:01 -0700624 const SensorInfo& sensor = mHalProxy->getSensorInfo(event.sensorHandle);
625 if ((sensor.flags & V1_0::SensorFlagBits::WAKE_UP) != 0) {
Stan Rokita537c0272019-09-13 10:36:07 -0700626 (*numWakeupEvents)++;
627 }
628 }
629 return eventsOut;
630}
631
Anthony Stangea689f8a2019-07-30 11:35:48 -0400632} // namespace implementation
633} // namespace V2_0
634} // namespace sensors
635} // namespace hardware
636} // namespace android