#ifndef LINUX_BOARDTEST_SPITESTCLASS_H_
#define LINUX_BOARDTEST_SPITESTCLASS_H_

#include "OBSWConfig.h"

#if defined(XIPHOS_Q7S)
#include "busConf.h"
#endif

#include <fsfw_hal/common/gpio/GpioIF.h>
#include <fsfw_hal/linux/spi/SpiCookie.h>
#include <test/testtasks/TestTask.h>

#include <vector>

class SpiTestClass: public TestTask {
public:
    enum TestModes {
        NONE,
        MGM_LIS3MDL,
        MGM_RM3100,
        GYRO_L3GD20H,
    };

    TestModes testMode;

    SpiTestClass(object_id_t objectId, GpioIF* gpioIF);

    ReturnValue_t performOneShotAction() override;
    ReturnValue_t performPeriodicAction() override;
private:

    GpioIF* gpioIF;

    std::array<uint8_t, 128> recvBuffer;
    std::array<uint8_t, 128> sendBuffer;
    struct spi_ioc_transfer spiTransferStruct = {};

    void performRm3100Test(uint8_t mgmId);
    void performLis3MdlTest(uint8_t lis3Id);
    void performL3gTest(uint8_t l3gId);

    /* ACS board specific code which pulls all GPIOs high */
    void acsInit();

    /* ACS board specific variables */
#ifdef RASPBERRY_PI
    uint8_t mgm0Lis3mdlChipSelect = 0;
    uint8_t mgm1Rm3100ChipSelect = 1;
    uint8_t gyro0AdisChipSelect = 5;
    uint8_t gyro1L3gd20ChipSelect = 6;
    uint8_t gyro2L3gd20ChipSelect = 4;
    uint8_t mgm2Lis3mdlChipSelect = 17;
    uint8_t mgm3Rm3100ChipSelect = 27;
#elif defined(XIPHOS_Q7S)
    uint8_t mgm0Lis3mdlChipSelect = q7s::GPIO_MGM_0_LIS3_CS;
    uint8_t mgm1Rm3100ChipSelect = q7s::GPIO_MGM_1_RM3100_CS;
    uint8_t gyro0AdisChipSelect = q7s::GPIO_GYRO_0_ADIS_CS;
    uint8_t gyro2AdisChipSelect = q7s::GPIO_GYRO_2_ADIS_CS;
    uint8_t gyro1L3gd20ChipSelect = q7s::GPIO_GYRO_1_L3G_CS;
    uint8_t gyro3L3gd20ChipSelect = q7s::GPIO_GYRO_3_L3G_CS;
    uint8_t mgm2Lis3mdlChipSelect = q7s::GPIO_MGM_2_LIS3_CS;
    uint8_t mgm3Rm3100ChipSelect = q7s::GPIO_MGM_3_RM3100_CS;
#else
    uint8_t mgm0Lis3mdlChipSelect = 0;
    uint8_t mgm1Rm3100ChipSelect = 0;
    uint8_t gyro0AdisResetLine = 0;
    uint8_t gyro0AdisChipSelect = 0;
    uint8_t gyro1L3gd20ChipSelect = 0;
    uint8_t gyro2L3gd20ChipSelect = 0;
    uint8_t mgm2Lis3mdlChipSelect = 0;
    uint8_t mgm3Rm3100ChipSelect = 0;
#endif

    static constexpr uint8_t STM_READ_MASK = 0b1000'0000;
    static constexpr uint8_t RM3100_READ_MASK = STM_READ_MASK;
    static constexpr uint8_t STM_AUTO_INCR_MASK = 0b0100'0000;

    void setSpiSpeedAndMode(int spiFd, spi::SpiModes mode, uint32_t speed);

    void writeStmRegister(int fd, gpioId_t chipSelect, uint8_t reg, uint8_t value,
            bool autoIncrement);
    void writeMultipleStmRegisters(int fd, gpioId_t chipSelect, uint8_t reg, uint8_t* values,
            size_t len);
    void writeMultipleRegisters(int fd, gpioId_t chipSelect, uint8_t reg, uint8_t *values,
            size_t len);
    void writeRegister(int fd, gpioId_t chipSelect, uint8_t reg, uint8_t value);

    uint8_t readRm3100Register(int fd, gpioId_t chipSelect, uint8_t reg);
    uint8_t readStmRegister(int fd, gpioId_t chipSelect, uint8_t reg, bool autoIncrement);
    uint8_t readRegister(int fd, gpioId_t chipSelect, uint8_t reg);
    void readMultipleStmRegisters(int fd, gpioId_t chipSelect, uint8_t reg, uint8_t *reply,
            size_t len);
    void readMultipleRegisters(int fd, gpioId_t chipSelect, uint8_t reg,
            uint8_t* reply, size_t len);

};




#endif /* LINUX_BOARDTEST_SPITESTCLASS_H_ */