#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, SUS_0 };

  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[6] = {};

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

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

  /* ACS board specific variables */
#ifdef RASPBERRY_PI
  uint8_t mgm0Lis3mdlChipSelect = gpio::MGM_0_BCM_PIN;
  uint8_t mgm1Rm3100ChipSelect = gpio::MGM_1_BCM_PIN;
  uint8_t mgm2Lis3mdlChipSelect = gpio::MGM_2_BCM_PIN;
  uint8_t mgm3Rm3100ChipSelect = gpio::MGM_3_BCM_PIN;

  uint8_t gyro0AdisChipSelect = gpio::GYRO_0_BCM_PIN;
  uint8_t gyro1L3gd20ChipSelect = gpio::GYRO_1_BCM_PIN;
  uint8_t gyro2AdisChipSelect = gpio::GYRO_2_BCM_PIN;
  uint8_t gyro3L3gd20ChipSelect = gpio::GYRO_3_BCM_PIN;
#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_ */