#include "main.hpp"

#include <stddef.h>
#include <stdio.h>

#include "main.h"
#include "project.hpp"
//
#include "sdk/hal/zhal.hpp"
#include "sdk\components\iflytop_can_slave_v1\iflytop_can_slave.hpp"
#include "sdk\components\tmc\ic\ztmc4361A.hpp"
#include "sdk\components\tmc\ic\ztmc5130.hpp"

#define TAG "main"
namespace iflytop {
Main gmain;
};

using namespace iflytop;

IflytopCanProtocolStackProcesser m_protocolStack;

TMC5130 m_tj_motor;
TMC5130 m_py_motor;

// ZGPIO arm_sensor1_gpio;
// ZGPIO arm_sensor2_gpio;
// ZGPIO arm_sensor3_gpio;
// ZGPIO arm_sensor4_gpio;
// ZGPIO arm_sensor5_gpio;
// ZGPIO arm_sensor6_gpio;
// ZGPIO arm_sensor7_gpio;
// ZGPIO arm_sensor8_gpio;

ZGPIO debuglight;

ZGPIO tmc_motor1_spi_select1_io;
ZGPIO tmc_motor1_nfreeze_io;
ZGPIO tmc_motor1_nreset_io;
ZGPIO tmc_motor1_sub_ic_enn_io;
ZGPIO tmc_motor2_spi_select1_io;
ZGPIO tmc_motor2_nfreeze_io;
ZGPIO tmc_motor2_nreset_io;
ZGPIO tmc_motor2_sub_ic_enn_io;

void input_sensors_init() {
  // arm_sensor1_gpio.initAsInput(ARM_SENSOR1_GPIO, ZGPIO::kMode_nopull, ZGPIO::kIRQ_risingAndFallingIrq, true);
  // arm_sensor2_gpio.initAsInput(ARM_SENSOR2_GPIO, ZGPIO::kMode_nopull, ZGPIO::kIRQ_risingAndFallingIrq, true);
  // arm_sensor3_gpio.initAsInput(ARM_SENSOR3_GPIO, ZGPIO::kMode_nopull, ZGPIO::kIRQ_noIrq, false);
  // arm_sensor4_gpio.initAsInput(ARM_SENSOR4_GPIO, ZGPIO::kMode_nopull, ZGPIO::kIRQ_noIrq, false);
  // arm_sensor5_gpio.initAsInput(ARM_SENSOR5_GPIO, ZGPIO::kMode_nopull, ZGPIO::kIRQ_noIrq, false);
  // arm_sensor6_gpio.initAsInput(ARM_SENSOR6_GPIO, ZGPIO::kMode_nopull, ZGPIO::kIRQ_noIrq, false);
  // arm_sensor7_gpio.initAsInput(ARM_SENSOR7_GPIO, ZGPIO::kMode_nopull, ZGPIO::kIRQ_risingAndFallingIrq, true);
  // arm_sensor8_gpio.initAsInput(ARM_SENSOR8_GPIO, ZGPIO::kMode_nopull, ZGPIO::kIRQ_risingAndFallingIrq, true);
}
uint32_t intput_sensors_get_table0() {
  uint32_t val = 0;
  // val |= arm_sensor1_gpio.getStateUint32() << 1;
  // val |= arm_sensor2_gpio.getStateUint32() << 2;
  // val |= arm_sensor3_gpio.getStateUint32() << 3;
  // val |= arm_sensor4_gpio.getStateUint32() << 4;
  // val |= arm_sensor5_gpio.getStateUint32() << 5;
  // val |= arm_sensor6_gpio.getStateUint32() << 6;
  // val |= arm_sensor7_gpio.getStateUint32() << 7;
  // val |= arm_sensor8_gpio.getStateUint32() << 8;
  return val;
}

icps::error_t Main::onHostRegisterWriteEvent(IflytopCanProtocolStackProcesser *processer, icps::WriteEvent *event) { return icps::kSuccess; }
icps::error_t Main::onHostRegisterReadEvent(IflytopCanProtocolStackProcesser *processer, icps::ReadEvent *event) { return icps::kSuccess; }
void          Main::onHostRegisterReportEvent(IflytopCanProtocolStackProcesser *processer, icps::ReportEvent *event) {}

void Main::run() {
  ZHALCORE::cfg_t oscfg = {
      .delayhtim = &DELAY_US_TIMER,
      .debuguart = &DEBUG_UART,
  };
  ZHALCORE::getInstance()->initialize(oscfg);

  ZLOGI(TAG, "zapp:%s", VERSION);
  printf("int32_t %d int %d longint %d\n", sizeof(int32_t), sizeof(int), sizeof(long int));

  debuglight.initAsOutput(DEBUG_LIGHT_GPIO, ZGPIO::kMode_nopull, false, false);
  ZHAL_CORE_REG(200, { debuglight.toggleState(); });

  /*******************************************************************************
   *                               GPIO输入初始化                                *
   *******************************************************************************/
  input_sensors_init();
  intput_sensors_get_table0();

  /*******************************************************************************
   *                                 电机初始化                                  *
   *******************************************************************************/
  {
    TMC5130::cfg_t cfg = {.hspi = &MOTOR_SPI, .enn_pin = MOTOR0_ENN, .csn_pin = MOTOR0_CSN};

    m_py_motor.initialize(&cfg);
    int32_t chipv = m_py_motor.readChipVERSION();
    ZLOGI(TAG, "m_py_motor:%lx", chipv);
  }

  {
    TMC5130::cfg_t cfg = {.hspi = &MOTOR_SPI, .enn_pin = MOTOR1_ENN, .csn_pin = MOTOR1_CSN};

    m_tj_motor.initialize(&cfg);
    int32_t chipv = m_tj_motor.readChipVERSION();
    ZLOGI(TAG, "m_tj_motor:%lx", chipv);
  }

  /*******************************************************************************
   *                                扫码枪初始化                                 *
   *******************************************************************************/
  {
      // static ZUART uart;
      // PB6.initAsOutput(STM32_GPIO::kOutput_nopull, true, false);
      // ZUART::cfg_t cfg = {
      //     .name          = "CODE_SCANER_UART",
      //     .huart         = &CODE_SCANER_UART,
      //     .rxbuffersize  = 300,
      //     .rxovertime_ms = 10,
      // };
      // uart.initialize(&cfg,[](){})
      //     uart.initialize_basic("CODE_SCANER_UART", &m_hardware, &CODE_SCANER_UART);
      // uart.initialize_setRxBuffer(300);
      // uart.initialize_setRxOvertime(33);
      // uart.initialize_finished();
  }

  /*******************************************************************************
   *                                协议栈初始化                                 *
   *******************************************************************************/
  {
    auto *cfg = IflytopCanProtocolStackProcesser::createDefaultConfig(DEVICE_ID, 128);
    m_protocolStack.initialize(cfg);
    m_protocolStack.setDumpPacketFlag(false);
    m_protocolStack.registerListener(this);
    m_protocolStack.activeReg(REG_GPIO_INPUT0, icps::kwr, 0);
  }

  while (1) {
    ZHALCORE::getInstance()->loop();
  }
}