|
|
@@ -15,6 +15,7 @@
|
|
|
#include "esp32h2/rom/uart.h"
|
|
|
#include "esp32h2/rom/gpio.h"
|
|
|
#include "soc/rtc.h"
|
|
|
+#include "i2c_bbpll.h"
|
|
|
#include "soc/rtc_cntl_reg.h"
|
|
|
#include "soc/efuse_reg.h"
|
|
|
#include "soc/syscon_reg.h"
|
|
|
@@ -26,14 +27,19 @@
|
|
|
|
|
|
static const char *TAG = "rtc_clk";
|
|
|
|
|
|
-#define RTC_PLL_FREQ_320M 320
|
|
|
-#define RTC_PLL_FREQ_480M 480
|
|
|
+#define RTC_PLL_FREQ_96M 96
|
|
|
+#define RTC_OSC_FREQ_RC8M 18
|
|
|
#define DELAY_RTC_CLK_SWITCH 5
|
|
|
+#define RTC_CNTL_ANA_CONF0_CAL_REG 0x6000e040
|
|
|
+#define RTC_CNTL_ANA_CONF0_CAL_START BIT(2)
|
|
|
+#define RTC_CNTL_ANA_CONF0_CAL_STOP BIT(3)
|
|
|
+#define RTC_CNTL_ANA_CONF0_CAL_DONE BIT(24)
|
|
|
|
|
|
-// Current PLL frequency, in MHZ (320 or 480). Zero if PLL is not enabled.
|
|
|
+// Current PLL frequency, in 96MHZ. Zero if PLL is not enabled.
|
|
|
static int s_cur_pll_freq;
|
|
|
|
|
|
-static void rtc_clk_cpu_freq_to_8m(void);
|
|
|
+void rtc_clk_cpu_freq_to_8m(void);
|
|
|
+static uint32_t rtc_clk_ahb_freq_set(uint32_t div);
|
|
|
|
|
|
void rtc_clk_32k_enable_internal(x32k_config_t cfg)
|
|
|
{
|
|
|
@@ -47,6 +53,9 @@ void rtc_clk_32k_enable_internal(x32k_config_t cfg)
|
|
|
void rtc_clk_32k_enable(bool enable)
|
|
|
{
|
|
|
if (enable) {
|
|
|
+ /* need to hangup gpio0 & 1 before enable xtal_32k */
|
|
|
+ rtc_gpio_hangup(0);
|
|
|
+ rtc_gpio_hangup(1);
|
|
|
x32k_config_t cfg = X32K_CONFIG_DEFAULT();
|
|
|
rtc_clk_32k_enable_internal(cfg);
|
|
|
} else {
|
|
|
@@ -55,16 +64,26 @@ void rtc_clk_32k_enable(bool enable)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+void rtc_clk_rc32k_dfreq(uint32_t dfreq)
|
|
|
+{
|
|
|
+ REG_SET_FIELD(RTC_CNTL_RC32K_CTRL_REG, RTC_CNTL_RC32K_DFREQ, dfreq);
|
|
|
+}
|
|
|
+
|
|
|
+void rtc_clk_rc32k_enable(bool enable)
|
|
|
+{
|
|
|
+ rc32k_config_t cfg = RC32K_CONFIG_DEFAULT();
|
|
|
+ rtc_clk_rc32k_dfreq(cfg.dfreq);
|
|
|
+ REG_SET_FIELD(RTC_CNTL_RC32K_CTRL_REG, RTC_CNTL_RC32K_XPD, enable);
|
|
|
+}
|
|
|
+
|
|
|
void rtc_clk_32k_enable_external(void)
|
|
|
{
|
|
|
- /* TODO ESP32-C3 IDF-2408: external 32k source may need different settings */
|
|
|
- x32k_config_t cfg = X32K_CONFIG_DEFAULT();
|
|
|
- rtc_clk_32k_enable_internal(cfg);
|
|
|
+ rtc_clk_32k_enable(true);
|
|
|
}
|
|
|
|
|
|
void rtc_clk_32k_bootstrap(uint32_t cycle)
|
|
|
{
|
|
|
- /* No special bootstrapping needed for ESP32-C3, 'cycle' argument is to keep the signature
|
|
|
+ /* No special bootstrapping needed for ESP32-H2, 'cycle' argument is to keep the signature
|
|
|
* same as for the ESP32. Just enable the XTAL here.
|
|
|
*/
|
|
|
(void) cycle;
|
|
|
@@ -82,53 +101,11 @@ bool rtc_clk_32k_enabled(void)
|
|
|
return !disabled;
|
|
|
}
|
|
|
|
|
|
-void rtc_clk_8m_enable(bool clk_8m_en, bool d256_en)
|
|
|
-{
|
|
|
- if (clk_8m_en) {
|
|
|
- // CLEAR_PERI_REG_MASK(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_ENB_CK8M); // ESP32H2-TODO: IDF-3396
|
|
|
- /* no need to wait once enabled by software */
|
|
|
- REG_SET_FIELD(RTC_CNTL_TIMER1_REG, RTC_CNTL_CK8M_WAIT, RTC_CK8M_ENABLE_WAIT_DEFAULT);
|
|
|
- esp_rom_delay_us(DELAY_8M_ENABLE);
|
|
|
- } else {
|
|
|
- // SET_PERI_REG_MASK(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_ENB_CK8M);
|
|
|
- REG_SET_FIELD(RTC_CNTL_TIMER1_REG, RTC_CNTL_CK8M_WAIT, RTC_CNTL_CK8M_WAIT_DEFAULT);
|
|
|
- }
|
|
|
- /* d256 should be independent configured with 8M
|
|
|
- * Maybe we can split this function into 8m and dmd256
|
|
|
- */
|
|
|
- if (d256_en) {
|
|
|
- // CLEAR_PERI_REG_MASK(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_ENB_CK8M_DIV);
|
|
|
- } else {
|
|
|
- // SET_PERI_REG_MASK(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_ENB_CK8M_DIV);
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-bool rtc_clk_8m_enabled(void)
|
|
|
-{
|
|
|
- return false;
|
|
|
- // return GET_PERI_REG_MASK(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_ENB_CK8M) == 0; // ESP32H2-TODO: IDF-3396
|
|
|
-}
|
|
|
-
|
|
|
-bool rtc_clk_8md256_enabled(void)
|
|
|
-{
|
|
|
- return false;
|
|
|
- // return GET_PERI_REG_MASK(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_ENB_CK8M_DIV) == 0; // ESP32H2-TODO: IDF-3396
|
|
|
-}
|
|
|
-
|
|
|
void rtc_clk_slow_freq_set(rtc_slow_freq_t slow_freq)
|
|
|
{
|
|
|
REG_SET_FIELD(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_ANA_CLK_RTC_SEL, slow_freq);
|
|
|
-
|
|
|
- /* Why we need to connect this clock to digital?
|
|
|
- * Or maybe this clock should be connected to digital when xtal 32k clock is enabled instead?
|
|
|
- */
|
|
|
- REG_SET_FIELD(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_DIG_XTAL32K_EN,
|
|
|
- (slow_freq == RTC_SLOW_FREQ_32K_XTAL) ? 1 : 0);
|
|
|
-
|
|
|
- /* The clk_8m_d256 will be closed when rtc_state in SLEEP,
|
|
|
- so if the slow_clk is 8md256, clk_8m must be force power on
|
|
|
- */
|
|
|
- REG_SET_FIELD(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_CK8M_FORCE_PU, (slow_freq == RTC_SLOW_FREQ_8MD256) ? 1 : 0);
|
|
|
+ rtc_clk_32k_enable((slow_freq == RTC_SLOW_FREQ_32K_XTAL) ? 1 : 0);
|
|
|
+ rtc_clk_rc32k_enable((slow_freq == RTC_SLOW_FREQ_RC32K) ? 1 : 0);
|
|
|
esp_rom_delay_us(DELAY_SLOW_CLK_SWITCH);
|
|
|
}
|
|
|
|
|
|
@@ -142,7 +119,7 @@ uint32_t rtc_clk_slow_freq_get_hz(void)
|
|
|
switch (rtc_clk_slow_freq_get()) {
|
|
|
case RTC_SLOW_FREQ_RTC: return RTC_SLOW_CLK_FREQ_150K;
|
|
|
case RTC_SLOW_FREQ_32K_XTAL: return RTC_SLOW_CLK_FREQ_32K;
|
|
|
- case RTC_SLOW_FREQ_8MD256: return RTC_SLOW_CLK_FREQ_8MD256;
|
|
|
+ case RTC_SLOW_FREQ_RC32K: return RTC_SLOW_CLK_FREQ_RC32;
|
|
|
}
|
|
|
return 0;
|
|
|
}
|
|
|
@@ -170,100 +147,32 @@ static void rtc_clk_bbpll_enable(void)
|
|
|
CLEAR_PERI_REG_MASK(RTC_CNTL_OPTIONS0_REG, RTC_CNTL_BB_I2C_FORCE_PD |
|
|
|
RTC_CNTL_BBPLL_FORCE_PD | RTC_CNTL_BBPLL_I2C_FORCE_PD);
|
|
|
}
|
|
|
+static void rtc_clk_bbpll_cali_stop(void)
|
|
|
+{
|
|
|
+ while (!REG_GET_BIT(RTC_CNTL_ANA_CONF0_CAL_REG, RTC_CNTL_ANA_CONF0_CAL_DONE));
|
|
|
+ REG_CLR_BIT(RTC_CNTL_ANA_CONF0_CAL_REG, RTC_CNTL_ANA_CONF0_CAL_STOP);
|
|
|
+ REG_SET_BIT(RTC_CNTL_ANA_CONF0_CAL_REG, RTC_CNTL_ANA_CONF0_CAL_START);
|
|
|
+
|
|
|
+}
|
|
|
|
|
|
void rtc_clk_bbpll_configure(rtc_xtal_freq_t xtal_freq, int pll_freq)
|
|
|
{
|
|
|
uint8_t div_ref;
|
|
|
- uint8_t div7_0;
|
|
|
- uint8_t dr1;
|
|
|
- uint8_t dr3;
|
|
|
- uint8_t dchgp;
|
|
|
- uint8_t dcur;
|
|
|
- uint8_t dbias;
|
|
|
-
|
|
|
- CLEAR_PERI_REG_MASK(I2C_MST_ANA_CONF0_REG, I2C_MST_BBPLL_STOP_FORCE_HIGH);
|
|
|
- SET_PERI_REG_MASK(I2C_MST_ANA_CONF0_REG, I2C_MST_BBPLL_STOP_FORCE_LOW);
|
|
|
- if (pll_freq == RTC_PLL_FREQ_480M) {
|
|
|
- /* Set this register to let the digital part know 480M PLL is used */
|
|
|
- // SET_PERI_REG_MASK(SYSTEM_CPU_PER_CONF_REG, SYSTEM_PLL_FREQ_SEL); // ESP32H2-TODO: IDF-3396
|
|
|
- /* Configure 480M PLL */
|
|
|
- switch (xtal_freq) {
|
|
|
- case RTC_XTAL_FREQ_40M:
|
|
|
- div_ref = 0;
|
|
|
- div7_0 = 8;
|
|
|
- dr1 = 0;
|
|
|
- dr3 = 0;
|
|
|
- dchgp = 5;
|
|
|
- dcur = 3;
|
|
|
- dbias = 2;
|
|
|
- break;
|
|
|
- case RTC_XTAL_FREQ_32M:
|
|
|
- div_ref = 1;
|
|
|
- div7_0 = 26;
|
|
|
- dr1 = 1;
|
|
|
- dr3 = 1;
|
|
|
- dchgp = 4;
|
|
|
- dcur = 0;
|
|
|
- dbias = 2;
|
|
|
- break;
|
|
|
- default:
|
|
|
- div_ref = 0;
|
|
|
- div7_0 = 8;
|
|
|
- dr1 = 0;
|
|
|
- dr3 = 0;
|
|
|
- dchgp = 5;
|
|
|
- dcur = 3;
|
|
|
- dbias = 2;
|
|
|
- break;
|
|
|
- }
|
|
|
- REGI2C_WRITE(I2C_BBPLL, I2C_BBPLL_MODE_HF, 0x6B);
|
|
|
+ uint8_t div5_0;
|
|
|
+ if ((pll_freq == RTC_PLL_FREQ_96M) && (xtal_freq == RTC_XTAL_FREQ_32M)) {
|
|
|
+ /* Configure 96M PLL */
|
|
|
+ div_ref = 0;
|
|
|
+ div5_0 = 1;
|
|
|
} else {
|
|
|
- /* Clear this register to let the digital part know 320M PLL is used */
|
|
|
- // CLEAR_PERI_REG_MASK(SYSTEM_CPU_PER_CONF_REG, SYSTEM_PLL_FREQ_SEL); // ESP32H2-TODO: IDF-3396
|
|
|
- /* Configure 320M PLL */
|
|
|
- switch (xtal_freq) {
|
|
|
- case RTC_XTAL_FREQ_40M:
|
|
|
- div_ref = 0;
|
|
|
- div7_0 = 4;
|
|
|
- dr1 = 0;
|
|
|
- dr3 = 0;
|
|
|
- dchgp = 5;
|
|
|
- dcur = 3;
|
|
|
- dbias = 2;
|
|
|
- break;
|
|
|
- case RTC_XTAL_FREQ_32M:
|
|
|
- div_ref = 1;
|
|
|
- div7_0 = 6;
|
|
|
- dr1 = 0;
|
|
|
- dr3 = 0;
|
|
|
- dchgp = 5;
|
|
|
- dcur = 3;
|
|
|
- dbias = 2;
|
|
|
- break;
|
|
|
- default:
|
|
|
- div_ref = 0;
|
|
|
- div7_0 = 4;
|
|
|
- dr1 = 0;
|
|
|
- dr3 = 0;
|
|
|
- dchgp = 5;
|
|
|
- dcur = 3;
|
|
|
- dbias = 2;
|
|
|
- break;
|
|
|
- }
|
|
|
- REGI2C_WRITE(I2C_BBPLL, I2C_BBPLL_MODE_HF, 0x69);
|
|
|
+ div_ref = 0;
|
|
|
+ div5_0 = 1;
|
|
|
+ SOC_LOGE(TAG, "invalid pll frequency");
|
|
|
}
|
|
|
- uint8_t i2c_bbpll_lref = (dchgp << I2C_BBPLL_OC_DCHGP_LSB) | (div_ref);
|
|
|
- uint8_t i2c_bbpll_div_7_0 = div7_0;
|
|
|
- uint8_t i2c_bbpll_dcur = (2 << I2C_BBPLL_OC_DLREF_SEL_LSB ) | (1 << I2C_BBPLL_OC_DHREF_SEL_LSB) | dcur;
|
|
|
- REGI2C_WRITE(I2C_BBPLL, I2C_BBPLL_OC_REF_DIV, i2c_bbpll_lref);
|
|
|
- REGI2C_WRITE(I2C_BBPLL, I2C_BBPLL_OC_DIV_7_0, i2c_bbpll_div_7_0);
|
|
|
- REGI2C_WRITE_MASK(I2C_BBPLL, I2C_BBPLL_OC_DR1, dr1);
|
|
|
- REGI2C_WRITE_MASK(I2C_BBPLL, I2C_BBPLL_OC_DR3, dr3);
|
|
|
- REGI2C_WRITE(I2C_BBPLL, I2C_BBPLL_OC_DCUR, i2c_bbpll_dcur);
|
|
|
- REGI2C_WRITE_MASK(I2C_BBPLL, I2C_BBPLL_OC_VCO_DBIAS, dbias);
|
|
|
- REGI2C_WRITE_MASK(I2C_BBPLL, I2C_BBPLL_OC_DHREF_SEL, 2);
|
|
|
- REGI2C_WRITE_MASK(I2C_BBPLL, I2C_BBPLL_OC_DLREF_SEL, 1);
|
|
|
|
|
|
+ REGI2C_WRITE_MASK(I2C_BBPLL, I2C_BBPLL_OC_REF_DIV, div_ref);
|
|
|
+ REGI2C_WRITE_MASK(I2C_BBPLL, I2C_BBPLL_OC_DIV, div5_0); //I2C_BBPLL_OC_DIV_5_0
|
|
|
+ REGI2C_WRITE_MASK(I2C_BBPLL, I2C_BBPLL_OC_DHREF_SEL, 3); // need update to 3 since s2
|
|
|
+ REGI2C_WRITE_MASK(I2C_BBPLL, I2C_BBPLL_OC_DLREF_SEL, 1);
|
|
|
s_cur_pll_freq = pll_freq;
|
|
|
}
|
|
|
|
|
|
@@ -274,19 +183,21 @@ void rtc_clk_bbpll_configure(rtc_xtal_freq_t xtal_freq, int pll_freq)
|
|
|
*/
|
|
|
static void rtc_clk_cpu_freq_to_pll_mhz(int cpu_freq_mhz)
|
|
|
{
|
|
|
- // int per_conf = DPORT_CPUPERIOD_SEL_80;
|
|
|
- if (cpu_freq_mhz == 80) {
|
|
|
- /* nothing to do */
|
|
|
- } else if (cpu_freq_mhz == 160) {
|
|
|
- // per_conf = DPORT_CPUPERIOD_SEL_160;
|
|
|
+ int div = 1;
|
|
|
+ if (RTC_PLL_FREQ_96M % cpu_freq_mhz == 0) {
|
|
|
+ div = RTC_PLL_FREQ_96M / cpu_freq_mhz;
|
|
|
} else {
|
|
|
SOC_LOGE(TAG, "invalid frequency");
|
|
|
abort();
|
|
|
}
|
|
|
- // REG_SET_FIELD(SYSTEM_CPU_PER_CONF_REG, SYSTEM_CPUPERIOD_SEL, per_conf); // ESP32H2-TODO: IDF-3396
|
|
|
- REG_SET_FIELD(SYSTEM_SYSCLK_CONF_REG, SYSTEM_PRE_DIV_CNT, 0);
|
|
|
- REG_SET_FIELD(SYSTEM_SYSCLK_CONF_REG, SYSTEM_SOC_CLK_SEL, DPORT_SOC_CLK_SEL_PLL);
|
|
|
- rtc_clk_apb_freq_update(80 * MHZ);
|
|
|
+ rtc_clk_cpu_freq_set(DPORT_SOC_CLK_SEL_PLL, div - 1);
|
|
|
+ if (cpu_freq_mhz > RTC_XTAL_FREQ_32M) {
|
|
|
+ rtc_clk_ahb_freq_set(2);
|
|
|
+ } else {
|
|
|
+ rtc_clk_ahb_freq_set(1);
|
|
|
+ }
|
|
|
+
|
|
|
+ rtc_clk_apb_freq_update(rtc_clk_apb_freq_get());
|
|
|
ets_update_cpu_frequency(cpu_freq_mhz);
|
|
|
}
|
|
|
|
|
|
@@ -295,62 +206,32 @@ bool rtc_clk_cpu_freq_mhz_to_config(uint32_t freq_mhz, rtc_cpu_freq_config_t *ou
|
|
|
uint32_t source_freq_mhz;
|
|
|
rtc_cpu_freq_src_t source;
|
|
|
uint32_t divider;
|
|
|
- uint32_t real_freq_mhz;
|
|
|
-
|
|
|
uint32_t xtal_freq = (uint32_t) rtc_clk_xtal_freq_get();
|
|
|
- if (freq_mhz <= xtal_freq) {
|
|
|
- divider = xtal_freq / freq_mhz;
|
|
|
- real_freq_mhz = (xtal_freq + divider / 2) / divider; /* round */
|
|
|
- if (real_freq_mhz != freq_mhz) {
|
|
|
- // no suitable divider
|
|
|
- return false;
|
|
|
- }
|
|
|
-
|
|
|
- source_freq_mhz = xtal_freq;
|
|
|
- source = RTC_CPU_FREQ_SRC_XTAL;
|
|
|
- } else if (freq_mhz == 80) {
|
|
|
- real_freq_mhz = freq_mhz;
|
|
|
- source = RTC_CPU_FREQ_SRC_PLL;
|
|
|
- source_freq_mhz = RTC_PLL_FREQ_480M;
|
|
|
- divider = 6;
|
|
|
- } else if (freq_mhz == 160) {
|
|
|
- real_freq_mhz = freq_mhz;
|
|
|
+ if (freq_mhz > xtal_freq) {
|
|
|
source = RTC_CPU_FREQ_SRC_PLL;
|
|
|
- source_freq_mhz = RTC_PLL_FREQ_480M;
|
|
|
- divider = 3;
|
|
|
+ source_freq_mhz = RTC_PLL_FREQ_96M;
|
|
|
+ divider = RTC_PLL_FREQ_96M / freq_mhz;
|
|
|
+ rtc_clk_ahb_freq_set(2);
|
|
|
} else {
|
|
|
- // unsupported frequency
|
|
|
- return false;
|
|
|
+ source = root_clk_get();
|
|
|
+ source_freq_mhz = root_clk_slt(source);
|
|
|
+ divider = source_freq_mhz / freq_mhz;
|
|
|
+ rtc_clk_ahb_freq_set(1);
|
|
|
}
|
|
|
*out_config = (rtc_cpu_freq_config_t) {
|
|
|
.source = source,
|
|
|
.div = divider,
|
|
|
.source_freq_mhz = source_freq_mhz,
|
|
|
- .freq_mhz = real_freq_mhz
|
|
|
+ .freq_mhz = freq_mhz
|
|
|
};
|
|
|
return true;
|
|
|
}
|
|
|
|
|
|
void rtc_clk_cpu_freq_set_config(const rtc_cpu_freq_config_t *config)
|
|
|
{
|
|
|
- uint32_t soc_clk_sel = REG_GET_FIELD(SYSTEM_SYSCLK_CONF_REG, SYSTEM_SOC_CLK_SEL);
|
|
|
- if (config->source == RTC_CPU_FREQ_SRC_XTAL) {
|
|
|
- rtc_clk_cpu_freq_to_xtal(config->freq_mhz, config->div);
|
|
|
- if (soc_clk_sel == DPORT_SOC_CLK_SEL_PLL) {
|
|
|
- rtc_clk_bbpll_disable();
|
|
|
- }
|
|
|
- } else if (config->source == RTC_CPU_FREQ_SRC_PLL) {
|
|
|
- if (soc_clk_sel != DPORT_SOC_CLK_SEL_PLL) {
|
|
|
- rtc_clk_bbpll_enable();
|
|
|
- rtc_clk_bbpll_configure(rtc_clk_xtal_freq_get(), config->source_freq_mhz);
|
|
|
- }
|
|
|
- rtc_clk_cpu_freq_to_pll_mhz(config->freq_mhz);
|
|
|
- } else if (config->source == RTC_CPU_FREQ_SRC_8M) {
|
|
|
- rtc_clk_cpu_freq_to_8m();
|
|
|
- if (soc_clk_sel == DPORT_SOC_CLK_SEL_PLL) {
|
|
|
- rtc_clk_bbpll_disable();
|
|
|
- }
|
|
|
- }
|
|
|
+ uint32_t src_freq_mhz = root_clk_slt(config->source);
|
|
|
+ uint32_t div = src_freq_mhz / (config->freq_mhz);
|
|
|
+ rtc_clk_cpu_freq_set(config->source, div);
|
|
|
}
|
|
|
|
|
|
void rtc_clk_cpu_freq_get_config(rtc_cpu_freq_config_t *out_config)
|
|
|
@@ -363,29 +244,37 @@ void rtc_clk_cpu_freq_get_config(rtc_cpu_freq_config_t *out_config)
|
|
|
switch (soc_clk_sel) {
|
|
|
case DPORT_SOC_CLK_SEL_XTAL: {
|
|
|
source = RTC_CPU_FREQ_SRC_XTAL;
|
|
|
- div = REG_GET_FIELD(SYSTEM_SYSCLK_CONF_REG, SYSTEM_PRE_DIV_CNT) + 1;
|
|
|
+ div = REG_GET_FIELD(SYSTEM_CPUCLK_CONF_REG, SYSTEM_PRE_DIV_CNT) + 1;
|
|
|
source_freq_mhz = (uint32_t) rtc_clk_xtal_freq_get();
|
|
|
freq_mhz = source_freq_mhz / div;
|
|
|
+ break;
|
|
|
}
|
|
|
- break;
|
|
|
case DPORT_SOC_CLK_SEL_PLL: {
|
|
|
- // ESP32H2-TODO: IDF-3396
|
|
|
- source = 0;
|
|
|
- div = 0;
|
|
|
- source_freq_mhz = 0;
|
|
|
- freq_mhz = 0;
|
|
|
+ source = RTC_CPU_FREQ_SRC_PLL;
|
|
|
+ div = REG_GET_FIELD(SYSTEM_CPUCLK_CONF_REG, SYSTEM_PRE_DIV_CNT) + 1;
|
|
|
+ source_freq_mhz = RTC_PLL_FREQ_96M;
|
|
|
+ freq_mhz = source_freq_mhz / div;
|
|
|
break;
|
|
|
}
|
|
|
- case DPORT_SOC_CLK_SEL_8M:
|
|
|
+ case DPORT_SOC_CLK_SEL_8M: {
|
|
|
source = RTC_CPU_FREQ_SRC_8M;
|
|
|
- source_freq_mhz = 8;
|
|
|
- div = 1;
|
|
|
- freq_mhz = source_freq_mhz;
|
|
|
+ source_freq_mhz = RTC_OSC_FREQ_RC8M;
|
|
|
+ div = REG_GET_FIELD(SYSTEM_CPUCLK_CONF_REG, SYSTEM_PRE_DIV_CNT) + 1;
|
|
|
+ freq_mhz = source_freq_mhz / div;
|
|
|
break;
|
|
|
- default:
|
|
|
+ }
|
|
|
+ case DPORT_SOC_CLK_SEL_XTAL_D2: {
|
|
|
+ source = RTC_CPU_FREQ_SRC_XTAL_D2;
|
|
|
+ div = REG_GET_FIELD(SYSTEM_CPUCLK_CONF_REG, SYSTEM_PRE_DIV_CNT) + 1;
|
|
|
+ source_freq_mhz = (uint32_t) rtc_clk_xtal_freq_get();
|
|
|
+ freq_mhz = source_freq_mhz / div / 2;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ default: {
|
|
|
SOC_LOGE(TAG, "unsupported frequency configuration");
|
|
|
abort();
|
|
|
}
|
|
|
+ }
|
|
|
*out_config = (rtc_cpu_freq_config_t) {
|
|
|
.source = source,
|
|
|
.source_freq_mhz = source_freq_mhz,
|
|
|
@@ -410,7 +299,6 @@ void rtc_clk_cpu_freq_set_config_fast(const rtc_cpu_freq_config_t *config)
|
|
|
void rtc_clk_cpu_freq_set_xtal(void)
|
|
|
{
|
|
|
int freq_mhz = (int) rtc_clk_xtal_freq_get();
|
|
|
-
|
|
|
rtc_clk_cpu_freq_to_xtal(freq_mhz, 1);
|
|
|
rtc_clk_bbpll_disable();
|
|
|
}
|
|
|
@@ -422,20 +310,17 @@ void rtc_clk_cpu_freq_to_xtal(int freq, int div)
|
|
|
{
|
|
|
ets_update_cpu_frequency(freq);
|
|
|
/* Set divider from XTAL to APB clock. Need to set divider to 1 (reg. value 0) first. */
|
|
|
- REG_SET_FIELD(SYSTEM_SYSCLK_CONF_REG, SYSTEM_PRE_DIV_CNT, 0);
|
|
|
- REG_SET_FIELD(SYSTEM_SYSCLK_CONF_REG, SYSTEM_PRE_DIV_CNT, div - 1);
|
|
|
+ rtc_clk_cpu_freq_set(DPORT_SOC_CLK_SEL_XTAL, div);
|
|
|
/* no need to adjust the REF_TICK */
|
|
|
/* switch clock source */
|
|
|
- REG_SET_FIELD(SYSTEM_SYSCLK_CONF_REG, SYSTEM_SOC_CLK_SEL, DPORT_SOC_CLK_SEL_XTAL);
|
|
|
- rtc_clk_apb_freq_update(freq * MHZ);
|
|
|
+ rtc_clk_apb_freq_update(rtc_clk_apb_freq_get());
|
|
|
}
|
|
|
|
|
|
-static void rtc_clk_cpu_freq_to_8m(void)
|
|
|
+void rtc_clk_cpu_freq_to_8m(void)
|
|
|
{
|
|
|
- ets_update_cpu_frequency(8);
|
|
|
- REG_SET_FIELD(SYSTEM_SYSCLK_CONF_REG, SYSTEM_PRE_DIV_CNT, 0);
|
|
|
- REG_SET_FIELD(SYSTEM_SYSCLK_CONF_REG, SYSTEM_SOC_CLK_SEL, DPORT_SOC_CLK_SEL_8M);
|
|
|
- rtc_clk_apb_freq_update(RTC_FAST_CLK_FREQ_8M);
|
|
|
+ ets_update_cpu_frequency(RTC_OSC_FREQ_RC8M);
|
|
|
+ root_clk_slt(DPORT_SOC_CLK_SEL_8M);
|
|
|
+ rtc_clk_apb_freq_update(rtc_clk_apb_freq_get());
|
|
|
}
|
|
|
|
|
|
rtc_xtal_freq_t rtc_clk_xtal_freq_get(void)
|
|
|
@@ -443,7 +328,7 @@ rtc_xtal_freq_t rtc_clk_xtal_freq_get(void)
|
|
|
uint32_t xtal_freq_reg = READ_PERI_REG(RTC_XTAL_FREQ_REG);
|
|
|
if (!clk_val_is_valid(xtal_freq_reg)) {
|
|
|
SOC_LOGW(TAG, "invalid RTC_XTAL_FREQ_REG value: 0x%08x", xtal_freq_reg);
|
|
|
- return RTC_XTAL_FREQ_40M;
|
|
|
+ return RTC_XTAL_FREQ_32M;
|
|
|
}
|
|
|
return reg_val_to_clk_val(xtal_freq_reg);
|
|
|
}
|
|
|
@@ -458,41 +343,121 @@ void rtc_clk_apb_freq_update(uint32_t apb_freq)
|
|
|
WRITE_PERI_REG(RTC_APB_FREQ_REG, clk_val_to_reg_val(apb_freq >> 12));
|
|
|
}
|
|
|
|
|
|
+
|
|
|
uint32_t rtc_clk_apb_freq_get(void)
|
|
|
{
|
|
|
- uint32_t freq_hz = reg_val_to_clk_val(READ_PERI_REG(RTC_APB_FREQ_REG)) << 12;
|
|
|
- // round to the nearest MHz
|
|
|
- freq_hz += MHZ / 2;
|
|
|
- uint32_t remainder = freq_hz % MHZ;
|
|
|
- return freq_hz - remainder;
|
|
|
+ uint32_t apb_div = REG_GET_FIELD(SYSTEM_BUSCLK_CONF_REG, SYSTEM_APB_DIV_NUM) + 1;
|
|
|
+ return rtc_clk_ahb_freq_get() / apb_div;
|
|
|
+}
|
|
|
+
|
|
|
+uint32_t rtc_clk_ahb_freq_get()
|
|
|
+{
|
|
|
+ rtc_cpu_freq_config_t cpu_config;
|
|
|
+ uint32_t ahb_div = REG_GET_FIELD(SYSTEM_BUSCLK_CONF_REG, SYSTEM_AHB_DIV_NUM) + 1;
|
|
|
+ rtc_clk_cpu_freq_get_config(&cpu_config) ;
|
|
|
+ return cpu_config.freq_mhz / ahb_div;
|
|
|
+}
|
|
|
+
|
|
|
+uint32_t rtc_clk_ahb_freq_set(uint32_t div)
|
|
|
+{
|
|
|
+ REG_SET_FIELD(SYSTEM_BUSCLK_CONF_REG, SYSTEM_AHB_DIV_NUM, div - 1);
|
|
|
+ return rtc_clk_ahb_freq_get();
|
|
|
+}
|
|
|
+
|
|
|
+uint32_t rtc_clk_apb_freq_set(uint32_t div)
|
|
|
+{
|
|
|
+ REG_SET_FIELD(SYSTEM_BUSCLK_CONF_REG, SYSTEM_APB_DIV_NUM, div - 1);
|
|
|
+ return rtc_clk_apb_freq_get();
|
|
|
+}
|
|
|
+
|
|
|
+void rtc_clk_cpu_freq_set(uint32_t source, uint32_t div)
|
|
|
+{
|
|
|
+ if (root_clk_get() != source) {
|
|
|
+ root_clk_slt(source);
|
|
|
+ }
|
|
|
+ REG_SET_FIELD(SYSTEM_CPUCLK_CONF_REG, SYSTEM_CPU_DIV_NUM, div - 1);
|
|
|
}
|
|
|
|
|
|
void rtc_clk_divider_set(uint32_t div)
|
|
|
{
|
|
|
CLEAR_PERI_REG_MASK(RTC_CNTL_SLOW_CLK_CONF_REG, RTC_CNTL_ANA_CLK_DIV_VLD);
|
|
|
- REG_SET_FIELD(RTC_CNTL_SLOW_CLK_CONF_REG, RTC_CNTL_ANA_CLK_DIV, div);
|
|
|
+ REG_SET_FIELD(RTC_CNTL_SLOW_CLK_CONF_REG, RTC_CNTL_ANA_CLK_DIV, div - 1);
|
|
|
SET_PERI_REG_MASK(RTC_CNTL_SLOW_CLK_CONF_REG, RTC_CNTL_ANA_CLK_DIV_VLD);
|
|
|
}
|
|
|
|
|
|
void rtc_clk_8m_divider_set(uint32_t div)
|
|
|
{
|
|
|
CLEAR_PERI_REG_MASK(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_CK8M_DIV_SEL_VLD);
|
|
|
- REG_SET_FIELD(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_CK8M_DIV_SEL, div);
|
|
|
+ REG_SET_FIELD(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_CK8M_DIV_SEL, div - 1);
|
|
|
SET_PERI_REG_MASK(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_CK8M_DIV_SEL_VLD);
|
|
|
}
|
|
|
|
|
|
void rtc_dig_clk8m_enable(void)
|
|
|
{
|
|
|
- SET_PERI_REG_MASK(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_DIG_CLK8M_EN_M);
|
|
|
+ SET_PERI_REG_MASK(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_DIG_CLK8M_EN);
|
|
|
esp_rom_delay_us(DELAY_RTC_CLK_SWITCH);
|
|
|
}
|
|
|
|
|
|
void rtc_dig_clk8m_disable(void)
|
|
|
{
|
|
|
- CLEAR_PERI_REG_MASK(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_DIG_CLK8M_EN_M);
|
|
|
+ CLEAR_PERI_REG_MASK(RTC_CNTL_CLK_CONF_REG, RTC_CNTL_DIG_CLK8M_EN);
|
|
|
esp_rom_delay_us(DELAY_RTC_CLK_SWITCH);
|
|
|
}
|
|
|
|
|
|
+uint32_t read_spll_freq(void)
|
|
|
+{
|
|
|
+ return REG_GET_FIELD(SYSTEM_SYSCLK_CONF_REG, SYSTEM_SPLL_FREQ);
|
|
|
+}
|
|
|
+
|
|
|
+uint32_t read_xtal_freq(void)
|
|
|
+{
|
|
|
+ return REG_GET_FIELD(SYSTEM_SYSCLK_CONF_REG, SYSTEM_CLK_XTAL_FREQ);
|
|
|
+}
|
|
|
+
|
|
|
+/* Select clock root source for esp32h2. return source clk freq_mhz
|
|
|
+ */
|
|
|
+uint32_t root_clk_slt(uint32_t source)
|
|
|
+{
|
|
|
+ uint32_t root_clk_freq_mhz;
|
|
|
+ switch (source) {
|
|
|
+ case RTC_CPU_FREQ_SRC_XTAL:
|
|
|
+ root_clk_freq_mhz = RTC_XTAL_FREQ_32M;
|
|
|
+ rtc_clk_bbpll_disable();
|
|
|
+ break;
|
|
|
+ case RTC_CPU_FREQ_SRC_PLL:
|
|
|
+ // SPLL_ENABLE
|
|
|
+ root_clk_freq_mhz = RTC_PLL_FREQ_96M;
|
|
|
+ rtc_clk_bbpll_enable();
|
|
|
+ rtc_clk_bbpll_configure(RTC_XTAL_FREQ_32M, root_clk_freq_mhz);
|
|
|
+ rtc_clk_bbpll_cali_stop();
|
|
|
+ break;
|
|
|
+ case RTC_CPU_FREQ_SRC_8M:
|
|
|
+ root_clk_freq_mhz = RTC_OSC_FREQ_RC8M;
|
|
|
+ rtc_dig_clk8m_enable();
|
|
|
+ rtc_clk_8m_divider_set(1);
|
|
|
+ rtc_clk_bbpll_disable();
|
|
|
+ break;
|
|
|
+ case RTC_CPU_FREQ_SRC_XTAL_D2:
|
|
|
+ root_clk_freq_mhz = RTC_XTAL_FREQ_32M / 2;
|
|
|
+ rtc_clk_bbpll_disable();
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ SOC_LOGE(TAG, "unsupported source clk configuration");
|
|
|
+ root_clk_freq_mhz = RTC_XTAL_FREQ_32M;
|
|
|
+ rtc_clk_bbpll_disable();
|
|
|
+ source = 0;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ REG_SET_FIELD(SYSTEM_SYSCLK_CONF_REG, SYSTEM_SOC_CLK_SEL, source);
|
|
|
+ return root_clk_freq_mhz;
|
|
|
+}
|
|
|
+
|
|
|
+uint32_t root_clk_get()
|
|
|
+{
|
|
|
+ uint32_t src_slt = REG_GET_FIELD(SYSTEM_SYSCLK_CONF_REG, SYSTEM_SOC_CLK_SEL);
|
|
|
+ return src_slt;
|
|
|
+}
|
|
|
+
|
|
|
/* Name used in libphy.a:phy_chip_v7.o
|
|
|
* TODO: update the library to use rtc_clk_xtal_freq_get
|
|
|
*/
|