At an helper to load_and_start the image on arbitrary load addresses. This should be taken with caution since it requires to configure the TF-A correctly as well, therefore the functions are prefixt with '__'. One use case of the new helper is to place OP-TEE at the very beginning of the DRAM and barebox afterwards e.g. if multiple DRAM setups are required for the platform/som-family. A nice side effect of this change is to bundle the usage of MX8M*_ATF_BL33_BASE_ADDR at a single place. Signed-off-by: Marco Felsch <m.felsch@xxxxxxxxxxxxxx> --- arch/arm/mach-imx/atf.c | 42 +++++++++++++++++++++++----------- arch/arm/mach-imx/romapi.c | 15 ++++++------ arch/arm/mach-imx/xload-qspi.c | 18 +++++++-------- drivers/mci/imx-esdhc-pbl.c | 13 ++++++----- include/mach/imx/romapi.h | 4 ++-- include/mach/imx/xload.h | 17 +++++++++----- 6 files changed, 65 insertions(+), 44 deletions(-) diff --git a/arch/arm/mach-imx/atf.c b/arch/arm/mach-imx/atf.c index eef3235b84f9..a976459aee56 100644 --- a/arch/arm/mach-imx/atf.c +++ b/arch/arm/mach-imx/atf.c @@ -66,7 +66,7 @@ void imx8mm_load_bl33(void *bl33) imx8mm_get_boot_source(&src, &instance); switch (src) { case BOOTSOURCE_MMC: - imx8m_esdhc_load_image(instance, false); + imx8m_esdhc_load_image(instance, false, bl33); break; case BOOTSOURCE_SERIAL: if (!IS_ENABLED(CONFIG_USB_GADGET_DRIVER_ARC_PBL)) { @@ -99,7 +99,7 @@ void imx8mm_load_bl33(void *bl33) break; case BOOTSOURCE_SPI: - imx8mm_qspi_load_image(instance, false); + imx8mm_qspi_load_image(instance, false, bl33); break; default: printf("Unsupported bootsource BOOTSOURCE_%d\n", src); @@ -136,10 +136,14 @@ static void imx_adjust_optee_memory(void **bl32, void **bl32_image, size_t *bl32 } __noreturn void imx8mm_load_and_start_image_via_tfa(void) +{ + __imx8mm_load_and_start_image_via_tfa((void *)MX8M_ATF_BL33_BASE_ADDR); +} + +__noreturn void __imx8mm_load_and_start_image_via_tfa(void *bl33) { const void *bl31; size_t bl31_size; - void *bl33 = (void *)MX8M_ATF_BL33_BASE_ADDR; unsigned long endmem = MX8M_DDR_CSD1_BASE_ADDR + imx8m_barebox_earlymem_size(32); imx8mm_init_scratch_space(); @@ -176,13 +180,13 @@ void imx8mp_load_bl33(void *bl33) imx8mp_get_boot_source(&src, &instance); switch (src) { case BOOTSOURCE_MMC: - imx8mp_esdhc_load_image(instance, false); + imx8mp_esdhc_load_image(instance, false, bl33); break; case BOOTSOURCE_SERIAL: - imx8mp_romapi_load_image(); + imx8mp_romapi_load_image(bl33); break; case BOOTSOURCE_SPI: - imx8mp_qspi_load_image(instance, false); + imx8mp_qspi_load_image(instance, false, bl33); break; default: printf("Unhandled bootsource BOOTSOURCE_%d\n", src); @@ -202,10 +206,14 @@ void imx8mp_load_bl33(void *bl33) } __noreturn void imx8mp_load_and_start_image_via_tfa(void) +{ + __imx8mp_load_and_start_image_via_tfa((void *)MX8M_ATF_BL33_BASE_ADDR); +} + +__noreturn void __imx8mp_load_and_start_image_via_tfa(void *bl33) { const void *bl31; size_t bl31_size; - void *bl33 = (void *)MX8M_ATF_BL33_BASE_ADDR; unsigned long endmem = MX8M_DDR_CSD1_BASE_ADDR + imx8m_barebox_earlymem_size(32); imx8mp_init_scratch_space(); @@ -243,13 +251,13 @@ void imx8mn_load_bl33(void *bl33) imx8mn_get_boot_source(&src, &instance); switch (src) { case BOOTSOURCE_MMC: - imx8mn_esdhc_load_image(instance, false); + imx8mn_esdhc_load_image(instance, false, bl33); break; case BOOTSOURCE_SERIAL: - imx8mn_romapi_load_image(); + imx8mn_romapi_load_image(bl33); break; case BOOTSOURCE_SPI: - imx8mn_qspi_load_image(instance, false); + imx8mn_qspi_load_image(instance, false, bl33); break; default: printf("Unhandled bootsource BOOTSOURCE_%d\n", src); @@ -269,10 +277,14 @@ void imx8mn_load_bl33(void *bl33) } __noreturn void imx8mn_load_and_start_image_via_tfa(void) +{ + __imx8mn_load_and_start_image_via_tfa((void *)MX8M_ATF_BL33_BASE_ADDR); +} + +__noreturn void __imx8mn_load_and_start_image_via_tfa(void *bl33) { const void *bl31; size_t bl31_size; - void *bl33 = (void *)MX8M_ATF_BL33_BASE_ADDR; unsigned long endmem = MX8M_DDR_CSD1_BASE_ADDR + imx8m_barebox_earlymem_size(16); imx8mn_init_scratch_space(); @@ -309,7 +321,7 @@ void imx8mq_load_bl33(void *bl33) imx8mn_get_boot_source(&src, &instance); switch (src) { case BOOTSOURCE_MMC: - imx8m_esdhc_load_image(instance, false); + imx8m_esdhc_load_image(instance, false, bl33); break; default: printf("Unhandled bootsource BOOTSOURCE_%d\n", src); @@ -329,10 +341,14 @@ void imx8mq_load_bl33(void *bl33) } __noreturn void imx8mq_load_and_start_image_via_tfa(void) +{ + __imx8mq_load_and_start_image_via_tfa((void *)MX8M_ATF_BL33_BASE_ADDR); +} + +__noreturn void __imx8mq_load_and_start_image_via_tfa(void *bl33) { const void *bl31; size_t bl31_size; - void *bl33 = (void *)MX8M_ATF_BL33_BASE_ADDR; unsigned long endmem = MX8M_DDR_CSD1_BASE_ADDR + imx8m_barebox_earlymem_size(32); imx8mq_init_scratch_space(); diff --git a/arch/arm/mach-imx/romapi.c b/arch/arm/mach-imx/romapi.c index a245357fdf5d..797b479c3e91 100644 --- a/arch/arm/mach-imx/romapi.c +++ b/arch/arm/mach-imx/romapi.c @@ -79,25 +79,24 @@ static int imx_romapi_load_seekable(struct rom_api *rom_api, void *adr, uint32_t } /* read piggydata via a bootrom callback and place it behind our copy in SDRAM */ -static int imx_romapi_load_image(struct rom_api *rom_api) +static int imx_romapi_load_image(struct rom_api *rom_api, void *bl33) { - return imx_romapi_load_stream(rom_api, - (void *)MX8M_ATF_BL33_BASE_ADDR + barebox_pbl_size, - __image_end - __piggydata_start); + return imx_romapi_load_stream(rom_api, bl33 + barebox_pbl_size, + __image_end - __piggydata_start); } -int imx8mp_romapi_load_image(void) +int imx8mp_romapi_load_image(void *bl33) { struct rom_api *rom_api = (void *)0x980; OPTIMIZER_HIDE_VAR(rom_api); - return imx_romapi_load_image(rom_api); + return imx_romapi_load_image(rom_api, bl33); } -int imx8mn_romapi_load_image(void) +int imx8mn_romapi_load_image(void *bl33) { - return imx8mp_romapi_load_image(); + return imx8mp_romapi_load_image(bl33); } static int imx_romapi_boot_device_seekable(struct rom_api *rom_api) diff --git a/arch/arm/mach-imx/xload-qspi.c b/arch/arm/mach-imx/xload-qspi.c index 6bf5bba5e69d..fe7aa9c7bb46 100644 --- a/arch/arm/mach-imx/xload-qspi.c +++ b/arch/arm/mach-imx/xload-qspi.c @@ -34,24 +34,24 @@ int imx8m_qspi_read(void *dest, size_t len, void *priv) * or 0. A negative error code is returned when this function fails. */ static -int imx8m_qspi_load_image(int instance, bool start, off_t offset, off_t ivt_offset) +int imx8m_qspi_load_image(int instance, bool start, off_t offset, off_t ivt_offset, + void *bl33) { void __iomem *qspi_ahb = IOMEM(IMX8M_QSPI_MMAP); - return imx_load_image(MX8M_DDR_CSD1_BASE_ADDR, MX8M_ATF_BL33_BASE_ADDR, - offset, ivt_offset, start, 0, - imx8m_qspi_read, qspi_ahb); + return imx_load_image(MX8M_DDR_CSD1_BASE_ADDR, (ptrdiff_t)bl33, offset, + ivt_offset, start, 0, imx8m_qspi_read, qspi_ahb); } -int imx8mm_qspi_load_image(int instance, bool start) +int imx8mm_qspi_load_image(int instance, bool start, void *bl33) { - return imx8m_qspi_load_image(instance, start, 0, SZ_4K); + return imx8m_qspi_load_image(instance, start, 0, SZ_4K, bl33); } -int imx8mn_qspi_load_image(int instance, bool start) +int imx8mn_qspi_load_image(int instance, bool start, void *bl33) { - return imx8m_qspi_load_image(instance, start, SZ_4K, 0); + return imx8m_qspi_load_image(instance, start, SZ_4K, 0, bl33); } -int imx8mp_qspi_load_image(int instance, bool start) +int imx8mp_qspi_load_image(int instance, bool start, void *bl33) __alias(imx8mn_qspi_load_image); diff --git a/drivers/mci/imx-esdhc-pbl.c b/drivers/mci/imx-esdhc-pbl.c index 892329de512a..5cf81eeffb1a 100644 --- a/drivers/mci/imx-esdhc-pbl.c +++ b/drivers/mci/imx-esdhc-pbl.c @@ -240,6 +240,7 @@ int imx7_esdhc_start_image(int instance) * imx8m_esdhc_load_image - Load and optionally start an image from USDHC controller * @instance: The USDHC controller instance (0..2) * @start: Whether to directly start the loaded image + * @bl33: Where to load the bl33 barebox image * * This uses esdhc_start_image() to load an image from SD/MMC. It is * assumed that the image is the currently running barebox image (This @@ -249,7 +250,7 @@ int imx7_esdhc_start_image(int instance) * Return: If successful, this function does not return (if directly started) * or 0. A negative error code is returned when this function fails. */ -int imx8m_esdhc_load_image(int instance, bool start) +int imx8m_esdhc_load_image(int instance, bool start, void *bl33) { struct esdhc_soc_data data; struct fsl_esdhc_host host = { 0 }; @@ -260,14 +261,14 @@ int imx8m_esdhc_load_image(int instance, bool start) return ret; return esdhc_load_image(&host, MX8M_DDR_CSD1_BASE_ADDR, - MX8MQ_ATF_BL33_BASE_ADDR, SZ_32K, SZ_1K, - start); + (ptrdiff_t)bl33, SZ_32K, SZ_1K, start); } /** * imx8mp_esdhc_load_image - Load and optionally start an image from USDHC controller * @instance: The USDHC controller instance (0..2) * @start: Whether to directly start the loaded image + * @bl33: Where to load the bl33 barebox image * * This uses esdhc_start_image() to load an image from SD/MMC. It is * assumed that the image is the currently running barebox image (This @@ -277,7 +278,7 @@ int imx8m_esdhc_load_image(int instance, bool start) * Return: If successful, this function does not return (if directly started) * or 0. A negative error code is returned when this function fails. */ -int imx8mp_esdhc_load_image(int instance, bool start) +int imx8mp_esdhc_load_image(int instance, bool start, void *bl33) { struct esdhc_soc_data data; struct fsl_esdhc_host host = { 0 }; @@ -291,10 +292,10 @@ int imx8mp_esdhc_load_image(int instance, bool start) offset = esdhc_bootpart_active(&host)? 0 : SZ_32K; return esdhc_load_image(&host, MX8M_DDR_CSD1_BASE_ADDR, - MX8MQ_ATF_BL33_BASE_ADDR, offset, 0, start); + (ptrdiff_t)bl33, offset, 0, start); } -int imx8mn_esdhc_load_image(int instance, bool start) +int imx8mn_esdhc_load_image(int instance, bool start, void *bl33) __alias(imx8mp_esdhc_load_image); #endif diff --git a/include/mach/imx/romapi.h b/include/mach/imx/romapi.h index b1a990085088..de5881001c02 100644 --- a/include/mach/imx/romapi.h +++ b/include/mach/imx/romapi.h @@ -35,8 +35,8 @@ enum boot_dev_type_e { #define ROM_API_OKAY 0xF0 -int imx8mp_romapi_load_image(void); -int imx8mn_romapi_load_image(void); +int imx8mp_romapi_load_image(void *bl33); +int imx8mn_romapi_load_image(void *bl33); int imx93_romapi_load_image(void); /* only call after DRAM has been configured */ diff --git a/include/mach/imx/xload.h b/include/mach/imx/xload.h index 965e73772ceb..49e38f8c1dd3 100644 --- a/include/mach/imx/xload.h +++ b/include/mach/imx/xload.h @@ -14,12 +14,12 @@ int imx6_esdhc_start_image(int instance); int imx6_nand_start_image(void); int imx7_esdhc_start_image(int instance); int imx7_nand_start_image(void); -int imx8m_esdhc_load_image(int instance, bool start); -int imx8mn_esdhc_load_image(int instance, bool start); -int imx8mp_esdhc_load_image(int instance, bool start); -int imx8mm_qspi_load_image(int instance, bool start); -int imx8mn_qspi_load_image(int instance, bool start); -int imx8mp_qspi_load_image(int instance, bool start); +int imx8m_esdhc_load_image(int instance, bool start, void *bl33); +int imx8mn_esdhc_load_image(int instance, bool start, void *bl33); +int imx8mp_esdhc_load_image(int instance, bool start, void *bl33); +int imx8mm_qspi_load_image(int instance, bool start, void *bl33); +int imx8mn_qspi_load_image(int instance, bool start, void *bl33); +int imx8mp_qspi_load_image(int instance, bool start, void *bl33); void imx8mm_load_bl33(void *bl33); void imx8mn_load_bl33(void *bl33); @@ -30,6 +30,11 @@ void __noreturn imx8mm_load_and_start_image_via_tfa(void); void __noreturn imx8mn_load_and_start_image_via_tfa(void); void __noreturn imx8mp_load_and_start_image_via_tfa(void); void __noreturn imx8mq_load_and_start_image_via_tfa(void); +void __noreturn __imx8mm_load_and_start_image_via_tfa(void *bl33); +void __noreturn __imx8mn_load_and_start_image_via_tfa(void *bl33); +void __noreturn __imx8mp_load_and_start_image_via_tfa(void *bl33); +void __noreturn __imx8mq_load_and_start_image_via_tfa(void *bl33); + void __noreturn imx93_load_and_start_image_via_tfa(void); int imx_load_image(ptrdiff_t address, ptrdiff_t entry, u32 offset, -- 2.39.2