#ifndef SERIAL_CAN_MUX_HPP_
#define SERIAL_CAN_MUX_HPP_

#include <ch.hpp>

#define OFFSET_TIME_RESET_MS                2000
#define INPUT_BL_RESET_ADDITIONAL_BYTES     0
#define INPUT_BL_RESET_LENGTH               3

namespace amiro {

  class SerialCanMux : public chibios_rt::BaseSequentialStreamInterface {
  public:
    SerialCanMux(SerialDriver *_sd_, CANDriver *can, const uint8_t boardId);
    virtual ~SerialCanMux();

    void convCan2Serial(uint8_t *inputs, size_t n);
    void sendSwitchCmd(uint8_t setid);
    void rcvSwitchCmd(uint8_t setid);

    size_t write(const uint8_t *bp, size_t n);
    size_t read(uint8_t *bp, size_t n);
    msg_t put(uint8_t b);
    msg_t get(void);

  protected:

  private:
    /* Reset command. */
    const uint8_t inputBLReset[3] = {0x02, 0xFF, 0x00};
//    const uint8_t inputchshell[3] = {0x00, 0x68, 0x0D};
//    const uint8_t inputsh_board[8] = {0x73, 0x68, 0x5F, 0x62, 0x6F, 0x61, 0x72, 0x6C};

    void restartSystem(void);
    bool checkByteForBLReset(uint8_t *inputs, size_t size);
    msg_t sendViaCan(uint32_t id, uint8_t *inputs, size_t size);

    uint8_t inputAddBytes[INPUT_BL_RESET_ADDITIONAL_BYTES];    // Buffer for additional bytes.
    uint8_t resetStatus;      // Status of reset
    uint8_t resetAddBytes;    // Counter of additional bytes

    SerialDriver *sd_;
    CANDriver *canDriver;
    uint8_t myID;
    volatile uint8_t queryShellID;
    volatile uint8_t replyShellID;

    CANTxFrame txmsg;
    uint8_t inputChar[16] = {};
  };

} /* amiro */

#endif /* SERIAL_CAN_MUX_HPP_ */