diff --git a/src/soc/mediatek/mt8195/Kconfig b/src/soc/mediatek/mt8195/Kconfig index 249d0877df..df1b5d8b47 100644 --- a/src/soc/mediatek/mt8195/Kconfig +++ b/src/soc/mediatek/mt8195/Kconfig @@ -10,6 +10,7 @@ config SOC_MEDIATEK_MT8195 select HAVE_UART_SPECIAL select SOC_MEDIATEK_COMMON select CLEAR_WDT_MODE_REG + select DPM_FOUR_CHANNEL if SOC_MEDIATEK_MT8195 diff --git a/src/soc/mediatek/mt8195/Makefile.inc b/src/soc/mediatek/mt8195/Makefile.inc index 48c8d32572..78766a9904 100644 --- a/src/soc/mediatek/mt8195/Makefile.inc +++ b/src/soc/mediatek/mt8195/Makefile.inc @@ -51,6 +51,8 @@ romstage-y += ../common/rtc.c ../common/rtc_osc_init.c ../common/rtc_mt6359p.c ramstage-y += ../common/auxadc.c ramstage-y += ../common/ddp.c ddp.c +ramstage-y += ../common/dpm.c +ramstage-$(CONFIG_DPM_FOUR_CHANNEL) += dpm_4ch.c ramstage-y += dp_intf.c dptx.c dptx_hal.c ramstage-y += emi.c ramstage-y += ../common/flash_controller.c diff --git a/src/soc/mediatek/mt8195/dpm_4ch.c b/src/soc/mediatek/mt8195/dpm_4ch.c new file mode 100644 index 0000000000..78895c8466 --- /dev/null +++ b/src/soc/mediatek/mt8195/dpm_4ch.c @@ -0,0 +1,89 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ + +#include +#include +#include +#include +#include +#include +#include + +static struct dpm_regs *const mtk_dpm2 = (void *)DPM_CFG_BASE2; + +static int wake_dpm_sram_up(void) +{ + int loop = 100; + + /* TODO: convert to new APIs (SET32_BITFIELDS/READ32_BITFIELD) */ + setbits32(&mtk_spm->dramc_mcu_sram_con, DRAMC_MCU_SRAM_SLEEP_B_LSB); + setbits32(&mtk_spm->dramc_mcu2_sram_con, DRAMC_MCU2_SRAM_SLEEP_B_LSB); + + while (loop > 0 && + ((read32(&mtk_spm->dramc_mcu_sram_con) & + DRAMC_MCU_SRAM_SLEEP_B_LSB) == 0 || + (read32(&mtk_spm->dramc_mcu2_sram_con) & + DRAMC_MCU2_SRAM_SLEEP_B_LSB) == 0)) { + mdelay(1); + --loop; + } + + if (loop == 0) { + printk(BIOS_ERR, "ERROR: failed to wake DPM up.\n"); + return -1; + } + + setbits32(&mtk_spm->dramc_mcu_sram_con, DRAMC_MCU_SRAM_ISOINT_B_LSB); + setbits32(&mtk_spm->dramc_mcu2_sram_con, DRAMC_MCU2_SRAM_ISOINT_B_LSB); + + return 0; +} + +static void dpm_mtcoms_sleep_on(void) +{ + /* DPM MTCMOS sleep on */ + write32(&mtk_spm->dpm0_pwr_con, 0x0000204d); + write32(&mtk_spm->dpm1_pwr_con, 0x0000204d); + mdelay(1); + write32(&mtk_spm->dpm0_pwr_con, 0x0000224d); + write32(&mtk_spm->dpm1_pwr_con, 0x0000224d); + mdelay(1); + clrbits32(&mtk_dpm->sw_rstn, DPM_SW_RSTN_RESET); + clrbits32(&mtk_dpm2->sw_rstn, DPM_SW_RSTN_RESET); +} + +static struct mtk_mcu dpm_mcu_4ch[] = { + { + .firmware_name = CONFIG_DPM_DM_FIRMWARE, + .run_address = (void *)DPM_DM_SRAM_BASE2, + }, + { + .firmware_name = CONFIG_DPM_PM_FIRMWARE, + .run_address = (void *)DPM_PM_SRAM_BASE2, + .priv = mtk_dpm2, + .reset = dpm_reset, + }, +}; + +int dpm_4ch_init(void) +{ + dpm_mtcoms_sleep_on(); + if (wake_dpm_sram_up()) + return -1; + return 0; +} + +int dpm_4ch_para_setting(void) +{ + int i; + struct mtk_mcu *dpm; + + for (i = 0; i < ARRAY_SIZE(dpm_mcu_4ch); i++) { + dpm = &dpm_mcu_4ch[i]; + dpm->load_buffer = _dram_dma; + dpm->buffer_size = REGION_SIZE(dram_dma); + if (mtk_init_mcu(dpm)) + return -1; + } + + return 0; +}