SensorPlatform.hpp

Go to the documentation of this file.

 
#pragma once
 
#if defined(ARDUINO)
#include "platform/arduino/SensorCommArduino_HW.hpp"
#include "platform/arduino/SensorCommArduino_I2C.hpp"
#include "platform/arduino/SensorCommArduino_SPI.hpp"
#include "platform/arduino/StreamArduinoAdapter.hpp"
#elif !defined(ARDUINO)  && defined(ESP_PLATFORM)
#include "platform/espidf/SensorCommEspIDF_HW.hpp"
#include "platform/espidf/SensorCommEspIDF_I2C.hpp"
#include "platform/espidf/SensorCommEspIDF_SPI.hpp"
#endif
#include "platform/SensorCommCustom.hpp"
#include "platform/SensorCommCustomHal.hpp"
#include "platform/SensorCommStatic.hpp"
#include <assert.h>
 
enum CommInterface {
    COMM_CUSTOM = 0,
    COMM_SPI = 1,
    COMM_I2C = 2
};
 
template<typename CommType, typename HalType, typename... Args>
bool beginCommonStatic(
    std::unique_ptr<SensorCommBase> &comm,
    std::unique_ptr<SensorCommStatic> &staticComm,
    std::unique_ptr<SensorHal> &hal,
    Args &&... args)
{
    hal = std::make_unique<HalType>();
    if (!hal) {
        return false;
    }
    comm = std::make_unique<CommType>(std::forward<Args>(args)..., hal.get());
    if (!comm) {
        hal.reset();
        return false;
    }
    if (!comm->init()) {
        return false;
    }
    staticComm = std::make_unique<SensorCommStatic>(comm.get(), hal.get());
    if (!staticComm) {
        return false;
    }
    return true;
}
 
template<typename CommType, typename HalType, typename... Args>
bool beginCommon(
    std::unique_ptr<SensorCommBase> &comm,
    std::unique_ptr<SensorHal> &hal,
    Args &&... args)
{
    hal = std::make_unique<HalType>();
    if (!hal) {
        return false;
    }
    comm = std::make_unique<CommType>(std::forward<Args>(args)..., hal.get());
    if (!comm) {
        hal.reset();
        return false;
    }
    return comm->init();
}
 
template <typename CommType, typename HalType>
bool beginCommCustomCallback(CommInterface interface,
                             typename CommType::CustomCallback callback,
                             typename HalType::CustomHalCallback hal_callback,
                             uint8_t addr,
                             std::unique_ptr<SensorCommBase> &comm,
                             std::unique_ptr<SensorHal> &hal)
{
    hal = std::make_unique<HalType>(hal_callback);
    if (!hal) {
        return false;
    }
    comm = std::make_unique<CommType>(callback, addr);
    if (!comm) {
        return false;
    }
    return comm->init();
}
 
inline void addrToBeBuf(uint32_t addr, uint8_t buf[4])
{
    buf[0] = (addr >> 24) & 0xFF;
    buf[1] = (addr >> 16) & 0xFF;
    buf[2] = (addr >> 8) & 0xFF;
    buf[3] = addr & 0xFF;
}
 
inline void addrToBeBuf(uint16_t addr, uint8_t buf[2])
{
    buf[0] = (addr >> 8) & 0xFF;
    buf[1] = addr & 0xFF;
}