Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 32895908 authored by Anthony Stange's avatar Anthony Stange
Browse files

Prep ISensorsWrapper to be used by the framework

Bug: 144139857
Test: Load sensors framework and verify it can receive data
Change-Id: I08bdb23779a1ec716cd99e3bc9ded4371fe9c89a
parent a9a5eb41
Loading
Loading
Loading
Loading
+158 −85
Original line number Diff line number Diff line
@@ -18,23 +18,19 @@
#define ANDROID_HARDWARE_SENSORS_V2_1_ISENSORSWRAPPER_H

#include "EventMessageQueueWrapper.h"
#include "convertV2_1.h"

#include <android/hardware/sensors/2.1/ISensors.h>
#include <android/hardware/sensors/2.1/types.h>
#include <binder/IBinder.h>
#include <fmq/MessageQueue.h>
#include <hidl/MQDescriptor.h>
#include <hidl/Status.h>
#include <log/log.h>

#include <atomic>

/**
 * ISensorsWrapperBase wraps around the V2_1::ISensors APIs to make any HAL 2.0/2.1 interface
 * appear as a HAL 2.1 implementation. This ensures the maximum amount of code can be shared
 * between VTS, default implementations, and the sensors framework.
 */
#include "ISensorsWrapper.h"

#include "android/hardware/sensors/1.0/ISensors.h"
#include "android/hardware/sensors/1.0/types.h"
#include "android/hardware/sensors/2.0/ISensors.h"
#include "android/hardware/sensors/2.0/ISensorsCallback.h"
#include "android/hardware/sensors/2.1/ISensors.h"
#include "android/hardware/sensors/2.1/ISensorsCallback.h"
#include "android/hardware/sensors/2.1/types.h"

#include <utils/LightRefBase.h>

#include <cassert>

namespace android {
namespace hardware {
@@ -42,135 +38,212 @@ namespace sensors {
namespace V2_1 {
namespace implementation {

using ::android::sp;
using ::android::hardware::MessageQueue;
using ::android::hardware::MQDescriptorSync;
using ::android::hardware::Return;
using ::android::hardware::Void;
using ::android::hardware::sensors::V1_0::ISensors;
using ::android::hardware::sensors::V1_0::OperationMode;
using ::android::hardware::sensors::V1_0::RateLevel;
using ::android::hardware::sensors::V1_0::Result;
using ::android::hardware::sensors::V1_0::SharedMemInfo;
using ::android::hardware::sensors::V2_1::Event;
using ::android::hardware::sensors::V2_1::ISensorsCallback;

// TODO: Look into providing this as a param if it needs to be a different value
// than the framework.
static constexpr size_t MAX_RECEIVE_BUFFER_EVENT_COUNT = 256;

class ISensorsWrapperBase : public RefBase {
/*
 * The ISensorsWrapper interface includes all function from supported Sensors HAL versions. This
 * allows for the SensorDevice to use the ISensorsWrapper interface to interact with the Sensors
 * HAL regardless of the current version of the Sensors HAL that is loaded. Each concrete
 * instantiation of ISensorsWrapper must correspond to a specific Sensors HAL version. This design
 * is beneficial because only the functions that change between Sensors HAL versions must be newly
 * implemented, any previously implemented function that does not change may remain the same.
 *
 * Functions that exist across all versions of the Sensors HAL should be implemented as pure
 * virtual functions which forces the concrete instantiations to implement the functions.
 *
 * Functions that do not exist across all versions of the Sensors HAL should include a default
 * implementation that generates an error if called. The default implementation should never
 * be called and must be overridden by Sensors HAL versions that support the function.
 */
class ISensorsWrapperBase : public VirtualLightRefBase {
  public:
    virtual ~ISensorsWrapperBase() {}
    virtual bool supportsPolling() const = 0;

    virtual bool supportsMessageQueues() const = 0;

    virtual void linkToDeath(android::sp<android::hardware::hidl_death_recipient> deathRecipient,
                             uint64_t cookie) = 0;

    virtual Return<void> getSensorsList(
            ::android::hardware::sensors::V2_1::ISensors::getSensorsList_2_1_cb _hidl_cb) = 0;

    virtual Return<Result> setOperationMode(OperationMode mode) = 0;

    virtual Return<Result> activate(int32_t sensorHandle, bool enabled) = 0;

    virtual Return<Result> batch(int32_t sensorHandle, int64_t samplingPeriodNs,
                                 int64_t maxReportLatencyNs) = 0;

    virtual Return<Result> flush(int32_t sensorHandle) = 0;

    virtual EventMessageQueueWrapperBase& getEventQueue() = 0;
    virtual Return<void> getSensorsList(V2_1::ISensors::getSensorsList_2_1_cb _hidl_cb) = 0;
    virtual Return<Result> injectSensorData(const V2_1::Event& event) = 0;
    virtual Return<Result> initialize(
            const ::android::hardware::MQDescriptorSync<uint32_t>& wakeLockDescriptor,
            const sp<V2_1::ISensorsCallback>& sensorsCallback) = 0;
    virtual Return<Result> injectSensorData(const Event& event) = 0;

    virtual Return<void> registerDirectChannel(const SharedMemInfo& mem,
                                               ISensors::registerDirectChannel_cb _hidl_cb) = 0;

    virtual Return<Result> unregisterDirectChannel(int32_t channelHandle) = 0;

    virtual Return<void> configDirectReport(int32_t sensorHandle, int32_t channelHandle,
                                            RateLevel rate,
                                            ISensors::configDirectReport_cb _hidl_cb) = 0;

    virtual Return<void> poll(int32_t /* maxCount */, ISensors::poll_cb /* _hidl_cb */) {
        // Enforce this method is never invoked as it should be overridden if it's meant to be used.
        assert(false);
        return Return<void>();
    }

    virtual EventMessageQueueWrapperBase* getEventQueue() { return nullptr; }

    virtual Return<Result> initialize(const MQDescriptorSync<uint32_t>& /* wakeLockDesc */,
                                      const ::android::sp<ISensorsCallback>& /* callback */) {
        // Enforce this method is never invoked as it should be overridden if it's meant to be used.
        assert(false);
        return Result::INVALID_OPERATION;
    }
};

template <typename T>
class SensorsWrapperBase : public ISensorsWrapperBase {
  public:
    SensorsWrapperBase(sp<T> sensors) : mSensors(sensors){};

    // V2_0::ISensors implementation
    void linkToDeath(android::sp<android::hardware::hidl_death_recipient> deathRecipient,
                     uint64_t cookie) {
        getSensors()->linkToDeath(deathRecipient, cookie);
                     uint64_t cookie) override {
        mSensors->linkToDeath(deathRecipient, cookie);
    }

    virtual Return<void> getSensorsList(
            ::android::hardware::sensors::V2_1::ISensors::getSensorsList_2_1_cb _hidl_cb) override {
        return mSensors->getSensorsList(
                [&](const auto& list) { _hidl_cb(convertToNewSensorInfos(list)); });
    }

    Return<Result> activate(int32_t sensorHandle, bool enabled) {
        return getSensors()->activate(sensorHandle, enabled);
    Return<Result> setOperationMode(OperationMode mode) override {
        return mSensors->setOperationMode(mode);
    }

    Return<Result> activate(int32_t sensorHandle, bool enabled) override {
        return mSensors->activate(sensorHandle, enabled);
    }

    Return<Result> batch(int32_t sensorHandle, int64_t samplingPeriodNs,
                         int64_t maxReportLatencyNs) {
        return getSensors()->batch(sensorHandle, samplingPeriodNs, maxReportLatencyNs);
                         int64_t maxReportLatencyNs) override {
        return mSensors->batch(sensorHandle, samplingPeriodNs, maxReportLatencyNs);
    }

    Return<Result> flush(int32_t sensorHandle) { return getSensors()->flush(sensorHandle); }
    Return<Result> flush(int32_t sensorHandle) override { return mSensors->flush(sensorHandle); }

    virtual Return<Result> injectSensorData(const Event& event) override {
        return mSensors->injectSensorData(convertToOldEvent(event));
    }

    Return<void> registerDirectChannel(const SharedMemInfo& mem,
                                       V2_0::ISensors::registerDirectChannel_cb _hidl_cb) {
        return getSensors()->registerDirectChannel(mem, _hidl_cb);
                                       ISensors::registerDirectChannel_cb _hidl_cb) override {
        return mSensors->registerDirectChannel(mem, _hidl_cb);
    }

    Return<Result> unregisterDirectChannel(int32_t channelHandle) {
        return getSensors()->unregisterDirectChannel(channelHandle);
    Return<Result> unregisterDirectChannel(int32_t channelHandle) override {
        return mSensors->unregisterDirectChannel(channelHandle);
    }

    Return<void> configDirectReport(int32_t sensorHandle, int32_t channelHandle, RateLevel rate,
                                    V2_0::ISensors::configDirectReport_cb _hidl_cb) {
        return getSensors()->configDirectReport(sensorHandle, channelHandle, rate, _hidl_cb);
                                    ISensors::configDirectReport_cb _hidl_cb) override {
        return mSensors->configDirectReport(sensorHandle, channelHandle, rate, _hidl_cb);
    }

    Return<Result> setOperationMode(OperationMode mode) {
        return getSensors()->setOperationMode(mode);
    }
  protected:
    sp<T> mSensors;
};

  private:
    virtual V2_0::ISensors* getSensors() = 0;
class ISensorsWrapperV1_0 : public SensorsWrapperBase<hardware::sensors::V1_0::ISensors> {
  public:
    ISensorsWrapperV1_0(sp<hardware::sensors::V1_0::ISensors> sensors)
        : SensorsWrapperBase(sensors){};

    bool supportsPolling() const override { return true; }

    bool supportsMessageQueues() const override { return false; }

    Return<void> poll(int32_t maxCount,
                      hardware::sensors::V1_0::ISensors::poll_cb _hidl_cb) override {
        return mSensors->poll(maxCount, _hidl_cb);
    }
};

class ISensorsWrapperV2_0 : public ISensorsWrapperBase {
class ISensorsWrapperV2_0 : public SensorsWrapperBase<hardware::sensors::V2_0::ISensors> {
  public:
    typedef MessageQueue<V1_0::Event, ::android::hardware::kSynchronizedReadWrite>
    typedef MessageQueue<::android::hardware::sensors::V1_0::Event,
                         ::android::hardware::kSynchronizedReadWrite>
            EventMessageQueue;

    ISensorsWrapperV2_0(sp<V2_0::ISensors>& sensors) : mSensors(sensors) {
    ISensorsWrapperV2_0(sp<hardware::sensors::V2_0::ISensors> sensors)
        : SensorsWrapperBase(sensors) {
        auto eventQueue = std::make_unique<EventMessageQueue>(MAX_RECEIVE_BUFFER_EVENT_COUNT,
                                                              true /* configureEventFlagWord */);
        mEventQueue = std::make_unique<EventMessageQueueWrapperV1_0>(eventQueue);
    }
    };

    EventMessageQueueWrapperBase& getEventQueue() override { return *mEventQueue; }
    bool supportsPolling() const override { return false; }

    Return<Result> initialize(
            const ::android::hardware::MQDescriptorSync<uint32_t>& wakeLockDescriptor,
            const sp<V2_1::ISensorsCallback>& sensorsCallback) override {
        return mSensors->initialize(*mEventQueue->getDesc(), wakeLockDescriptor, sensorsCallback);
    }
    bool supportsMessageQueues() const override { return true; }

    Return<void> getSensorsList(V2_1::ISensors::getSensorsList_2_1_cb _hidl_cb) override {
        return getSensors()->getSensorsList(
                [&](const auto& list) { _hidl_cb(convertToNewSensorInfos(list)); });
    }
    EventMessageQueueWrapperBase* getEventQueue() override { return mEventQueue.get(); }

    Return<Result> injectSensorData(const V2_1::Event& event) override {
        return mSensors->injectSensorData(convertToOldEvent(event));
    Return<Result> initialize(const MQDescriptorSync<uint32_t>& wakeLockDesc,
                              const ::android::sp<ISensorsCallback>& callback) override {
        return mSensors->initialize(*mEventQueue->getDesc(), wakeLockDesc, callback);
    }

  private:
    V2_0::ISensors* getSensors() override { return mSensors.get(); }

    sp<V2_0::ISensors> mSensors;
    std::unique_ptr<EventMessageQueueWrapperV1_0> mEventQueue;
};

class ISensorsWrapperV2_1 : public ISensorsWrapperBase {
class ISensorsWrapperV2_1 : public SensorsWrapperBase<hardware::sensors::V2_1::ISensors> {
  public:
    typedef MessageQueue<V2_1::Event, ::android::hardware::kSynchronizedReadWrite>
            EventMessageQueue;
    typedef MessageQueue<Event, ::android::hardware::kSynchronizedReadWrite> EventMessageQueueV2_1;

    ISensorsWrapperV2_1(sp<V2_1::ISensors>& sensors) : mSensors(sensors) {
        auto eventQueue = std::make_unique<EventMessageQueue>(MAX_RECEIVE_BUFFER_EVENT_COUNT,
                                                              true /* configureEventFlagWord */);
    ISensorsWrapperV2_1(sp<hardware::sensors::V2_1::ISensors> sensors)
        : SensorsWrapperBase(sensors) {
        auto eventQueue = std::make_unique<EventMessageQueueV2_1>(
                MAX_RECEIVE_BUFFER_EVENT_COUNT, true /* configureEventFlagWord */);
        mEventQueue = std::make_unique<EventMessageQueueWrapperV2_1>(eventQueue);
    }
    };

    EventMessageQueueWrapperBase& getEventQueue() override { return *mEventQueue; }
    bool supportsPolling() const override { return false; }

    Return<Result> initialize(
            const ::android::hardware::MQDescriptorSync<uint32_t>& wakeLockDescriptor,
            const sp<V2_1::ISensorsCallback>& sensorsCallback) override {
        return mSensors->initialize_2_1(*mEventQueue->getDesc(), wakeLockDescriptor,
                                        sensorsCallback);
    }
    bool supportsMessageQueues() const override { return true; }

    EventMessageQueueWrapperBase* getEventQueue() override { return mEventQueue.get(); }

    Return<void> getSensorsList(V2_1::ISensors::getSensorsList_2_1_cb _hidl_cb) override {
    Return<void> getSensorsList(
            ::android::hardware::sensors::V2_1::ISensors::getSensorsList_2_1_cb _hidl_cb) override {
        return mSensors->getSensorsList_2_1(_hidl_cb);
    }

    Return<Result> injectSensorData(const V2_1::Event& event) override {
    Return<Result> injectSensorData(const Event& event) override {
        return mSensors->injectSensorData_2_1(event);
    }

  private:
    V2_0::ISensors* getSensors() override { return mSensors.get(); }
    Return<Result> initialize(const MQDescriptorSync<uint32_t>& wakeLockDesc,
                              const ::android::sp<ISensorsCallback>& callback) override {
        return mSensors->initialize_2_1(*mEventQueue->getDesc(), wakeLockDesc, callback);
    }

    sp<V2_1::ISensors> mSensors;
  private:
    std::unique_ptr<EventMessageQueueWrapperV2_1> mEventQueue;
};

+4 −4
Original line number Diff line number Diff line
@@ -67,7 +67,7 @@ bool SensorsHidlEnvironmentV2_X::resetHal() {
        }

        EventFlag::deleteEventFlag(&mEventQueueFlag);
        EventFlag::createEventFlag(mSensors->getEventQueue().getEventFlagWord(), &mEventQueueFlag);
        EventFlag::createEventFlag(mSensors->getEventQueue()->getEventFlagWord(), &mEventQueueFlag);
        if (mEventQueueFlag == nullptr) {
            break;
        }
@@ -124,18 +124,18 @@ void SensorsHidlEnvironmentV2_X::startPollingThread() {
}

void SensorsHidlEnvironmentV2_X::readEvents() {
    size_t availableEvents = mSensors->getEventQueue().availableToRead();
    size_t availableEvents = mSensors->getEventQueue()->availableToRead();

    if (availableEvents == 0) {
        uint32_t eventFlagState = 0;

        mEventQueueFlag->wait(asBaseType(EventQueueFlagBits::READ_AND_PROCESS), &eventFlagState);
        availableEvents = mSensors->getEventQueue().availableToRead();
        availableEvents = mSensors->getEventQueue()->availableToRead();
    }

    size_t eventsToRead = std::min(availableEvents, mEventBuffer.size());
    if (eventsToRead > 0) {
        if (mSensors->getEventQueue().read(mEventBuffer.data(), eventsToRead)) {
        if (mSensors->getEventQueue()->read(mEventBuffer.data(), eventsToRead)) {
            mEventQueueFlag->wake(asBaseType(EventQueueFlagBits::EVENTS_READ));
            for (size_t i = 0; i < eventsToRead; i++) {
                addEvent(mEventBuffer[i]);