SensorCommCustomHal.hpp

Go to the documentation of this file.

 
#pragma once
 
#include "SensorCommBase.hpp"
 
class SensorCommCustomHal : public SensorHal
{
public:
    enum Operation {
        OP_PINMODE,
        OP_DIGITALWRITE,
        OP_DIGITALREAD,
        OP_MILLIS,
        OP_DELAY,
        OP_DELAYMICROSECONDS,
    };
 
    using CustomHalCallback = uint32_t (*)(Operation op, void *param1, void *param2);
 
    SensorCommCustomHal(CustomHalCallback callback) : halCallback(callback) {}
 
    void pinMode(uint8_t pin, uint8_t mode) override
    {
        if (modeCallback) {
            modeCallback(pin, mode);
        } else if (halCallback) {
            halCallback(OP_PINMODE, reinterpret_cast<void *>(pin), reinterpret_cast<void *>(mode));
        }
    }
 
    void digitalWrite(uint8_t pin, uint8_t level) override
    {
        if (writeCallback) {
            writeCallback(pin, level);
        } else if (halCallback) {
            halCallback(OP_DIGITALWRITE, reinterpret_cast<void *>(pin), reinterpret_cast<void *>(level));
        }
    }
 
    uint8_t digitalRead(uint8_t pin) override
    {
        if (readCallback) {
            return readCallback(pin);
        } else if (halCallback) {
            return halCallback(OP_DIGITALREAD, reinterpret_cast<void *>(pin), nullptr);
        }
        return 0;
    }
 
    uint32_t millis()override
    {
        if (halCallback) {
            return halCallback(OP_MILLIS, nullptr, nullptr);
        }
        return 0;
    }
 
    void delay(uint32_t ms) override
    {
        if (halCallback) {
            halCallback(OP_DELAY, reinterpret_cast<void *>(ms), nullptr);
        }
    }
 
    void delayMicroseconds(uint32_t us)override
    {
        if (halCallback) {
            halCallback(OP_DELAYMICROSECONDS, reinterpret_cast<void *>(us), nullptr);
        }
    }
private:
    CustomHalCallback halCallback;
};