#include "board.h"

__attribute__((weak))
SYS_HSE_BypassTypeDef board_hse_source(void)
{
#ifdef BOARD_HSE_BYPASS
  return BOARD_HSE_BYPASS;
#else
  return SYS_HSE_BYPASS_OFF;
#endif
}

__attribute__((weak))
RTC_ClkSourceTypeDef board_rtc_source(void)
{
#ifdef BOARD_RTC_SOURCE
  return BOARD_RTC_SOURCE;
#else
  return RTC_CLK_SOURCE_LSE;
#endif
}

uint32_t board_lse_freq(void)
{
#ifdef BOARD_LSE_FREQ
  return BOARD_LSE_FREQ;
#else
  return 32768;
#endif
}

uint32_t board_pll_clkin_freq(void)
{
#ifdef BOARD_PLL_CLKIN_FREQ
  return BOARD_PLL_CLKIN_FREQ;
#else
  return SYS_GetHSEFreq();
#endif
}

MAC_MediaInterfaceTypeDef board_mac_media(void)
{
#ifdef BOARD_MAC_MEDIA_INTERFACE
  return BOARD_MAC_MEDIA_INTERFACE;
#else
  return MAC_MEDIA_INTERFACE_RMII;
#endif
}

uint8_t board_mac_phy_addr(void)
{
  // PHY address depends on how it is physically configured on board
  return 3;
}

#define RMII_CLK_DIR 0 // REF_CLK direction in RMII mode, 0: PHY to MAC, 1: MAC to PHY
void board_init_mac(void)
{
}

void board_init_phy(MAC_HandleTypeDef *hmac)
{
  // RMII mode setting and clk direction. This can override the mode decided by RX_DV at power on
  MAC_MdioWrite(hmac, MAC_PHY_REG_PAGE, 7);
  uint16_t mdio = MAC_MdioRead(hmac, MAC_PHY_REG_RMSR);
  MODIFY_REG(mdio, MAC_PHY_RMSR_RMII_MODE, (hmac->Init.MediaInterface == MAC_MEDIA_INTERFACE_RMII) << MAC_PHY_RMSR_RMII_OFFSET);
  MODIFY_REG(mdio, MAC_PHY_RMSR_RMII_CLKDIR, RMII_CLK_DIR == 0 ? MAC_PHY_RMSR_RMII_CLK_OUT : MAC_PHY_RMSR_RMII_CLK_IN);
  MAC_MdioWrite(hmac, MAC_PHY_REG_RMSR, mdio);
  // Enable INTB for link change
  mdio = MAC_MdioRead(hmac, MAC_PHY_REG_IWL);
  MAC_MdioWrite(hmac, MAC_PHY_REG_IWL, mdio | MAC_PHY_IWL_INT_LINKCHG);
  MAC_MdioWrite(hmac, MAC_PHY_REG_PAGE, 0);

  dbg_printf("Mac media:     %s\n",         hmac->Init.MediaInterface == MAC_MEDIA_INTERFACE_MII ? "MII" : "RMII");
  dbg_printf("Mac macaddr:   0x%02x%04x\n", MAC0->MACMSB, MAC0->MACLSB);
  dbg_printf("Mac phyaddr:   0x%x\n",       hmac->Init.PhyAddress);
  dbg_printf("Mac autoneg:   0x%x\n",       hmac->Init.AutoNegotiation);
  dbg_printf("Mac interface: 0x%x\n",       hmac->Init.MediaInterface);
  dbg_printf("Mac loopback:  0x%x\n",       hmac->Init.LoopbackMode);
  dbg_printf("Mac mdcscaler: 0x%x\n",       hmac->Init.MdcScaler);
  dbg_printf("Mac duplex:    0x%x\n",       hmac->Init.DuplexMode);
  dbg_printf("Mac speed:     0x%x\n",       hmac->Init.Speed);
  uint16_t mac_phy_stat = MAC_MdioRead(hmac, MAC_PHY_REG_STAT);
  dbg_printf("Mac phy autoneg done: %s, link status: %s\n",
              mac_phy_stat & MAC_PHY_STAT_AUTONEG_DONE ? "yes" : "no",
              mac_phy_stat & MAC_PHY_STAT_LINK_STATUS  ? "yes" : "no");
}

__attribute__((weak)) uint32_t FCB_GetPLLFreq(uint32_t clkin_freq);
__attribute__((weak)) void board_init(void)
{
  PERIPHERAL_ENABLE(DMAC, 0);
  DMAC_Init();

#ifdef AGM_LOGIC_EMBED_INC
  static __attribute__((section(".flash.logic"))) __attribute__((aligned(4))) const uint8_t logic_config[] = {
#include AGM_LOGIC_EMBED_INC
  };
  PERIPHERAL_ENABLE(FCB, 0);
  if (sizeof(logic_config) < FCB_AUTO_WORDS * 4) {
    FCB_AutoDecompress((uint32_t)logic_config);
  } else {
    FCB_AutoConfigDma((uint32_t)logic_config, DMAC_CHANNEL0);
  }
  PERIPHERAL_DISABLE(FCB, 0);
#endif

  if (FCB_GetPLLFreq) {
    uint32_t freq = BOARD_PLL_FREQUENCY;
    SYS_EnableAPBClock(APB_MASK_FCB0);
    if (FCB_IsActive()) {
      freq = FCB_GetPLLFreq(board_pll_clkin_freq());
    } else {
      FCB_Activate();
    }
    SYS_SetPLLFreq(freq);
  }
  SYS_SwitchPLLClock(board_hse_source());

  INT_Init(); // This will disabe all interrupts. INT_EnableIRQ should be called after this to enable any external interrupt.
  INT_EnableIntGlobal();
  INT_EnableIntExternal();

  SYS_DisableJTDI();
  SYS_DisableJTDO();
  SYS_DisableNJTRST();

  // Enable LED_GPIO and EXT_GPIO to drive LED's on board
  SYS_EnableAPBClock(LED_GPIO_MASK);
  GPIO_SetOutput(LED_GPIO, LED_GPIO_BITS);
  GPIO_SetHigh(LED_GPIO, LED_GPIO_BITS);

  SYS_EnableAPBClock(EXT_GPIO_MASK);
  GPIO_SetOutput(EXT_GPIO, EXT_GPIO_BITS);
  GPIO_SetHigh(EXT_GPIO, EXT_GPIO_BITS);

  // Enable BUT_GPIO to make buttons on board to trigger interrupts
  SYS_EnableAPBClock(BUT_GPIO_MASK);
  GPIO_SetInput(BUT_GPIO, BUT_GPIO_BITS);
  GPIO_EnableInt(BUT_GPIO, BUT_GPIO_BITS);
  GPIO_IntConfig(BUT_GPIO, BUT_GPIO_BITS, GPIO_INTMODE_FALLEDGE);

#ifdef LOGGER_UART
  GPIO_AF_ENABLE(GPIO_AF_PIN(UART, LOGGER_UART, UARTRXD));
  GPIO_AF_ENABLE(GPIO_AF_PIN(UART, LOGGER_UART, UARTTXD));

  MSG_UART = UARTx(LOGGER_UART);
  SYS_EnableAPBClock(APB_MASK_UARTx(LOGGER_UART));//BAUD_RATE
  UART_Init(UARTx(LOGGER_UART), 921600, UART_LCR_DATABITS_8, UART_LCR_STOPBITS_1, UART_LCR_PARITY_NONE, UART_LCR_FIFO_16);
#endif

  board_init_mac();
  dbg_printf("\nInit done. CLK: %.3fMHz, RTC: %dHz\n", SYS_GetSysClkFreq()/(double)1e6, BOARD_RTC_FREQUENCY);
}

void board_led_write(bool state)
{
  GPIO_SetValue(LED_GPIO, LED_GPIO_BITS, state ? LED_GPIO_BITS : 0);
}

uint32_t board_button_read(void)
{
  return GPIO_GetValue(BUT_GPIO, BUT_GPIO_BITS);
}

int board_uart_read(uint8_t *buf, int len)
{
  (void) buf; (void) len;
  return 0;
}

int board_uart_write(void const *buf, int len)
{
  UART_Send(UART0, (const unsigned char *)buf, len);
  return len;
}

uint32_t board_millis(void)
{
  return UTIL_GetTick();
}