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

Commit 5659ad20 authored by TreeHugger Robot's avatar TreeHugger Robot Committed by Android (Google) Code Review
Browse files

Merge "Prep ISensorsWrapper to be used by the framework"

parents dd0c0f71 32895908
Loading
Loading
Loading
Loading
+158 −85
Original line number Original line Diff line number Diff line
@@ -18,23 +18,19 @@
#define ANDROID_HARDWARE_SENSORS_V2_1_ISENSORSWRAPPER_H
#define ANDROID_HARDWARE_SENSORS_V2_1_ISENSORSWRAPPER_H


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


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


#include <atomic>
#include <utils/LightRefBase.h>


/**
#include <cassert>
 * 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.
 */


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


using ::android::sp;
using ::android::hardware::MessageQueue;
using ::android::hardware::MQDescriptorSync;
using ::android::hardware::Return;
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::OperationMode;
using ::android::hardware::sensors::V1_0::RateLevel;
using ::android::hardware::sensors::V1_0::RateLevel;
using ::android::hardware::sensors::V1_0::Result;
using ::android::hardware::sensors::V1_0::Result;
using ::android::hardware::sensors::V1_0::SharedMemInfo;
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
// TODO: Look into providing this as a param if it needs to be a different value
// than the framework.
// than the framework.
static constexpr size_t MAX_RECEIVE_BUFFER_EVENT_COUNT = 256;
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:
  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<Result> injectSensorData(const Event& event) = 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<void> registerDirectChannel(const SharedMemInfo& mem,
    virtual Return<Result> initialize(
                                               ISensors::registerDirectChannel_cb _hidl_cb) = 0;
            const ::android::hardware::MQDescriptorSync<uint32_t>& wakeLockDescriptor,

            const sp<V2_1::ISensorsCallback>& sensorsCallback) = 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,
    void linkToDeath(android::sp<android::hardware::hidl_death_recipient> deathRecipient,
                     uint64_t cookie) {
                     uint64_t cookie) override {
        getSensors()->linkToDeath(deathRecipient, cookie);
        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<Result> setOperationMode(OperationMode mode) override {
        return getSensors()->activate(sensorHandle, enabled);
        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,
    Return<Result> batch(int32_t sensorHandle, int64_t samplingPeriodNs,
                         int64_t maxReportLatencyNs) {
                         int64_t maxReportLatencyNs) override {
        return getSensors()->batch(sensorHandle, samplingPeriodNs, maxReportLatencyNs);
        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,
    Return<void> registerDirectChannel(const SharedMemInfo& mem,
                                       V2_0::ISensors::registerDirectChannel_cb _hidl_cb) {
                                       ISensors::registerDirectChannel_cb _hidl_cb) override {
        return getSensors()->registerDirectChannel(mem, _hidl_cb);
        return mSensors->registerDirectChannel(mem, _hidl_cb);
    }
    }


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


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


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


  private:
class ISensorsWrapperV1_0 : public SensorsWrapperBase<hardware::sensors::V1_0::ISensors> {
    virtual V2_0::ISensors* getSensors() = 0;
  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:
  public:
    typedef MessageQueue<V1_0::Event, ::android::hardware::kSynchronizedReadWrite>
    typedef MessageQueue<::android::hardware::sensors::V1_0::Event,
                         ::android::hardware::kSynchronizedReadWrite>
            EventMessageQueue;
            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,
        auto eventQueue = std::make_unique<EventMessageQueue>(MAX_RECEIVE_BUFFER_EVENT_COUNT,
                                                              true /* configureEventFlagWord */);
                                                              true /* configureEventFlagWord */);
        mEventQueue = std::make_unique<EventMessageQueueWrapperV1_0>(eventQueue);
        mEventQueue = std::make_unique<EventMessageQueueWrapperV1_0>(eventQueue);
    }
    };


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


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


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


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


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

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


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


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


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


    Return<Result> initialize(
    bool supportsMessageQueues() const override { return true; }
            const ::android::hardware::MQDescriptorSync<uint32_t>& wakeLockDescriptor,

            const sp<V2_1::ISensorsCallback>& sensorsCallback) override {
    EventMessageQueueWrapperBase* getEventQueue() override { return mEventQueue.get(); }
        return mSensors->initialize_2_1(*mEventQueue->getDesc(), wakeLockDescriptor,
                                        sensorsCallback);
    }


    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 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);
        return mSensors->injectSensorData_2_1(event);
    }
    }


  private:
    Return<Result> initialize(const MQDescriptorSync<uint32_t>& wakeLockDesc,
    V2_0::ISensors* getSensors() override { return mSensors.get(); }
                              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;
    std::unique_ptr<EventMessageQueueWrapperV2_1> mEventQueue;
};
};


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


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


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


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


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


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