Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 1 | /* |
| 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 Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 19 | #include "SubHal.h" |
| 20 | |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 21 | #include <android/hardware/sensors/2.0/types.h> |
| 22 | |
Stan Rokita | d0cd57d | 2019-09-17 15:52:51 -0700 | [diff] [blame] | 23 | #include "hardware_legacy/power.h" |
| 24 | |
Stan Rokita | 2879067 | 2019-08-20 14:32:15 -0700 | [diff] [blame] | 25 | #include <dlfcn.h> |
| 26 | |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 27 | #include <cinttypes> |
Stan Rokita | 2879067 | 2019-08-20 14:32:15 -0700 | [diff] [blame] | 28 | #include <fstream> |
| 29 | #include <functional> |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 30 | #include <thread> |
Stan Rokita | 2879067 | 2019-08-20 14:32:15 -0700 | [diff] [blame] | 31 | |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 32 | namespace android { |
| 33 | namespace hardware { |
| 34 | namespace sensors { |
| 35 | namespace V2_0 { |
| 36 | namespace implementation { |
| 37 | |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 38 | using ::android::hardware::sensors::V2_0::EventQueueFlagBits; |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 39 | using ::android::hardware::sensors::V2_0::WakeLockQueueFlagBits; |
| 40 | using ::android::hardware::sensors::V2_0::implementation::getTimeNow; |
| 41 | using ::android::hardware::sensors::V2_0::implementation::kWakelockTimeoutNs; |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 42 | |
Stan Rokita | 2879067 | 2019-08-20 14:32:15 -0700 | [diff] [blame] | 43 | typedef ISensorsSubHal*(SensorsHalGetSubHalFunc)(uint32_t*); |
| 44 | |
Stan Rokita | e072153 | 2019-10-17 11:58:02 -0700 | [diff] [blame^] | 45 | static constexpr int32_t kBitsAfterSubHalIndex = 24; |
| 46 | |
Stan Rokita | e93fdf9 | 2019-09-24 11:58:51 -0700 | [diff] [blame] | 47 | /** |
| 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 Rokita | e072153 | 2019-10-17 11:58:02 -0700 | [diff] [blame^] | 55 | int32_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 | */ |
| 66 | size_t extractSubHalIndex(int32_t sensorHandle) { |
| 67 | return static_cast<size_t>(sensorHandle >> kBitsAfterSubHalIndex); |
Stan Rokita | e93fdf9 | 2019-09-24 11:58:51 -0700 | [diff] [blame] | 68 | } |
| 69 | |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 70 | HalProxy::HalProxy() { |
Stan Rokita | 7a72354 | 2019-08-29 15:47:50 -0700 | [diff] [blame] | 71 | const char* kMultiHalConfigFile = "/vendor/etc/sensors/hals.conf"; |
| 72 | initializeSubHalListFromConfigFile(kMultiHalConfigFile); |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 73 | init(); |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 74 | } |
| 75 | |
Anthony Stange | aacbf94 | 2019-08-30 15:21:34 -0400 | [diff] [blame] | 76 | HalProxy::HalProxy(std::vector<ISensorsSubHal*>& subHalList) : mSubHalList(subHalList) { |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 77 | init(); |
Anthony Stange | aacbf94 | 2019-08-30 15:21:34 -0400 | [diff] [blame] | 78 | } |
| 79 | |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 80 | HalProxy::~HalProxy() { |
Stan Rokita | 336c1c7 | 2019-10-14 15:30:57 -0700 | [diff] [blame] | 81 | stopThreads(); |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 82 | } |
| 83 | |
Stan Rokita | dc7a8e7 | 2019-08-23 12:35:40 -0700 | [diff] [blame] | 84 | Return<void> HalProxy::getSensorsList(getSensorsList_cb _hidl_cb) { |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 85 | std::vector<SensorInfo> sensors; |
| 86 | for (const auto& iter : mSensors) { |
| 87 | sensors.push_back(iter.second); |
| 88 | } |
| 89 | _hidl_cb(sensors); |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 90 | return Void(); |
| 91 | } |
| 92 | |
Stan Rokita | 7a72354 | 2019-08-29 15:47:50 -0700 | [diff] [blame] | 93 | Return<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 Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 114 | } |
| 115 | |
Stan Rokita | 4b4c7b7 | 2019-09-10 15:07:59 -0700 | [diff] [blame] | 116 | Return<Result> HalProxy::activate(int32_t sensorHandle, bool enabled) { |
Stan Rokita | e072153 | 2019-10-17 11:58:02 -0700 | [diff] [blame^] | 117 | if (!isSubHalIndexValid(sensorHandle)) { |
| 118 | return Result::BAD_VALUE; |
| 119 | } |
Stan Rokita | 4b4c7b7 | 2019-09-10 15:07:59 -0700 | [diff] [blame] | 120 | return getSubHalForSensorHandle(sensorHandle) |
Stan Rokita | f97a3f3 | 2019-09-13 09:58:47 -0700 | [diff] [blame] | 121 | ->activate(clearSubHalIndex(sensorHandle), enabled); |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 122 | } |
| 123 | |
| 124 | Return<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 Rokita | 336c1c7 | 2019-10-14 15:30:57 -0700 | [diff] [blame] | 130 | 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 Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 142 | |
| 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 Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 149 | // 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 Rokita | 336c1c7 | 2019-10-14 15:30:57 -0700 | [diff] [blame] | 154 | 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 Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 166 | if (!mDynamicSensorsCallback || !mEventQueue || !mWakeLockQueue || mEventQueueFlag == nullptr) { |
| 167 | result = Result::BAD_VALUE; |
| 168 | } |
| 169 | |
Stan Rokita | 336c1c7 | 2019-10-14 15:30:57 -0700 | [diff] [blame] | 170 | mThreadsRun.store(true); |
| 171 | |
Stan Rokita | 5971426 | 2019-09-20 10:55:30 -0700 | [diff] [blame] | 172 | mPendingWritesThread = std::thread(startPendingWritesThread, this); |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 173 | mWakelockThread = std::thread(startWakelockThread, this); |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 174 | |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 175 | 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 Rokita | 336c1c7 | 2019-10-14 15:30:57 -0700 | [diff] [blame] | 186 | mCurrentOperationMode = OperationMode::NORMAL; |
| 187 | |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 188 | return result; |
| 189 | } |
| 190 | |
Stan Rokita | 4b4c7b7 | 2019-09-10 15:07:59 -0700 | [diff] [blame] | 191 | Return<Result> HalProxy::batch(int32_t sensorHandle, int64_t samplingPeriodNs, |
| 192 | int64_t maxReportLatencyNs) { |
Stan Rokita | e072153 | 2019-10-17 11:58:02 -0700 | [diff] [blame^] | 193 | if (!isSubHalIndexValid(sensorHandle)) { |
| 194 | return Result::BAD_VALUE; |
| 195 | } |
Stan Rokita | 4b4c7b7 | 2019-09-10 15:07:59 -0700 | [diff] [blame] | 196 | return getSubHalForSensorHandle(sensorHandle) |
Stan Rokita | f97a3f3 | 2019-09-13 09:58:47 -0700 | [diff] [blame] | 197 | ->batch(clearSubHalIndex(sensorHandle), samplingPeriodNs, maxReportLatencyNs); |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 198 | } |
| 199 | |
Stan Rokita | 4b4c7b7 | 2019-09-10 15:07:59 -0700 | [diff] [blame] | 200 | Return<Result> HalProxy::flush(int32_t sensorHandle) { |
Stan Rokita | e072153 | 2019-10-17 11:58:02 -0700 | [diff] [blame^] | 201 | if (!isSubHalIndexValid(sensorHandle)) { |
| 202 | return Result::BAD_VALUE; |
| 203 | } |
Stan Rokita | f97a3f3 | 2019-09-13 09:58:47 -0700 | [diff] [blame] | 204 | return getSubHalForSensorHandle(sensorHandle)->flush(clearSubHalIndex(sensorHandle)); |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 205 | } |
| 206 | |
Stan Rokita | 83e4370 | 2019-09-24 10:16:08 -0700 | [diff] [blame] | 207 | Return<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 Rokita | e072153 | 2019-10-17 11:58:02 -0700 | [diff] [blame^] | 217 | if (!isSubHalIndexValid(event.sensorHandle)) { |
| 218 | return Result::BAD_VALUE; |
| 219 | } |
Stan Rokita | 83e4370 | 2019-09-24 10:16:08 -0700 | [diff] [blame] | 220 | subHalEvent.sensorHandle = clearSubHalIndex(event.sensorHandle); |
| 221 | result = getSubHalForSensorHandle(event.sensorHandle)->injectSensorData(subHalEvent); |
| 222 | } |
| 223 | return result; |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 224 | } |
| 225 | |
Stan Rokita | db23aa8 | 2019-09-24 11:08:27 -0700 | [diff] [blame] | 226 | Return<void> HalProxy::registerDirectChannel(const SharedMemInfo& mem, |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 227 | registerDirectChannel_cb _hidl_cb) { |
Stan Rokita | db23aa8 | 2019-09-24 11:08:27 -0700 | [diff] [blame] | 228 | if (mDirectChannelSubHal == nullptr) { |
| 229 | _hidl_cb(Result::INVALID_OPERATION, -1 /* channelHandle */); |
| 230 | } else { |
| 231 | mDirectChannelSubHal->registerDirectChannel(mem, _hidl_cb); |
| 232 | } |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 233 | return Return<void>(); |
| 234 | } |
| 235 | |
Stan Rokita | db23aa8 | 2019-09-24 11:08:27 -0700 | [diff] [blame] | 236 | Return<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 Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 244 | } |
| 245 | |
Stan Rokita | db23aa8 | 2019-09-24 11:08:27 -0700 | [diff] [blame] | 246 | Return<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 Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 254 | return Return<void>(); |
| 255 | } |
| 256 | |
| 257 | Return<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 Rokita | e93fdf9 | 2019-09-24 11:58:51 -0700 | [diff] [blame] | 262 | Return<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 Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 279 | return Return<void>(); |
| 280 | } |
| 281 | |
| 282 | Return<void> HalProxy::onDynamicSensorsDisconnected( |
Stan Rokita | e93fdf9 | 2019-09-24 11:58:51 -0700 | [diff] [blame] | 283 | 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 Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 301 | return Return<void>(); |
| 302 | } |
| 303 | |
Stan Rokita | dc7a8e7 | 2019-08-23 12:35:40 -0700 | [diff] [blame] | 304 | void HalProxy::initializeSubHalListFromConfigFile(const char* configFileName) { |
| 305 | std::ifstream subHalConfigStream(configFileName); |
| 306 | if (!subHalConfigStream) { |
Stan Rokita | 7a72354 | 2019-08-29 15:47:50 -0700 | [diff] [blame] | 307 | ALOGE("Failed to load subHal config file: %s", configFileName); |
Stan Rokita | dc7a8e7 | 2019-08-23 12:35:40 -0700 | [diff] [blame] | 308 | } else { |
| 309 | std::string subHalLibraryFile; |
| 310 | while (subHalConfigStream >> subHalLibraryFile) { |
| 311 | void* handle = dlopen(subHalLibraryFile.c_str(), RTLD_NOW); |
| 312 | if (handle == nullptr) { |
Stan Rokita | 7a72354 | 2019-08-29 15:47:50 -0700 | [diff] [blame] | 313 | ALOGE("dlopen failed for library: %s", subHalLibraryFile.c_str()); |
Stan Rokita | dc7a8e7 | 2019-08-23 12:35:40 -0700 | [diff] [blame] | 314 | } else { |
| 315 | SensorsHalGetSubHalFunc* sensorsHalGetSubHalPtr = |
| 316 | (SensorsHalGetSubHalFunc*)dlsym(handle, "sensorsHalGetSubHal"); |
| 317 | if (sensorsHalGetSubHalPtr == nullptr) { |
Stan Rokita | 7a72354 | 2019-08-29 15:47:50 -0700 | [diff] [blame] | 318 | ALOGE("Failed to locate sensorsHalGetSubHal function for library: %s", |
| 319 | subHalLibraryFile.c_str()); |
Stan Rokita | dc7a8e7 | 2019-08-23 12:35:40 -0700 | [diff] [blame] | 320 | } 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 Rokita | 7a72354 | 2019-08-29 15:47:50 -0700 | [diff] [blame] | 326 | ALOGE("SubHal version was not 2.0 for library: %s", |
| 327 | subHalLibraryFile.c_str()); |
Stan Rokita | dc7a8e7 | 2019-08-23 12:35:40 -0700 | [diff] [blame] | 328 | } else { |
| 329 | ALOGV("Loaded SubHal from library: %s", subHalLibraryFile.c_str()); |
| 330 | mSubHalList.push_back(subHal); |
| 331 | } |
| 332 | } |
| 333 | } |
| 334 | } |
| 335 | } |
| 336 | } |
| 337 | |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 338 | void 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 Rokita | dc7a8e7 | 2019-08-23 12:35:40 -0700 | [diff] [blame] | 345 | void 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 Rokita | e93fdf9 | 2019-09-24 11:58:51 -0700 | [diff] [blame] | 350 | if (!subHalIndexIsClear(sensor.sensorHandle)) { |
Stan Rokita | dc7a8e7 | 2019-08-23 12:35:40 -0700 | [diff] [blame] | 351 | ALOGE("SubHal sensorHandle's first byte was not 0"); |
| 352 | } else { |
| 353 | ALOGV("Loaded sensor: %s", sensor.name.c_str()); |
Stan Rokita | e072153 | 2019-10-17 11:58:02 -0700 | [diff] [blame^] | 354 | sensor.sensorHandle = setSubHalIndex(sensor.sensorHandle, subHalIndex); |
Stan Rokita | 7a72354 | 2019-08-29 15:47:50 -0700 | [diff] [blame] | 355 | setDirectChannelFlags(&sensor, subHal); |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 356 | mSensors[sensor.sensorHandle] = sensor; |
Stan Rokita | dc7a8e7 | 2019-08-23 12:35:40 -0700 | [diff] [blame] | 357 | } |
| 358 | } |
| 359 | }); |
| 360 | if (!result.isOk()) { |
| 361 | ALOGE("getSensorsList call failed for SubHal: %s", subHal->getName().c_str()); |
| 362 | } |
| 363 | } |
| 364 | } |
| 365 | |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 366 | void HalProxy::init() { |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 367 | initializeSubHalCallbacks(); |
| 368 | initializeSensorList(); |
| 369 | } |
| 370 | |
Stan Rokita | 336c1c7 | 2019-10-14 15:30:57 -0700 | [diff] [blame] | 371 | void 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 | |
| 394 | void 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 Rokita | 5971426 | 2019-09-20 10:55:30 -0700 | [diff] [blame] | 406 | void HalProxy::startPendingWritesThread(HalProxy* halProxy) { |
| 407 | halProxy->handlePendingWrites(); |
| 408 | } |
| 409 | |
| 410 | void 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 Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 413 | while (mThreadsRun.load()) { |
Stan Rokita | 5971426 | 2019-09-20 10:55:30 -0700 | [diff] [blame] | 414 | mEventQueueWriteCV.wait( |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 415 | 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 Rokita | 5971426 | 2019-09-20 10:55:30 -0700 | [diff] [blame] | 419 | size_t eventQueueSize = mEventQueue->getQuantumCount(); |
| 420 | size_t numToWrite = std::min(pendingWriteEvents.size(), eventQueueSize); |
| 421 | lock.unlock(); |
Stan Rokita | 5971426 | 2019-09-20 10:55:30 -0700 | [diff] [blame] | 422 | 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 Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 426 | kPendingWriteTimeoutNs, mEventQueueFlag)) { |
Stan Rokita | 5971426 | 2019-09-20 10:55:30 -0700 | [diff] [blame] | 427 | ALOGE("Dropping %zu events after blockingWrite failed.", numToWrite); |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 428 | if (numWakeupEvents > 0) { |
| 429 | if (pendingWriteEvents.size() > eventQueueSize) { |
| 430 | decrementRefCountAndMaybeReleaseWakelock( |
| 431 | countNumWakeupEvents(pendingWriteEvents, eventQueueSize)); |
| 432 | } else { |
| 433 | decrementRefCountAndMaybeReleaseWakelock(numWakeupEvents); |
| 434 | } |
| 435 | } |
Stan Rokita | 5971426 | 2019-09-20 10:55:30 -0700 | [diff] [blame] | 436 | } |
| 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 Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 450 | void HalProxy::startWakelockThread(HalProxy* halProxy) { |
| 451 | halProxy->handleWakelocks(); |
| 452 | } |
| 453 | |
| 454 | void 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 | |
| 479 | bool 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 | |
| 491 | void HalProxy::resetSharedWakelock() { |
| 492 | std::lock_guard<std::recursive_mutex> lockGuard(mWakelockMutex); |
| 493 | decrementRefCountAndMaybeReleaseWakelock(mWakelockRefCount); |
| 494 | mWakelockTimeoutResetTime = getTimeNow(); |
| 495 | } |
| 496 | |
| 497 | void HalProxy::postEventsToMessageQueue(const std::vector<Event>& events, size_t numWakeupEvents, |
| 498 | ScopedWakelock wakelock) { |
Stan Rokita | 5971426 | 2019-09-20 10:55:30 -0700 | [diff] [blame] | 499 | size_t numToWrite = 0; |
| 500 | std::lock_guard<std::mutex> lock(mEventQueueWriteMutex); |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 501 | if (wakelock.isLocked()) { |
| 502 | incrementRefCountAndMaybeAcquireWakelock(numWakeupEvents); |
| 503 | } |
Stan Rokita | 5971426 | 2019-09-20 10:55:30 -0700 | [diff] [blame] | 504 | 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 Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 514 | } |
| 515 | } |
| 516 | if (numToWrite < events.size()) { |
Stan Rokita | 5971426 | 2019-09-20 10:55:30 -0700 | [diff] [blame] | 517 | // TODO: Bound the mPendingWriteEventsQueue so that we do not trigger OOMs if framework |
| 518 | // stalls |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 519 | std::vector<Event> eventsLeft(events.begin() + numToWrite, events.end()); |
| 520 | mPendingWriteEventsQueue.push({eventsLeft, numWakeupEvents}); |
Stan Rokita | 5971426 | 2019-09-20 10:55:30 -0700 | [diff] [blame] | 521 | mEventQueueWriteCV.notify_one(); |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 522 | } |
| 523 | } |
| 524 | |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 525 | bool 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 Rokita | d0cd57d | 2019-09-17 15:52:51 -0700 | [diff] [blame] | 529 | if (mWakelockRefCount == 0) { |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 530 | acquire_wake_lock(PARTIAL_WAKE_LOCK, kWakelockName); |
| 531 | mWakelockCV.notify_one(); |
Stan Rokita | d0cd57d | 2019-09-17 15:52:51 -0700 | [diff] [blame] | 532 | } |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 533 | mWakelockTimeoutStartTime = getTimeNow(); |
| 534 | mWakelockRefCount += delta; |
| 535 | if (timeoutStart != nullptr) { |
| 536 | *timeoutStart = mWakelockTimeoutStartTime; |
| 537 | } |
| 538 | return true; |
Stan Rokita | d0cd57d | 2019-09-17 15:52:51 -0700 | [diff] [blame] | 539 | } |
| 540 | |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 541 | void 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 Rokita | d0cd57d | 2019-09-17 15:52:51 -0700 | [diff] [blame] | 548 | if (mWakelockRefCount == 0) { |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 549 | release_wake_lock(kWakelockName); |
Stan Rokita | d0cd57d | 2019-09-17 15:52:51 -0700 | [diff] [blame] | 550 | } |
| 551 | } |
| 552 | |
Stan Rokita | 7a72354 | 2019-08-29 15:47:50 -0700 | [diff] [blame] | 553 | void 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 Rokita | e072153 | 2019-10-17 11:58:02 -0700 | [diff] [blame^] | 567 | ISensorsSubHal* HalProxy::getSubHalForSensorHandle(int32_t sensorHandle) { |
| 568 | return mSubHalList[extractSubHalIndex(sensorHandle)]; |
| 569 | } |
| 570 | |
| 571 | bool HalProxy::isSubHalIndexValid(int32_t sensorHandle) { |
| 572 | return extractSubHalIndex(sensorHandle) < mSubHalList.size(); |
Stan Rokita | 1638531 | 2019-09-10 14:54:36 -0700 | [diff] [blame] | 573 | } |
| 574 | |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 575 | size_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 Rokita | e072153 | 2019-10-17 11:58:02 -0700 | [diff] [blame^] | 586 | int32_t HalProxy::clearSubHalIndex(int32_t sensorHandle) { |
Stan Rokita | f97a3f3 | 2019-09-13 09:58:47 -0700 | [diff] [blame] | 587 | return sensorHandle & (~kSensorHandleSubHalIndexMask); |
Stan Rokita | 1638531 | 2019-09-10 14:54:36 -0700 | [diff] [blame] | 588 | } |
| 589 | |
Stan Rokita | e072153 | 2019-10-17 11:58:02 -0700 | [diff] [blame^] | 590 | bool HalProxy::subHalIndexIsClear(int32_t sensorHandle) { |
Stan Rokita | e93fdf9 | 2019-09-24 11:58:51 -0700 | [diff] [blame] | 591 | return (sensorHandle & kSensorHandleSubHalIndexMask) == 0; |
| 592 | } |
| 593 | |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 594 | void HalProxyCallback::postEvents(const std::vector<Event>& events, ScopedWakelock wakelock) { |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 595 | if (events.empty() || !mHalProxy->areThreadsRunning()) return; |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 596 | 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 Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 609 | mHalProxy->postEventsToMessageQueue(events, numWakeupEvents, std::move(wakelock)); |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 610 | } |
| 611 | |
| 612 | ScopedWakelock HalProxyCallback::createScopedWakelock(bool lock) { |
Stan Rokita | d0cd57d | 2019-09-17 15:52:51 -0700 | [diff] [blame] | 613 | ScopedWakelock wakelock(mHalProxy, lock); |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 614 | return wakelock; |
| 615 | } |
| 616 | |
| 617 | std::vector<Event> HalProxyCallback::processEvents(const std::vector<Event>& events, |
| 618 | size_t* numWakeupEvents) const { |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 619 | *numWakeupEvents = 0; |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 620 | std::vector<Event> eventsOut; |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 621 | for (Event event : events) { |
Stan Rokita | e93fdf9 | 2019-09-24 11:58:51 -0700 | [diff] [blame] | 622 | event.sensorHandle = setSubHalIndex(event.sensorHandle, mSubHalIndex); |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 623 | eventsOut.push_back(event); |
Stan Rokita | 75cc7bf | 2019-09-26 13:17:01 -0700 | [diff] [blame] | 624 | const SensorInfo& sensor = mHalProxy->getSensorInfo(event.sensorHandle); |
| 625 | if ((sensor.flags & V1_0::SensorFlagBits::WAKE_UP) != 0) { |
Stan Rokita | 537c027 | 2019-09-13 10:36:07 -0700 | [diff] [blame] | 626 | (*numWakeupEvents)++; |
| 627 | } |
| 628 | } |
| 629 | return eventsOut; |
| 630 | } |
| 631 | |
Anthony Stange | a689f8a | 2019-07-30 11:35:48 -0400 | [diff] [blame] | 632 | } // namespace implementation |
| 633 | } // namespace V2_0 |
| 634 | } // namespace sensors |
| 635 | } // namespace hardware |
| 636 | } // namespace android |