soc/mediatek/mt8195: Support 4 channel DRAM in DPM init flow

Signed-off-by: Ryan Chuang <ryan.chuang@mediatek.corp-partner.google.com>
Change-Id: If2e9d8a4dcfad28c48a2b5fa7c92f70fae879e67
Reviewed-on: https://review.coreboot.org/c/coreboot/+/55749
Tested-by: build bot (Jenkins) <no-reply@coreboot.org>
Reviewed-by: Yu-Ping Wu <yupingso@google.com>

3 files changed, 92 insertions, 0 deletions

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 <console/console.h>
+#include <delay.h>
+#include <device/mmio.h>
+#include <soc/dpm.h>
+#include <soc/dramc_soc.h>
+#include <soc/spm.h>
+#include <soc/symbols.h>
+
+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;
+}