You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

53 lines
1.4 KiB

2 years ago
2 years ago
2 years ago
2 years ago
2 years ago
  1. #include "clock.hpp"
  2. #include "chip_helper.hpp"
  3. extern "C" {
  4. static zchip_tim_t* m_usdleaytim;
  5. uint32_t zchip_clock_init(zchip_clock_cfg_t* cfg) {
  6. m_usdleaytim = cfg->usdleaytim;
  7. uint32_t freq = chip_get_timer_clock_sorce_freq(cfg->usdleaytim);
  8. uint32_t prescaler = freq / 1000000 - 1; // 1us
  9. uint32_t autoreload = 65535;
  10. HAL_TIM_Base_DeInit(cfg->usdleaytim);
  11. cfg->usdleaytim->Init.Prescaler = prescaler;
  12. cfg->usdleaytim->Init.CounterMode = TIM_COUNTERMODE_UP;
  13. cfg->usdleaytim->Init.Period = autoreload;
  14. cfg->usdleaytim->Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
  15. HAL_TIM_Base_Init(cfg->usdleaytim);
  16. return 0;
  17. }
  18. //
  19. uint32_t zchip_clock_get_ticket(void) { return HAL_GetTick(); }
  20. uint32_t zchip_clock_hasspassed(uint32_t ticket) {
  21. uint32_t nowticket = HAL_GetTick();
  22. if (nowticket >= ticket) {
  23. return nowticket - ticket;
  24. }
  25. return UINT32_MAX - ticket + nowticket;
  26. }
  27. void __zchip_clock_early_delayus(uint32_t n) {
  28. volatile uint32_t counter = 0;
  29. __HAL_TIM_SET_COUNTER(m_usdleaytim, 0);
  30. HAL_TIM_Base_Start(m_usdleaytim);
  31. while (counter < n) {
  32. counter = __HAL_TIM_GET_COUNTER(m_usdleaytim);
  33. }
  34. HAL_TIM_Base_Stop(m_usdleaytim);
  35. }
  36. void zchip_clock_early_delayus(uint32_t n) {
  37. uint32_t us = n % 1000;
  38. uint32_t ms = n / 1000;
  39. if (us > 0) {
  40. __zchip_clock_early_delayus(us);
  41. }
  42. for (uint32_t i = 0; i < ms; i++) {
  43. __zchip_clock_early_delayus(1000);
  44. }
  45. }
  46. }