diff --git a/src/soc/mediatek/common/Kconfig b/src/soc/mediatek/common/Kconfig index 29cd2109f9..7411e483f1 100644 --- a/src/soc/mediatek/common/Kconfig +++ b/src/soc/mediatek/common/Kconfig @@ -34,4 +34,10 @@ config CLEAR_WDT_MODE_REG help Enable this option to clear WTD mode register explicitly. +config DPM_FOUR_CHANNEL + bool + default n + help + This option enables four channel configuration for DPM. + endif diff --git a/src/soc/mediatek/common/dpm.c b/src/soc/mediatek/common/dpm.c index 991441e74c..0bcf409399 100644 --- a/src/soc/mediatek/common/dpm.c +++ b/src/soc/mediatek/common/dpm.c @@ -5,16 +5,6 @@ #include #include -static void reset_dpm(struct mtk_mcu *mcu) -{ - /* write bootargs */ - write32(&mtk_dpm->twam_window_len, 0x0); - write32(&mtk_dpm->twam_mon_type, 0x0); - - /* free RST */ - setbits32(&mtk_dpm->sw_rstn, DPM_SW_RSTN_RESET); -} - static struct mtk_mcu dpm_mcu[] = { { .firmware_name = CONFIG_DPM_DM_FIRMWARE, @@ -23,15 +13,32 @@ static struct mtk_mcu dpm_mcu[] = { { .firmware_name = CONFIG_DPM_PM_FIRMWARE, .run_address = (void *)DPM_PM_SRAM_BASE, - .reset = reset_dpm, + .priv = mtk_dpm, + .reset = dpm_reset, }, }; +void dpm_reset(struct mtk_mcu *mcu) +{ + struct dpm_regs *dpm = mcu->priv; + + /* write bootargs */ + write32(&dpm->twam_window_len, 0x0); + write32(&dpm->twam_mon_type, 0x0); + + /* free RST */ + setbits32(&dpm->sw_rstn, DPM_SW_RSTN_RESET); +} + int dpm_init(void) { int i; struct mtk_mcu *dpm; + if (CONFIG(DPM_FOUR_CHANNEL)) + if (dpm_4ch_init()) + return -1; + /* config DPM SRAM layout */ clrsetbits32(&mtk_dpm->sw_rstn, DPM_MEM_RATIO_MASK, DPM_MEM_RATIO_CFG1); @@ -43,5 +50,9 @@ int dpm_init(void) return -1; } + if (CONFIG(DPM_FOUR_CHANNEL)) + if (dpm_4ch_para_setting()) + return -1; + return 0; } diff --git a/src/soc/mediatek/common/include/soc/dpm.h b/src/soc/mediatek/common/include/soc/dpm.h index 7262e09a6f..8c110aaaf1 100644 --- a/src/soc/mediatek/common/include/soc/dpm.h +++ b/src/soc/mediatek/common/include/soc/dpm.h @@ -1,9 +1,10 @@ /* SPDX-License-Identifier: GPL-2.0-only */ -#ifndef __SOC_MEDIATEK_DPM_H__ -#define __SOC_MEDIATEK_DPM_H__ +#ifndef __SOC_MEDIATEK_COMMON_DPM_H__ +#define __SOC_MEDIATEK_COMMON_DPM_H__ #include +#include #include #include @@ -41,9 +42,16 @@ check_member(dpm_regs, status_4, 0x70B0); #define DPM_MEM_RATIO_OFFSET 28 #define DPM_MEM_RATIO_MASK (0x3 << DPM_MEM_RATIO_OFFSET) #define DPM_MEM_RATIO_CFG1 (1 << DPM_MEM_RATIO_OFFSET) +#define DRAMC_MCU_SRAM_ISOINT_B_LSB BIT(1) +#define DRAMC_MCU2_SRAM_ISOINT_B_LSB BIT(1) +#define DRAMC_MCU_SRAM_SLEEP_B_LSB BIT(4) +#define DRAMC_MCU2_SRAM_SLEEP_B_LSB BIT(4) static struct dpm_regs *const mtk_dpm = (void *)DPM_CFG_BASE; +void dpm_reset(struct mtk_mcu *mcu); int dpm_init(void); +int dpm_4ch_para_setting(void); +int dpm_4ch_init(void); -#endif /* __SOC_MEDIATEK_MT8192_DPM_H__ */ +#endif /* __SOC_MEDIATEK_COMMON_DPM_H__ */