Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2010 The Android Open Source Project |
| 3 | * |
| 4 | * Licensed under the Apache License, Version 2.0 (the "License"); |
| 5 | * you may not use this file except in compliance with the License. |
| 6 | * You may obtain a copy of the License at |
| 7 | * |
| 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
| 9 | * |
| 10 | * Unless required by applicable law or agreed to in writing, software |
| 11 | * distributed under the License is distributed on an "AS IS" BASIS, |
| 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| 13 | * See the License for the specific language governing permissions and |
| 14 | * limitations under the License. |
| 15 | */ |
| 16 | |
| 17 | #ifndef ANDROID_SENSOR_DEVICE_H |
| 18 | #define ANDROID_SENSOR_DEVICE_H |
| 19 | |
Arthur Ishiguro | 24804dc | 2021-11-12 17:17:09 +0000 | [diff] [blame] | 20 | #include "HidlSensorHalWrapper.h" |
| 21 | #include "ISensorHalWrapper.h" |
| 22 | |
Arthur Ishiguro | d6b9e21 | 2021-11-14 01:20:55 +0000 | [diff] [blame] | 23 | #include "ISensorsWrapper.h" |
Peng Xu | 1a00e2d | 2017-09-27 23:08:30 -0700 | [diff] [blame] | 24 | #include "SensorDeviceUtils.h" |
Arthur Ishiguro | 539c27c | 2020-04-13 09:47:59 -0700 | [diff] [blame] | 25 | #include "SensorService.h" |
Peng Xu | 6a2d3a0 | 2015-12-21 12:00:23 -0800 | [diff] [blame] | 26 | #include "SensorServiceUtils.h" |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 27 | |
Mathias Agopian | 801ea09 | 2017-03-06 15:05:04 -0800 | [diff] [blame] | 28 | #include <sensor/Sensor.h> |
Arthur Ishiguro | d6b9e21 | 2021-11-14 01:20:55 +0000 | [diff] [blame] | 29 | #include <sensor/SensorEventQueue.h> |
Steven Moreland | d15c030 | 2016-12-20 11:14:50 -0800 | [diff] [blame] | 30 | #include <stdint.h> |
| 31 | #include <sys/types.h> |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 32 | #include <utils/KeyedVector.h> |
| 33 | #include <utils/Singleton.h> |
| 34 | #include <utils/String8.h> |
Brian Stack | a28e921 | 2018-09-19 15:20:30 -0700 | [diff] [blame] | 35 | #include <utils/Timers.h> |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 36 | |
Peng Xu | 2bec623 | 2016-07-01 17:13:10 -0700 | [diff] [blame] | 37 | #include <algorithm> //std::max std::min |
Mark Wheatley | 8f285d9 | 2023-07-07 20:07:18 +0000 | [diff] [blame] | 38 | #include <condition_variable> |
| 39 | #include <mutex> |
| 40 | #include <queue> |
Arthur Ishiguro | 4f1dd8a | 2021-11-12 17:21:24 +0000 | [diff] [blame] | 41 | #include <string> |
Arthur Ishiguro | d6b9e21 | 2021-11-14 01:20:55 +0000 | [diff] [blame] | 42 | #include <unordered_map> |
Arthur Ishiguro | 4f1dd8a | 2021-11-12 17:21:24 +0000 | [diff] [blame] | 43 | #include <vector> |
Andreas Huber | 99fdbb5 | 2016-10-10 13:22:58 -0700 | [diff] [blame] | 44 | |
Ashutosh Joshi | 96b12d8 | 2017-03-15 16:27:12 -0700 | [diff] [blame] | 45 | #include "RingBuffer.h" |
| 46 | |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 47 | // --------------------------------------------------------------------------- |
| 48 | |
| 49 | namespace android { |
Andreas Huber | 99fdbb5 | 2016-10-10 13:22:58 -0700 | [diff] [blame] | 50 | |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 51 | // --------------------------------------------------------------------------- |
| 52 | |
Arthur Ishiguro | 24804dc | 2021-11-12 17:17:09 +0000 | [diff] [blame] | 53 | class SensorDevice : public Singleton<SensorDevice>, |
| 54 | public SensorServiceUtil::Dumpable, |
| 55 | public ISensorHalWrapper::SensorDeviceCallback { |
Peng Xu | 6a2d3a0 | 2015-12-21 12:00:23 -0800 | [diff] [blame] | 56 | public: |
Brian Stack | a28e921 | 2018-09-19 15:20:30 -0700 | [diff] [blame] | 57 | ~SensorDevice(); |
Brian Stack | 156da08 | 2018-10-01 15:58:53 -0700 | [diff] [blame] | 58 | void prepareForReconnect(); |
| 59 | void reconnect(); |
Brian Stack | a28e921 | 2018-09-19 15:20:30 -0700 | [diff] [blame] | 60 | |
Peng Xu | 6a2d3a0 | 2015-12-21 12:00:23 -0800 | [diff] [blame] | 61 | ssize_t getSensorList(sensor_t const** list); |
Andreas Huber | 99fdbb5 | 2016-10-10 13:22:58 -0700 | [diff] [blame] | 62 | |
Rocky Fang | beb0dff | 2023-12-15 01:59:46 +0000 | [diff] [blame] | 63 | std::vector<int32_t> getDynamicSensorHandles(); |
| 64 | |
Peng Xu | 6a2d3a0 | 2015-12-21 12:00:23 -0800 | [diff] [blame] | 65 | void handleDynamicSensorConnection(int handle, bool connected); |
| 66 | status_t initCheck() const; |
| 67 | int getHalDeviceVersion() const; |
Andreas Huber | 99fdbb5 | 2016-10-10 13:22:58 -0700 | [diff] [blame] | 68 | |
Peng Xu | 6a2d3a0 | 2015-12-21 12:00:23 -0800 | [diff] [blame] | 69 | ssize_t poll(sensors_event_t* buffer, size_t count); |
Brian Stack | b7bfc0f | 2018-09-25 09:41:16 -0700 | [diff] [blame] | 70 | void writeWakeLockHandled(uint32_t count); |
Andreas Huber | 99fdbb5 | 2016-10-10 13:22:58 -0700 | [diff] [blame] | 71 | |
Peng Xu | 6a2d3a0 | 2015-12-21 12:00:23 -0800 | [diff] [blame] | 72 | status_t activate(void* ident, int handle, int enabled); |
| 73 | status_t batch(void* ident, int handle, int flags, int64_t samplingPeriodNs, |
| 74 | int64_t maxBatchReportLatencyNs); |
| 75 | // Call batch with timeout zero instead of calling setDelay() for newer devices. |
| 76 | status_t setDelay(void* ident, int handle, int64_t ns); |
| 77 | status_t flush(void* ident, int handle); |
| 78 | status_t setMode(uint32_t mode); |
Peng Xu | e36e347 | 2016-11-03 11:57:10 -0700 | [diff] [blame] | 79 | |
Peng Xu | 5363254 | 2017-01-23 20:06:27 -0800 | [diff] [blame] | 80 | bool isDirectReportSupported() const; |
Arthur Ishiguro | d6b9e21 | 2021-11-14 01:20:55 +0000 | [diff] [blame] | 81 | int32_t registerDirectChannel(const sensors_direct_mem_t* memory); |
Peng Xu | e36e347 | 2016-11-03 11:57:10 -0700 | [diff] [blame] | 82 | void unregisterDirectChannel(int32_t channelHandle); |
Arthur Ishiguro | d6b9e21 | 2021-11-14 01:20:55 +0000 | [diff] [blame] | 83 | int32_t configureDirectChannel(int32_t sensorHandle, int32_t channelHandle, |
| 84 | const struct sensors_direct_cfg_t* config); |
Peng Xu | e36e347 | 2016-11-03 11:57:10 -0700 | [diff] [blame] | 85 | |
Peng Xu | 6a2d3a0 | 2015-12-21 12:00:23 -0800 | [diff] [blame] | 86 | void disableAllSensors(); |
| 87 | void enableAllSensors(); |
Arthur Ishiguro | d6b9e21 | 2021-11-14 01:20:55 +0000 | [diff] [blame] | 88 | void autoDisable(void* ident, int handle); |
Andreas Huber | 99fdbb5 | 2016-10-10 13:22:58 -0700 | [diff] [blame] | 89 | |
Arthur Ishiguro | d6b9e21 | 2021-11-14 01:20:55 +0000 | [diff] [blame] | 90 | status_t injectSensorData(const sensors_event_t* event); |
| 91 | void notifyConnectionDestroyed(void* ident); |
Peng Xu | 6a2d3a0 | 2015-12-21 12:00:23 -0800 | [diff] [blame] | 92 | |
Arthur Ishiguro | 24804dc | 2021-11-12 17:17:09 +0000 | [diff] [blame] | 93 | // SensorDeviceCallback |
| 94 | virtual void onDynamicSensorsConnected( |
| 95 | const std::vector<sensor_t>& dynamicSensorsAdded) override; |
| 96 | virtual void onDynamicSensorsDisconnected( |
| 97 | const std::vector<int32_t>& dynamicSensorHandlesRemoved) override; |
Brian Stack | 6c49e6f | 2018-09-24 15:44:32 -0700 | [diff] [blame] | 98 | |
Arthur Ishiguro | 539c27c | 2020-04-13 09:47:59 -0700 | [diff] [blame] | 99 | void setUidStateForConnection(void* ident, SensorService::UidState state); |
| 100 | |
Arthur Ishiguro | 24804dc | 2021-11-12 17:17:09 +0000 | [diff] [blame] | 101 | bool isReconnecting() const { return mHalWrapper->mReconnecting; } |
Brian Stack | 156da08 | 2018-10-01 15:58:53 -0700 | [diff] [blame] | 102 | |
Brian Stack | bce04d7 | 2019-03-21 10:54:10 -0700 | [diff] [blame] | 103 | bool isSensorActive(int handle) const; |
| 104 | |
Anh Pham | 5198c99 | 2021-02-10 14:15:30 +0100 | [diff] [blame] | 105 | // To update the BatchParams of a SensorEventConnection when the mic toggle changes its state |
| 106 | // while the Sensors Off toggle is on. |
| 107 | void onMicSensorAccessChanged(void* ident, int handle, nsecs_t samplingPeriodNs); |
| 108 | |
Peng Xu | 6a2d3a0 | 2015-12-21 12:00:23 -0800 | [diff] [blame] | 109 | // Dumpable |
Mike Ma | 2474386 | 2020-01-29 00:36:55 -0800 | [diff] [blame] | 110 | virtual std::string dump() const override; |
| 111 | virtual void dump(util::ProtoOutputStream* proto) const override; |
Arthur Ishiguro | d6b9e21 | 2021-11-14 01:20:55 +0000 | [diff] [blame] | 112 | |
Peng Xu | 6a2d3a0 | 2015-12-21 12:00:23 -0800 | [diff] [blame] | 113 | private: |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 114 | friend class Singleton<SensorDevice>; |
Steven Moreland | d15c030 | 2016-12-20 11:14:50 -0800 | [diff] [blame] | 115 | |
Arthur Ishiguro | 24804dc | 2021-11-12 17:17:09 +0000 | [diff] [blame] | 116 | std::unique_ptr<ISensorHalWrapper> mHalWrapper; |
| 117 | |
Arthur Ishiguro | 4f1dd8a | 2021-11-12 17:21:24 +0000 | [diff] [blame] | 118 | std::vector<sensor_t> mSensorList; |
Arthur Ishiguro | 71e78ac | 2021-11-14 01:18:47 +0000 | [diff] [blame] | 119 | std::unordered_map<int32_t, sensor_t> mConnectedDynamicSensors; |
Andreas Huber | 99fdbb5 | 2016-10-10 13:22:58 -0700 | [diff] [blame] | 120 | |
Anthony Stange | fb4e33a | 2021-09-29 15:47:53 +0000 | [diff] [blame] | 121 | // A bug in the Sensors HIDL spec which marks onDynamicSensorsConnected as oneway causes dynamic |
| 122 | // meta events and onDynamicSensorsConnected to be received out of order. This mutex + CV are |
| 123 | // used to block meta event processing until onDynamicSensorsConnected is received to simplify |
| 124 | // HAL implementations. |
| 125 | std::mutex mDynamicSensorsMutex; |
| 126 | std::condition_variable mDynamicSensorsCv; |
Arthur Ishiguro | 65b5981 | 2021-12-26 19:09:54 +0000 | [diff] [blame] | 127 | static constexpr std::chrono::seconds MAX_DYN_SENSOR_WAIT{5}; |
Anthony Stange | fb4e33a | 2021-09-29 15:47:53 +0000 | [diff] [blame] | 128 | |
Arthur Ishiguro | d6b9e21 | 2021-11-14 01:20:55 +0000 | [diff] [blame] | 129 | static const nsecs_t MINIMUM_EVENTS_PERIOD = 1000000; // 1000 Hz |
| 130 | mutable Mutex mLock; // protect mActivationCount[].batchParams |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 131 | // fixed-size array after construction |
Aravind Akella | 724d91d | 2013-06-27 12:04:23 -0700 | [diff] [blame] | 132 | |
| 133 | // Struct to store all the parameters(samplingPeriod, maxBatchReportLatency and flags) from |
| 134 | // batch call. For continous mode clients, maxBatchReportLatency is set to zero. |
| 135 | struct BatchParams { |
Arthur Ishiguro | d6b9e21 | 2021-11-14 01:20:55 +0000 | [diff] [blame] | 136 | nsecs_t mTSample, mTBatch; |
| 137 | BatchParams() : mTSample(INT64_MAX), mTBatch(INT64_MAX) {} |
| 138 | BatchParams(nsecs_t tSample, nsecs_t tBatch) : mTSample(tSample), mTBatch(tBatch) {} |
| 139 | bool operator!=(const BatchParams& other) { |
| 140 | return !(mTSample == other.mTSample && mTBatch == other.mTBatch); |
| 141 | } |
| 142 | // Merge another parameter with this one. The updated mTSample will be the min of the two. |
| 143 | // The update mTBatch will be the min of original mTBatch and the apparent batch period |
| 144 | // of the other. the apparent batch is the maximum of mTBatch and mTSample, |
| 145 | void merge(const BatchParams& other) { |
| 146 | mTSample = std::min(mTSample, other.mTSample); |
| 147 | mTBatch = std::min(mTBatch, std::max(other.mTBatch, other.mTSample)); |
| 148 | } |
Aravind Akella | 724d91d | 2013-06-27 12:04:23 -0700 | [diff] [blame] | 149 | }; |
| 150 | |
| 151 | // Store batch parameters in the KeyedVector and the optimal batch_rate and timeout in |
| 152 | // bestBatchParams. For every batch() call corresponding params are stored in batchParams |
| 153 | // vector. A continuous mode request is batch(... timeout=0 ..) followed by activate(). A batch |
| 154 | // mode request is batch(... timeout > 0 ...) followed by activate(). |
| 155 | // Info is a per-sensor data structure which contains the batch parameters for each client that |
| 156 | // has registered for this sensor. |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 157 | struct Info { |
Aravind Akella | 724d91d | 2013-06-27 12:04:23 -0700 | [diff] [blame] | 158 | BatchParams bestBatchParams; |
| 159 | // Key is the unique identifier(ident) for each client, value is the batch parameters |
| 160 | // requested by the client. |
| 161 | KeyedVector<void*, BatchParams> batchParams; |
| 162 | |
Brian Stack | 0c305fe | 2019-04-09 12:49:24 -0700 | [diff] [blame] | 163 | // Flag to track if the sensor is active |
| 164 | bool isActive = false; |
| 165 | |
Aravind Akella | 724d91d | 2013-06-27 12:04:23 -0700 | [diff] [blame] | 166 | // Sets batch parameters for this ident. Returns error if this ident is not already present |
| 167 | // in the KeyedVector above. |
| 168 | status_t setBatchParamsForIdent(void* ident, int flags, int64_t samplingPeriodNs, |
| 169 | int64_t maxBatchReportLatencyNs); |
| 170 | // Finds the optimal parameters for batching and stores them in bestBatchParams variable. |
| 171 | void selectBatchParams(); |
| 172 | // Removes batchParams for an ident and re-computes bestBatchParams. Returns the index of |
| 173 | // the removed ident. If index >=0, ident is present and successfully removed. |
| 174 | ssize_t removeBatchParamsForIdent(void* ident); |
Aravind Akella | 4949c50 | 2015-02-11 15:54:35 -0800 | [diff] [blame] | 175 | |
Arthur Ishiguro | 539c27c | 2020-04-13 09:47:59 -0700 | [diff] [blame] | 176 | bool hasBatchParamsForIdent(void* ident) const { |
| 177 | return batchParams.indexOfKey(ident) >= 0; |
| 178 | } |
| 179 | |
| 180 | /** |
| 181 | * @return The number of active clients of this sensor. |
| 182 | */ |
Brian Stack | 156da08 | 2018-10-01 15:58:53 -0700 | [diff] [blame] | 183 | int numActiveClients() const; |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 184 | }; |
| 185 | DefaultKeyedVector<int, Info> mActivationCount; |
| 186 | |
Ashutosh Joshi | 96b12d8 | 2017-03-15 16:27:12 -0700 | [diff] [blame] | 187 | int mTotalHidlTransportErrors; |
| 188 | |
Arthur Ishiguro | 539c27c | 2020-04-13 09:47:59 -0700 | [diff] [blame] | 189 | /** |
| 190 | * Enums describing the reason why a client was disabled. |
| 191 | */ |
| 192 | enum DisabledReason : uint8_t { |
| 193 | // UID becomes idle (e.g. app goes to background). |
| 194 | DISABLED_REASON_UID_IDLE = 0, |
| 195 | |
| 196 | // Sensors are restricted for all clients. |
| 197 | DISABLED_REASON_SERVICE_RESTRICTED, |
| 198 | DISABLED_REASON_MAX, |
| 199 | }; |
| 200 | |
| 201 | static_assert(DisabledReason::DISABLED_REASON_MAX < sizeof(uint8_t) * CHAR_BIT); |
| 202 | |
| 203 | // Use this map to determine which client is activated or deactivated. |
Arthur Ishiguro | d6b9e21 | 2021-11-14 01:20:55 +0000 | [diff] [blame] | 204 | std::unordered_map<void*, uint8_t> mDisabledClients; |
Arthur Ishiguro | 539c27c | 2020-04-13 09:47:59 -0700 | [diff] [blame] | 205 | |
| 206 | void addDisabledReasonForIdentLocked(void* ident, DisabledReason reason); |
| 207 | void removeDisabledReasonForIdentLocked(void* ident, DisabledReason reason); |
| 208 | |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 209 | SensorDevice(); |
Arthur Ishiguro | 24804dc | 2021-11-12 17:17:09 +0000 | [diff] [blame] | 210 | bool connectHalService(); |
Brian Stack | 156da08 | 2018-10-01 15:58:53 -0700 | [diff] [blame] | 211 | void initializeSensorList(); |
| 212 | void reactivateSensors(const DefaultKeyedVector<int, Info>& previousActivations); |
Arthur Ishiguro | 4f1dd8a | 2021-11-12 17:21:24 +0000 | [diff] [blame] | 213 | static bool sensorHandlesChanged(const std::vector<sensor_t>& oldSensorList, |
| 214 | const std::vector<sensor_t>& newSensorList); |
Brian Stack | 156da08 | 2018-10-01 15:58:53 -0700 | [diff] [blame] | 215 | static bool sensorIsEquivalent(const sensor_t& prevSensor, const sensor_t& newSensor); |
Brian Stack | 979887b | 2018-09-19 15:27:48 -0700 | [diff] [blame] | 216 | |
Brian Stack | 156da08 | 2018-10-01 15:58:53 -0700 | [diff] [blame] | 217 | status_t activateLocked(void* ident, int handle, int enabled); |
| 218 | status_t batchLocked(void* ident, int handle, int flags, int64_t samplingPeriodNs, |
| 219 | int64_t maxBatchReportLatencyNs); |
Brian Stack | a28e921 | 2018-09-19 15:20:30 -0700 | [diff] [blame] | 220 | |
Arthur Ishiguro | 539c27c | 2020-04-13 09:47:59 -0700 | [diff] [blame] | 221 | status_t updateBatchParamsLocked(int handle, Info& info); |
| 222 | status_t doActivateHardwareLocked(int handle, bool enable); |
| 223 | |
Arthur Ishiguro | 539c27c | 2020-04-13 09:47:59 -0700 | [diff] [blame] | 224 | bool isClientDisabled(void* ident) const; |
| 225 | bool isClientDisabledLocked(void* ident) const; |
Arthur Ishiguro | d6b9e21 | 2021-11-14 01:20:55 +0000 | [diff] [blame] | 226 | std::vector<void*> getDisabledClientsLocked() const; |
Arthur Ishiguro | 539c27c | 2020-04-13 09:47:59 -0700 | [diff] [blame] | 227 | |
| 228 | bool clientHasNoAccessLocked(void* ident) const; |
Andreas Huber | 99fdbb5 | 2016-10-10 13:22:58 -0700 | [diff] [blame] | 229 | |
Anthony Stange | 1292486 | 2020-03-20 10:46:15 -0400 | [diff] [blame] | 230 | float getResolutionForSensor(int sensorHandle); |
| 231 | |
Peng Xu | 5363254 | 2017-01-23 20:06:27 -0800 | [diff] [blame] | 232 | bool mIsDirectReportSupported; |
Mark Wheatley | 8f285d9 | 2023-07-07 20:07:18 +0000 | [diff] [blame] | 233 | |
| 234 | std::mutex mHalBypassLock; |
| 235 | std::condition_variable mHalBypassCV; |
| 236 | std::queue<sensors_event_t> mHalBypassInjectedEventQueue; |
| 237 | ssize_t getHalBypassInjectedEvents(sensors_event_t* buffer, size_t count); |
| 238 | bool mInHalBypassMode; |
Mathias Agopian | f001c92 | 2010-11-11 17:58:51 -0800 | [diff] [blame] | 239 | }; |
| 240 | |
| 241 | // --------------------------------------------------------------------------- |
| 242 | }; // namespace android |
| 243 | |
| 244 | #endif // ANDROID_SENSOR_DEVICE_H |