#include "clock.hpp"

#include "chip_helper.hpp"
extern "C" {

static zchip_tim_t* m_usdleaytim;

uint32_t zchip_clock_init(zchip_clock_cfg_t* cfg) {
  m_usdleaytim = cfg->usdleaytim;

  uint32_t freq       = chip_get_timer_clock_sorce_freq(cfg->usdleaytim);
  uint32_t prescaler  = freq / 1000000 - 1;  // 1us
  uint32_t autoreload = 65535;

  HAL_TIM_Base_DeInit(cfg->usdleaytim);

  cfg->usdleaytim->Init.Prescaler         = prescaler;
  cfg->usdleaytim->Init.CounterMode       = TIM_COUNTERMODE_UP;
  cfg->usdleaytim->Init.Period            = autoreload;
  cfg->usdleaytim->Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
  HAL_TIM_Base_Init(cfg->usdleaytim);

  return 0;
}
//
uint32_t zchip_clock_get_ticket(void) { return HAL_GetTick(); }
uint32_t zchip_clock_hasspassed(uint32_t ticket) {
  uint32_t nowticket = HAL_GetTick();
  if (nowticket >= ticket) {
    return nowticket - ticket;
  }
  return UINT32_MAX - ticket + nowticket;
}

void __zchip_clock_early_delayus(uint32_t n) {
  volatile uint32_t counter = 0;
  __HAL_TIM_SET_COUNTER(m_usdleaytim, 0);
  HAL_TIM_Base_Start(m_usdleaytim);
  while (counter < n) {
    counter = __HAL_TIM_GET_COUNTER(m_usdleaytim);
  }
  HAL_TIM_Base_Stop(m_usdleaytim);
}
void zchip_clock_early_delayus(uint32_t n) {
  uint32_t us = n % 1000;
  uint32_t ms = n / 1000;
  if (us > 0) {
    __zchip_clock_early_delayus(us);
  }
  for (uint32_t i = 0; i < ms; i++) {
    __zchip_clock_early_delayus(1000);
  }
}
}