From 80373767ed5a74867d92408ca572483f58ef7ff5 Mon Sep 17 00:00:00 2001 From: Rex-BC Chen Date: Tue, 1 Jun 2021 11:22:32 +0800 Subject: [PATCH] soc/mediatek: Extract spm_parse_firmware to common spm_parse_firmware can be shared by MT8192 and MT8195. TEST=emerge-asurada coreboot; Signed-off-by: Rex-BC Chen Change-Id: I54d9672aa9ee9078ec9fe3fa4f2e9fe860a50636 Reviewed-on: https://review.coreboot.org/c/coreboot/+/55139 Reviewed-by: Rex-BC Chen Reviewed-by: Yu-Ping Wu Tested-by: build bot (Jenkins) --- .../mediatek/common/include/soc/spm_common.h | 9 +++ src/soc/mediatek/common/spm.c | 55 +++++++++++++++++++ src/soc/mediatek/mt8192/Makefile.inc | 2 +- src/soc/mediatek/mt8192/spm.c | 46 +--------------- 4 files changed, 66 insertions(+), 46 deletions(-) create mode 100644 src/soc/mediatek/common/include/soc/spm_common.h create mode 100644 src/soc/mediatek/common/spm.c diff --git a/src/soc/mediatek/common/include/soc/spm_common.h b/src/soc/mediatek/common/include/soc/spm_common.h new file mode 100644 index 0000000000..43c4dcf46e --- /dev/null +++ b/src/soc/mediatek/common/include/soc/spm_common.h @@ -0,0 +1,9 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ + +#ifndef SOC_MEDIATEK_SPM_COMMON_H +#define SOC_MEDIATEK_SPM_COMMON_H + +#include + +void spm_parse_firmware(struct mtk_mcu *mcu); +#endif /* SOC_MEDIATEK_SPM_COMMON_H */ diff --git a/src/soc/mediatek/common/spm.c b/src/soc/mediatek/common/spm.c new file mode 100644 index 0000000000..48f75fe661 --- /dev/null +++ b/src/soc/mediatek/common/spm.c @@ -0,0 +1,55 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ + +#include +#include +#include +#include +#include +#include +#include + +#define SPMFW_HEADER_SIZE 16 + +void spm_parse_firmware(struct mtk_mcu *mcu) +{ + size_t file_size, copy_size; + int offset; + u16 firmware_size; + + struct dyna_load_pcm *pcm = (struct dyna_load_pcm *)mcu->priv; + file_size = mcu->run_size; + + /* + * spmfw layout: + * u16 firmware_size + * u32 binary[firmware_size] + * struct pcm_desc descriptor + * char *version + */ + + /* Firmware size */ + offset = 0; + copy_size = sizeof(firmware_size); + memcpy(&firmware_size, mcu->load_buffer + offset, copy_size); + printk(BIOS_DEBUG, "SPM: binary array size = %#x\n", firmware_size); + + /* Binary */ + offset = SPMFW_HEADER_SIZE; /* binary start offset */ + copy_size = firmware_size * sizeof(u32); + assert(offset < file_size); + pcm->buf = (u8 *)(mcu->load_buffer + offset); + + /* Descriptor */ + offset += copy_size; + assert(offset < file_size); + copy_size = sizeof(pcm->desc); + memcpy(&pcm->desc, mcu->load_buffer + offset, copy_size); + + /* Firmware size and total words need to be the same */ + assert(firmware_size == pcm->desc.total_words); + + /* Version */ + offset += copy_size; + assert(offset < file_size); + printk(BIOS_INFO, "SPM: spmfw (version %s)\n", (u8 *)mcu->load_buffer + offset); +} diff --git a/src/soc/mediatek/mt8192/Makefile.inc b/src/soc/mediatek/mt8192/Makefile.inc index 0943e7c87d..e5043597d0 100644 --- a/src/soc/mediatek/mt8192/Makefile.inc +++ b/src/soc/mediatek/mt8192/Makefile.inc @@ -60,7 +60,7 @@ ramstage-y += ../common/mtcmos.c mtcmos.c ramstage-y += ../common/pmif.c ramstage-y += ../common/rtc.c ../common/rtc_mt6359p.c ramstage-y += soc.c -ramstage-y += spm.c +ramstage-y += ../common/spm.c spm.c ramstage-y += ../common/sspm.c ramstage-y += ../common/timer.c ramstage-y += ../common/uart.c diff --git a/src/soc/mediatek/mt8192/spm.c b/src/soc/mediatek/mt8192/spm.c index 13eebc8a81..3a444dfcf3 100644 --- a/src/soc/mediatek/mt8192/spm.c +++ b/src/soc/mediatek/mt8192/spm.c @@ -6,12 +6,12 @@ #include #include #include +#include #include #include #include #define SPM_SYSTEM_BASE_OFFSET 0x40000000 -#define SPMFW_HEADER_SIZE 16 static const struct pwr_ctrl spm_init_ctrl = { /* Auto-gen Start */ @@ -476,50 +476,6 @@ static void spm_init_pcm_register(void) write32(&mtk_spm->pcm_pwr_io_en, 0); } -static void spm_parse_firmware(struct mtk_mcu *mcu) -{ - size_t file_size, copy_size; - int offset; - u16 firmware_size; - - struct dyna_load_pcm *pcm = (struct dyna_load_pcm *)mcu->priv; - file_size = mcu->run_size; - - /* - * spmfw layout: - * u16 firmware_size - * u32 binary[firmware_size] - * struct pcm_desc descriptor - * char *version - */ - - /* Firmware size */ - offset = 0; - copy_size = sizeof(firmware_size); - memcpy(&firmware_size, mcu->load_buffer + offset, copy_size); - printk(BIOS_DEBUG, "SPM: binary array size = %#x\n", firmware_size); - - /* Binary */ - offset = SPMFW_HEADER_SIZE; /* binary start offset */ - copy_size = firmware_size * sizeof(u32); - assert(offset < file_size); - pcm->buf = (u8 *)(mcu->load_buffer + offset); - - /* Descriptor */ - offset += copy_size; - assert(offset < file_size); - copy_size = sizeof(pcm->desc); - memcpy(&pcm->desc, mcu->load_buffer + offset, copy_size); - - /* Firmware size and total words need to be the same */ - assert(firmware_size == pcm->desc.total_words); - - /* Version */ - offset += copy_size; - assert(offset < file_size); - printk(BIOS_INFO, "SPM: spmfw (version %s)\n", (u8 *)mcu->load_buffer + offset); -} - static void spm_set_wakeup_event(const struct pwr_ctrl *pwrctrl) { u32 val, mask;