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;