rtc_time.c 8.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204
  1. /*
  2. * SPDX-FileCopyrightText: 2020-2023 Espressif Systems (Shanghai) CO LTD
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. */
  6. #include <stdint.h>
  7. #include "esp32c3/rom/ets_sys.h"
  8. #include "soc/rtc.h"
  9. #include "soc/rtc_cntl_reg.h"
  10. #include "hal/clk_tree_ll.h"
  11. #include "hal/rtc_cntl_ll.h"
  12. #include "hal/timer_ll.h"
  13. #include "soc/timer_group_reg.h"
  14. #include "esp_rom_sys.h"
  15. #include "esp_private/periph_ctrl.h"
  16. /* Calibration of RTC_SLOW_CLK is performed using a special feature of TIMG0.
  17. * This feature counts the number of XTAL clock cycles within a given number of
  18. * RTC_SLOW_CLK cycles.
  19. *
  20. * Slow clock calibration feature has two modes of operation: one-off and cycling.
  21. * In cycling mode (which is enabled by default on SoC reset), counting of XTAL
  22. * cycles within RTC_SLOW_CLK cycle is done continuously. Cycling mode is enabled
  23. * using TIMG_RTC_CALI_START_CYCLING bit. In one-off mode counting is performed
  24. * once, and TIMG_RTC_CALI_RDY bit is set when counting is done. One-off mode is
  25. * enabled using TIMG_RTC_CALI_START bit.
  26. */
  27. /**
  28. * @brief Clock calibration function used by rtc_clk_cal and rtc_clk_cal_ratio
  29. * @param cal_clk which clock to calibrate
  30. * @param slowclk_cycles number of slow clock cycles to count
  31. * @return number of XTAL clock cycles within the given number of slow clock cycles
  32. */
  33. uint32_t rtc_clk_cal_internal(rtc_cal_sel_t cal_clk, uint32_t slowclk_cycles)
  34. {
  35. /* On ESP32C3, choosing RTC_CAL_RTC_MUX results in calibration of
  36. * the 150k RTC clock regardless of the currenlty selected SLOW_CLK.
  37. * On the ESP32, it used the currently selected SLOW_CLK.
  38. * The following code emulates ESP32 behavior:
  39. */
  40. if (cal_clk == RTC_CAL_RTC_MUX) {
  41. soc_rtc_slow_clk_src_t slow_clk_src = rtc_clk_slow_src_get();
  42. if (slow_clk_src == SOC_RTC_SLOW_CLK_SRC_XTAL32K) {
  43. cal_clk = RTC_CAL_32K_XTAL;
  44. } else if (slow_clk_src == SOC_RTC_SLOW_CLK_SRC_RC_FAST_D256) {
  45. cal_clk = RTC_CAL_8MD256;
  46. }
  47. } else if (cal_clk == RTC_CAL_INTERNAL_OSC) {
  48. cal_clk = RTC_CAL_RTC_MUX;
  49. }
  50. /* Enable requested clock (150k clock is always on) */
  51. bool dig_32k_xtal_enabled = clk_ll_xtal32k_digi_is_enabled();
  52. if (cal_clk == RTC_CAL_32K_XTAL && !dig_32k_xtal_enabled) {
  53. clk_ll_xtal32k_digi_enable();
  54. }
  55. bool rc_fast_enabled = clk_ll_rc_fast_is_enabled();
  56. bool rc_fast_d256_enabled = clk_ll_rc_fast_d256_is_enabled();
  57. if (cal_clk == RTC_CAL_8MD256) {
  58. rtc_clk_8m_enable(true, true);
  59. clk_ll_rc_fast_d256_digi_enable();
  60. }
  61. /* There may be another calibration process already running during we call this function,
  62. * so we should wait the last process is done.
  63. */
  64. if (GET_PERI_REG_MASK(TIMG_RTCCALICFG_REG(0), TIMG_RTC_CALI_START_CYCLING)) {
  65. /**
  66. * Set a small timeout threshold to accelerate the generation of timeout.
  67. * The internal circuit will be reset when the timeout occurs and will not affect the next calibration.
  68. */
  69. REG_SET_FIELD(TIMG_RTCCALICFG2_REG(0), TIMG_RTC_CALI_TIMEOUT_THRES, 1);
  70. while (!GET_PERI_REG_MASK(TIMG_RTCCALICFG_REG(0), TIMG_RTC_CALI_RDY)
  71. && !GET_PERI_REG_MASK(TIMG_RTCCALICFG2_REG(0), TIMG_RTC_CALI_TIMEOUT));
  72. }
  73. /* Prepare calibration */
  74. REG_SET_FIELD(TIMG_RTCCALICFG_REG(0), TIMG_RTC_CALI_CLK_SEL, cal_clk);
  75. CLEAR_PERI_REG_MASK(TIMG_RTCCALICFG_REG(0), TIMG_RTC_CALI_START_CYCLING);
  76. REG_SET_FIELD(TIMG_RTCCALICFG_REG(0), TIMG_RTC_CALI_MAX, slowclk_cycles);
  77. /* Figure out how long to wait for calibration to finish */
  78. /* Set timeout reg and expect time delay*/
  79. uint32_t expected_freq;
  80. if (cal_clk == RTC_CAL_32K_XTAL) {
  81. REG_SET_FIELD(TIMG_RTCCALICFG2_REG(0), TIMG_RTC_CALI_TIMEOUT_THRES, RTC_SLOW_CLK_X32K_CAL_TIMEOUT_THRES(slowclk_cycles));
  82. expected_freq = SOC_CLK_XTAL32K_FREQ_APPROX;
  83. } else if (cal_clk == RTC_CAL_8MD256) {
  84. REG_SET_FIELD(TIMG_RTCCALICFG2_REG(0), TIMG_RTC_CALI_TIMEOUT_THRES, RTC_SLOW_CLK_8MD256_CAL_TIMEOUT_THRES(slowclk_cycles));
  85. expected_freq = SOC_CLK_RC_FAST_D256_FREQ_APPROX;
  86. } else {
  87. REG_SET_FIELD(TIMG_RTCCALICFG2_REG(0), TIMG_RTC_CALI_TIMEOUT_THRES, RTC_SLOW_CLK_150K_CAL_TIMEOUT_THRES(slowclk_cycles));
  88. expected_freq = SOC_CLK_RC_SLOW_FREQ_APPROX;
  89. }
  90. uint32_t us_time_estimate = (uint32_t) (((uint64_t) slowclk_cycles) * MHZ / expected_freq);
  91. /* Start calibration */
  92. CLEAR_PERI_REG_MASK(TIMG_RTCCALICFG_REG(0), TIMG_RTC_CALI_START);
  93. SET_PERI_REG_MASK(TIMG_RTCCALICFG_REG(0), TIMG_RTC_CALI_START);
  94. /* Wait for calibration to finish up to another us_time_estimate */
  95. esp_rom_delay_us(us_time_estimate);
  96. uint32_t cal_val;
  97. while (true) {
  98. if (GET_PERI_REG_MASK(TIMG_RTCCALICFG_REG(0), TIMG_RTC_CALI_RDY)) {
  99. cal_val = REG_GET_FIELD(TIMG_RTCCALICFG1_REG(0), TIMG_RTC_CALI_VALUE);
  100. break;
  101. }
  102. if (GET_PERI_REG_MASK(TIMG_RTCCALICFG2_REG(0), TIMG_RTC_CALI_TIMEOUT)) {
  103. cal_val = 0;
  104. break;
  105. }
  106. }
  107. CLEAR_PERI_REG_MASK(TIMG_RTCCALICFG_REG(0), TIMG_RTC_CALI_START);
  108. /* if dig_32k_xtal was originally off and enabled due to calibration, then set back to off state */
  109. if (cal_clk == RTC_CAL_32K_XTAL && !dig_32k_xtal_enabled) {
  110. clk_ll_xtal32k_digi_disable();
  111. }
  112. if (cal_clk == RTC_CAL_8MD256) {
  113. clk_ll_rc_fast_d256_digi_disable();
  114. rtc_clk_8m_enable(rc_fast_enabled, rc_fast_d256_enabled);
  115. }
  116. return cal_val;
  117. }
  118. uint32_t rtc_clk_cal_ratio(rtc_cal_sel_t cal_clk, uint32_t slowclk_cycles)
  119. {
  120. uint64_t xtal_cycles = rtc_clk_cal_internal(cal_clk, slowclk_cycles);
  121. uint64_t ratio_64 = ((xtal_cycles << RTC_CLK_CAL_FRACT)) / slowclk_cycles;
  122. uint32_t ratio = (uint32_t)(ratio_64 & UINT32_MAX);
  123. return ratio;
  124. }
  125. static bool rtc_clk_cal_32k_valid(rtc_xtal_freq_t xtal_freq, uint32_t slowclk_cycles, uint64_t actual_xtal_cycles)
  126. {
  127. uint64_t expected_xtal_cycles = (xtal_freq * 1000000ULL * slowclk_cycles) >> 15; // xtal_freq(hz) * slowclk_cycles / 32768
  128. uint64_t delta = expected_xtal_cycles / 2000; // 5/10000
  129. return (actual_xtal_cycles >= (expected_xtal_cycles - delta)) && (actual_xtal_cycles <= (expected_xtal_cycles + delta));
  130. }
  131. uint32_t rtc_clk_cal(rtc_cal_sel_t cal_clk, uint32_t slowclk_cycles)
  132. {
  133. rtc_xtal_freq_t xtal_freq = rtc_clk_xtal_freq_get();
  134. uint64_t xtal_cycles = rtc_clk_cal_internal(cal_clk, slowclk_cycles);
  135. if ((cal_clk == RTC_CAL_32K_XTAL) && !rtc_clk_cal_32k_valid(xtal_freq, slowclk_cycles, xtal_cycles)) {
  136. return 0;
  137. }
  138. uint64_t divider = ((uint64_t)xtal_freq) * slowclk_cycles;
  139. uint64_t period_64 = ((xtal_cycles << RTC_CLK_CAL_FRACT) + divider / 2 - 1) / divider;
  140. uint32_t period = (uint32_t)(period_64 & UINT32_MAX);
  141. return period;
  142. }
  143. uint64_t rtc_time_us_to_slowclk(uint64_t time_in_us, uint32_t period)
  144. {
  145. /* Overflow will happen in this function if time_in_us >= 2^45, which is about 400 days.
  146. * TODO: fix overflow.
  147. */
  148. return (time_in_us << RTC_CLK_CAL_FRACT) / period;
  149. }
  150. uint64_t rtc_time_slowclk_to_us(uint64_t rtc_cycles, uint32_t period)
  151. {
  152. return (rtc_cycles * period) >> RTC_CLK_CAL_FRACT;
  153. }
  154. uint64_t rtc_time_get(void)
  155. {
  156. return rtc_cntl_ll_get_rtc_time();
  157. }
  158. void rtc_clk_wait_for_slow_cycle(void) //This function may not by useful any more
  159. {
  160. SET_PERI_REG_MASK(RTC_CNTL_SLOW_CLK_CONF_REG, RTC_CNTL_SLOW_CLK_NEXT_EDGE);
  161. while (GET_PERI_REG_MASK(RTC_CNTL_SLOW_CLK_CONF_REG, RTC_CNTL_SLOW_CLK_NEXT_EDGE)) {
  162. esp_rom_delay_us(1);
  163. }
  164. }
  165. uint32_t rtc_clk_freq_cal(uint32_t cal_val)
  166. {
  167. if (cal_val == 0) {
  168. return 0; // cal_val will be denominator, return 0 as the symbol of failure.
  169. }
  170. return 1000000ULL * (1 << RTC_CLK_CAL_FRACT) / cal_val;
  171. }
  172. /// @brief if the calibration is used, we need to enable the timer group0 first
  173. __attribute__((constructor))
  174. static void enable_timer_group0_for_calibration(void)
  175. {
  176. PERIPH_RCC_ACQUIRE_ATOMIC(PERIPH_TIMG0_MODULE, ref_count) {
  177. if (ref_count == 0) {
  178. timer_ll_enable_bus_clock(0, true);
  179. timer_ll_reset_register(0);
  180. }
  181. }
  182. }