|
|
@@ -21,230 +21,180 @@
|
|
|
|
|
|
static portMUX_TYPE periph_spinlock = portMUX_INITIALIZER_UNLOCKED;
|
|
|
|
|
|
+/* Static functions to return register address & mask for clk_en / rst of each peripheral */
|
|
|
+static uint32_t get_clk_en_mask(periph_module_t periph);
|
|
|
+static uint32_t get_rst_en_mask(periph_module_t periph);
|
|
|
+static uint32_t get_clk_en_reg(periph_module_t periph);
|
|
|
+static uint32_t get_rst_en_reg(periph_module_t periph);
|
|
|
+
|
|
|
void periph_module_enable(periph_module_t periph)
|
|
|
{
|
|
|
portENTER_CRITICAL(&periph_spinlock);
|
|
|
+ DPORT_SET_PERI_REG_MASK(get_clk_en_reg(periph), get_clk_en_mask(periph));
|
|
|
+ DPORT_CLEAR_PERI_REG_MASK(get_rst_en_reg(periph), get_rst_en_mask(periph));
|
|
|
+ portEXIT_CRITICAL(&periph_spinlock);
|
|
|
+}
|
|
|
+
|
|
|
+void periph_module_disable(periph_module_t periph)
|
|
|
+{
|
|
|
+ portENTER_CRITICAL(&periph_spinlock);
|
|
|
+ DPORT_CLEAR_PERI_REG_MASK(get_clk_en_reg(periph), get_clk_en_mask(periph));
|
|
|
+ DPORT_SET_PERI_REG_MASK(get_rst_en_reg(periph), get_rst_en_mask(periph));
|
|
|
+ portEXIT_CRITICAL(&periph_spinlock);
|
|
|
+}
|
|
|
+
|
|
|
+void periph_module_reset(periph_module_t periph)
|
|
|
+{
|
|
|
+ portENTER_CRITICAL(&periph_spinlock);
|
|
|
+ uint32_t rst_en = get_rst_en_mask(periph);
|
|
|
+ uint32_t mask = get_clk_en_mask(periph);
|
|
|
+ DPORT_SET_PERI_REG_MASK(rst_en, mask);
|
|
|
+ DPORT_CLEAR_PERI_REG_MASK(rst_en, mask);
|
|
|
+ portEXIT_CRITICAL(&periph_spinlock);
|
|
|
+}
|
|
|
+
|
|
|
+static uint32_t get_clk_en_mask(periph_module_t periph)
|
|
|
+{
|
|
|
switch(periph) {
|
|
|
case PERIPH_RMT_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_RMT_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_RMT_RST);
|
|
|
- break;
|
|
|
+ return DPORT_RMT_CLK_EN;
|
|
|
case PERIPH_LEDC_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_LEDC_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_LEDC_RST);
|
|
|
- break;
|
|
|
+ return DPORT_LEDC_CLK_EN;
|
|
|
case PERIPH_UART0_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_UART_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_UART_RST);
|
|
|
- break;
|
|
|
+ return DPORT_UART_CLK_EN;
|
|
|
case PERIPH_UART1_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_UART1_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_UART1_RST);
|
|
|
- break;
|
|
|
+ return DPORT_UART1_CLK_EN;
|
|
|
case PERIPH_UART2_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_UART2_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_UART2_RST);
|
|
|
- break;
|
|
|
+ return DPORT_UART2_CLK_EN;
|
|
|
case PERIPH_I2C0_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_I2C_EXT0_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_I2C_EXT0_RST);
|
|
|
- break;
|
|
|
+ return DPORT_I2C_EXT0_CLK_EN;
|
|
|
case PERIPH_I2C1_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_I2C_EXT1_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_I2C_EXT1_RST);
|
|
|
- break;
|
|
|
+ return DPORT_I2C_EXT1_CLK_EN;
|
|
|
case PERIPH_I2S0_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_I2S0_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_I2S0_RST);
|
|
|
- break;
|
|
|
+ return DPORT_I2S0_CLK_EN;
|
|
|
case PERIPH_I2S1_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_I2S1_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_I2S1_RST);
|
|
|
- break;
|
|
|
+ return DPORT_I2S1_CLK_EN;
|
|
|
case PERIPH_TIMG0_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_TIMERGROUP_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_TIMERGROUP_RST);
|
|
|
- break;
|
|
|
+ return DPORT_TIMERGROUP_CLK_EN;
|
|
|
case PERIPH_TIMG1_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_TIMERGROUP1_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_TIMERGROUP1_RST);
|
|
|
- break;
|
|
|
+ return DPORT_TIMERGROUP1_CLK_EN;
|
|
|
case PERIPH_PWM0_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_PWM0_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_PWM0_RST);
|
|
|
- break;
|
|
|
+ return DPORT_PWM0_CLK_EN;
|
|
|
case PERIPH_PWM1_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_PWM1_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_PWM1_RST);
|
|
|
- break;
|
|
|
+ return DPORT_PWM1_CLK_EN;
|
|
|
case PERIPH_PWM2_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_PWM2_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_PWM2_RST);
|
|
|
- break;
|
|
|
+ return DPORT_PWM2_CLK_EN;
|
|
|
case PERIPH_PWM3_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_PWM3_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_PWM3_RST);
|
|
|
- break;
|
|
|
+ return DPORT_PWM3_CLK_EN;
|
|
|
case PERIPH_UHCI0_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_UHCI0_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_UHCI0_RST);
|
|
|
- break;
|
|
|
+ return DPORT_UHCI0_CLK_EN;
|
|
|
case PERIPH_UHCI1_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_UHCI1_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_UHCI1_RST);
|
|
|
- break;
|
|
|
+ return DPORT_UHCI1_CLK_EN;
|
|
|
case PERIPH_PCNT_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_PCNT_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_PCNT_RST);
|
|
|
- break;
|
|
|
+ return DPORT_PCNT_CLK_EN;
|
|
|
case PERIPH_SPI_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_SPI_CLK_EN_1);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_SPI_RST_1);
|
|
|
- break;
|
|
|
+ return DPORT_SPI_CLK_EN_1;
|
|
|
case PERIPH_HSPI_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_SPI_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_SPI_RST);
|
|
|
- break;
|
|
|
+ return DPORT_SPI_CLK_EN;
|
|
|
case PERIPH_VSPI_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_SPI_CLK_EN_2);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_SPI_RST_2);
|
|
|
- break;
|
|
|
+ return DPORT_SPI_CLK_EN_2;
|
|
|
case PERIPH_SPI_DMA_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_SPI_DMA_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_SPI_DMA_RST);
|
|
|
- break;
|
|
|
+ return DPORT_SPI_DMA_CLK_EN;
|
|
|
case PERIPH_SDMMC_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_WIFI_CLK_EN_REG, DPORT_WIFI_CLK_SDIO_HOST_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_CORE_RST_EN_REG, DPORT_SDIO_HOST_RST);
|
|
|
- break;
|
|
|
+ return DPORT_WIFI_CLK_SDIO_HOST_EN;
|
|
|
case PERIPH_SDIO_SLAVE_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_WIFI_CLK_EN_REG, DPORT_WIFI_CLK_SDIOSLAVE_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_CORE_RST_EN_REG, DPORT_SDIO_RST);
|
|
|
- break;
|
|
|
+ return DPORT_WIFI_CLK_SDIOSLAVE_EN;
|
|
|
case PERIPH_CAN_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_CAN_CLK_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_CAN_RST);
|
|
|
- break;
|
|
|
+ return DPORT_CAN_CLK_EN;
|
|
|
case PERIPH_EMAC_MODULE:
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_WIFI_CLK_EN_REG, DPORT_WIFI_CLK_EMAC_EN);
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_CORE_RST_EN_REG, DPORT_EMAC_RST);
|
|
|
- break;
|
|
|
+ return DPORT_WIFI_CLK_EMAC_EN;
|
|
|
default:
|
|
|
- break;
|
|
|
+ return 0;
|
|
|
}
|
|
|
- portEXIT_CRITICAL(&periph_spinlock);
|
|
|
}
|
|
|
|
|
|
-void periph_module_disable(periph_module_t periph)
|
|
|
+static uint32_t get_rst_en_mask(periph_module_t periph)
|
|
|
{
|
|
|
- portENTER_CRITICAL(&periph_spinlock);
|
|
|
switch(periph) {
|
|
|
case PERIPH_RMT_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_RMT_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_RMT_RST);
|
|
|
- break;
|
|
|
+ return DPORT_RMT_RST;
|
|
|
case PERIPH_LEDC_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_LEDC_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_LEDC_RST);
|
|
|
- break;
|
|
|
+ return DPORT_LEDC_RST;
|
|
|
case PERIPH_UART0_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_UART_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_UART_RST);
|
|
|
- break;
|
|
|
+ return DPORT_UART_RST;
|
|
|
case PERIPH_UART1_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_UART1_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_UART1_RST);
|
|
|
- break;
|
|
|
+ return DPORT_UART1_RST;
|
|
|
case PERIPH_UART2_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_UART2_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_UART2_RST);
|
|
|
- break;
|
|
|
+ return DPORT_UART2_RST;
|
|
|
case PERIPH_I2C0_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_I2C_EXT0_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_I2C_EXT0_RST);
|
|
|
- break;
|
|
|
+ return DPORT_I2C_EXT0_RST;
|
|
|
case PERIPH_I2C1_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_I2C_EXT0_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_I2C_EXT1_RST);
|
|
|
- break;
|
|
|
+ return DPORT_I2C_EXT1_RST;
|
|
|
case PERIPH_I2S0_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_I2S0_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_I2S0_RST);
|
|
|
- break;
|
|
|
+ return DPORT_I2S0_RST;
|
|
|
case PERIPH_I2S1_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_I2S1_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_I2S1_RST);
|
|
|
- break;
|
|
|
+ return DPORT_I2S1_RST;
|
|
|
case PERIPH_TIMG0_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_TIMERGROUP_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_TIMERGROUP_RST);
|
|
|
- break;
|
|
|
+ return DPORT_TIMERGROUP_RST;
|
|
|
case PERIPH_TIMG1_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_TIMERGROUP1_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_TIMERGROUP1_RST);
|
|
|
- break;
|
|
|
+ return DPORT_TIMERGROUP1_RST;
|
|
|
case PERIPH_PWM0_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_PWM0_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_PWM0_RST);
|
|
|
- break;
|
|
|
+ return DPORT_PWM0_RST;
|
|
|
case PERIPH_PWM1_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_PWM1_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_PWM1_RST);
|
|
|
- break;
|
|
|
+ return DPORT_PWM1_RST;
|
|
|
case PERIPH_PWM2_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_PWM2_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_PWM2_RST);
|
|
|
- break;
|
|
|
+ return DPORT_PWM2_RST;
|
|
|
case PERIPH_PWM3_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_PWM3_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_PWM3_RST);
|
|
|
- break;
|
|
|
+ return DPORT_PWM3_RST;
|
|
|
case PERIPH_UHCI0_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_UHCI0_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_UHCI0_RST);
|
|
|
- break;
|
|
|
+ return DPORT_UHCI0_RST;
|
|
|
case PERIPH_UHCI1_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_UHCI1_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_UHCI1_RST);
|
|
|
- break;
|
|
|
+ return DPORT_UHCI1_RST;
|
|
|
case PERIPH_PCNT_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_PCNT_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_PCNT_RST);
|
|
|
- break;
|
|
|
+ return DPORT_PCNT_RST;
|
|
|
case PERIPH_SPI_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_SPI_CLK_EN_1);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_SPI_RST_1);
|
|
|
- break;
|
|
|
+ return DPORT_SPI_RST_1;
|
|
|
case PERIPH_HSPI_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_SPI_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_SPI_RST);
|
|
|
- break;
|
|
|
+ return DPORT_SPI_RST;
|
|
|
case PERIPH_VSPI_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_SPI_CLK_EN_2);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_SPI_RST_2);
|
|
|
- break;
|
|
|
+ return DPORT_SPI_RST_2;
|
|
|
case PERIPH_SPI_DMA_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_SPI_DMA_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_SPI_DMA_RST);
|
|
|
- break;
|
|
|
+ return DPORT_SPI_DMA_RST;
|
|
|
case PERIPH_SDMMC_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_WIFI_CLK_EN_REG, DPORT_WIFI_CLK_SDIO_HOST_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_CORE_RST_EN_REG, DPORT_SDIO_HOST_RST);
|
|
|
- break;
|
|
|
+ return DPORT_WIFI_CLK_SDIO_HOST_EN;
|
|
|
case PERIPH_SDIO_SLAVE_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_WIFI_CLK_EN_REG, DPORT_WIFI_CLK_SDIOSLAVE_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_CORE_RST_EN_REG, DPORT_SDIO_RST);
|
|
|
- break;
|
|
|
+ return DPORT_WIFI_CLK_SDIOSLAVE_EN;
|
|
|
case PERIPH_CAN_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_PERIP_CLK_EN_REG, DPORT_CAN_CLK_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_PERIP_RST_EN_REG, DPORT_CAN_RST);
|
|
|
- break;
|
|
|
+ return DPORT_CAN_RST;
|
|
|
case PERIPH_EMAC_MODULE:
|
|
|
- DPORT_CLEAR_PERI_REG_MASK(DPORT_WIFI_CLK_EN_REG, DPORT_WIFI_CLK_EMAC_EN);
|
|
|
- DPORT_SET_PERI_REG_MASK(DPORT_CORE_RST_EN_REG, DPORT_EMAC_RST);
|
|
|
- break;
|
|
|
+ return DPORT_WIFI_CLK_EMAC_EN;
|
|
|
default:
|
|
|
- break;
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static bool is_wifi_clk_peripheral(periph_module_t periph)
|
|
|
+{
|
|
|
+ /* A small subset of peripherals use WIFI_CLK_EN_REG and
|
|
|
+ CORE_RST_EN_REG for their clock & reset registers */
|
|
|
+ switch(periph) {
|
|
|
+ case PERIPH_SDMMC_MODULE:
|
|
|
+ case PERIPH_SDIO_SLAVE_MODULE:
|
|
|
+ case PERIPH_EMAC_MODULE:
|
|
|
+ return true;
|
|
|
+ default:
|
|
|
+ return false;
|
|
|
}
|
|
|
- portEXIT_CRITICAL(&periph_spinlock);
|
|
|
}
|
|
|
+
|
|
|
+static uint32_t get_clk_en_reg(periph_module_t periph)
|
|
|
+{
|
|
|
+ return is_wifi_clk_peripheral(periph) ? DPORT_WIFI_CLK_EN_REG : DPORT_PERIP_CLK_EN_REG;
|
|
|
+}
|
|
|
+
|
|
|
+static uint32_t get_rst_en_reg(periph_module_t periph)
|
|
|
+{
|
|
|
+ return is_wifi_clk_peripheral(periph) ? DPORT_CORE_RST_EN_REG : DPORT_PERIP_RST_EN_REG;
|
|
|
+}
|
|
|
+
|
|
|
+
|