SensorCommCustom.hpp

Go to the documentation of this file.

 
#pragma once
 
#include "SensorCommBase.hpp"
 
class SensorCommCustom : public SensorCommBase
{
public:
    using CustomCallback = bool(*)(uint8_t addr, uint8_t reg, uint8_t *buf, size_t len, bool writeReg, bool isWrite);
 
    SensorCommCustom(CustomCallback callback, uint8_t addr) : customCallback(callback), addr(addr) {}
 
    bool init() override
    {
        return true;
    }
 
    void deinit() override {}
 
    int writeRegister(const uint8_t reg, uint8_t *buf, size_t len) override
    {
        if (customCallback(addr, reg, buf, len, true, true)) {
            return 0;
        } else {
            return -1;
        }
    }
 
    int writeBuffer(uint8_t *buffer, size_t len)
    {
        if (customCallback(addr, 0x00, buffer, len, false, true)) {
            return 0;
        } else {
            return -1;
        }
    }
 
    int readBuffer(uint8_t *buf, size_t len) override
    {
        if (customCallback(addr, 0x00, buf, len, false, false)) {
            return 0;
        } else {
            return -1;
        }
    }
 
    int readRegister(const uint8_t reg, uint8_t *buf, size_t len) override
    {
        if (customCallback(addr, reg, buf, len, true, false)) {
            return 0;
        } else {
            return -1;
        }
    }
 
    int writeThenRead(const uint8_t *write_buffer, size_t write_len, uint8_t *read_buffer, size_t read_len) override
    {
        writeBuffer((uint8_t *)write_buffer, write_len);
        if (customCallback(addr, 0x00, read_buffer, read_len, false, false)) {
            return 0;
        } else {
            return -1;
        }
    }
 
    void setParams(const CommParamsBase &params) override
    {
#if defined(__cpp_rtti)
        const auto pdat = dynamic_cast<const I2CParam *>(&params);
#else
        const auto pdat = static_cast<const I2CParam *>(&params);
#endif
        uint8_t type = pdat->getType();
        switch (type) {
        case I2CParam::I2C_SET_ADDR:
            addr = pdat->getParams();
            break;
        case I2CParam::I2C_SET_FLAG:
            // TODO:
            // sendStopFlag = pdat->getParams();
            break;
        default:
            break;
        }
    }
private:
    CustomCallback customCallback;
    uint8_t addr;
};