From: Teo Hall <teo.h...@nxp.com>

This patch adds V2X container support on i.MX95.
Signed-off-by: Ye Li <ye...@nxp.com>
Signed-off-by: Teo Hall <teo.h...@nxp.com>
Signed-off-by: Alice Guo <alice....@nxp.com>
---
 arch/arm/mach-imx/image-container.c | 63 +++++++++++++++++++++++--------------
 1 file changed, 40 insertions(+), 23 deletions(-)

diff --git a/arch/arm/mach-imx/image-container.c 
b/arch/arm/mach-imx/image-container.c
index 
2afe9d38a0681862098a6566a873873f24069b88..54ae7721888dbc93fdaba8e5aedc52c4506bb1c1
 100644
--- a/arch/arm/mach-imx/image-container.c
+++ b/arch/arm/mach-imx/image-container.c
@@ -231,45 +231,62 @@ static unsigned long get_boot_device_offset(void *dev, 
int dev_type)
        return offset;
 }
 
-static int get_imageset_end(void *dev, int dev_type)
+static ulong get_imageset_end(void *dev, int dev_type)
 {
-       unsigned long offset1 = 0, offset2 = 0;
-       int value_container[2];
+       unsigned long offset[3] = {};
+       int value_container[3] = {};
        u16 hdr_length;
 
-       offset1 = get_boot_device_offset(dev, dev_type);
-       offset2 = CONTAINER_HDR_ALIGNMENT + offset1;
+       offset[0] = get_boot_device_offset(dev, dev_type);
 
-       value_container[0] = get_dev_container_size(dev, dev_type, offset1, 
&hdr_length);
+       value_container[0] = get_dev_container_size(dev, dev_type, offset[0], 
&hdr_length);
        if (value_container[0] < 0) {
                printf("Parse seco container failed %d\n", value_container[0]);
-               return value_container[0];
+               return 0;
        }
 
        debug("seco container size 0x%x\n", value_container[0]);
 
-       value_container[1] = get_dev_container_size(dev, dev_type, offset2, 
&hdr_length);
-       if (value_container[1] < 0) {
-               debug("Parse scu container failed %d, only seco container\n",
-                     value_container[1]);
-               /* return seco container total size */
-               return value_container[0] + offset1;
+       if (is_imx95()) {
+               offset[1] = ALIGN(hdr_length, CONTAINER_HDR_ALIGNMENT) + 
offset[0];
+
+               value_container[1] = get_dev_container_size(dev, dev_type, 
offset[1], &hdr_length);
+               if (value_container[1] < 0) {
+                       printf("Parse v2x container failed %d\n", 
value_container[1]);
+                       return value_container[0] + offset[0]; /* return seco 
container total size */
+               }
+
+               debug("v2x container size 0x%x\n", value_container[1]);
+
+               offset[2] = ALIGN(hdr_length, CONTAINER_HDR_ALIGNMENT) + 
offset[1];
+       } else {
+               /* Skip offset[1] */
+               offset[2] = ALIGN(hdr_length, CONTAINER_HDR_ALIGNMENT) + 
offset[0];
        }
 
-       debug("scu container size 0x%x\n", value_container[1]);
+       value_container[2] = get_dev_container_size(dev, dev_type, offset[2], 
&hdr_length);
+       if (value_container[2] < 0) {
+               debug("Parse scu container image failed %d, only seco 
container\n", value_container[2]);
+               if (is_imx95())
+                       return value_container[1] + offset[1]; /* return seco + 
v2x container total size */
+               else
+                       return value_container[0] + offset[0]; /* return seco 
container total size */
+       }
 
-       return value_container[1] + offset2;
+       debug("scu container size 0x%x\n", value_container[2]);
+
+       return value_container[2] + offset[2];
 }
 
 #ifdef CONFIG_SPL_SPI_LOAD
 unsigned int spl_spi_get_uboot_offs(struct spi_flash *flash)
 {
-       int end;
+       ulong end;
 
        end = get_imageset_end(flash, QSPI_DEV);
        end = ROUND(end, SZ_1K);
 
-       printf("Load image from QSPI 0x%x\n", end);
+       printf("Load image from QSPI 0x%lx\n", end);
 
        return end;
 }
@@ -279,12 +296,12 @@ unsigned int spl_spi_get_uboot_offs(struct spi_flash 
*flash)
 unsigned long arch_spl_mmc_get_uboot_raw_sector(struct mmc *mmc,
                                                unsigned long raw_sect)
 {
-       int end;
+       ulong end;
 
        end = get_imageset_end(mmc, MMC_DEV);
        end = ROUND(end, SZ_1K);
 
-       printf("Load image from MMC/SD 0x%x\n", end);
+       printf("Load image from MMC/SD 0x%lx\n", end);
 
        return end / mmc->read_bl_len;
 }
@@ -312,12 +329,12 @@ int spl_mmc_emmc_boot_partition(struct mmc *mmc)
 #ifdef CONFIG_SPL_NAND_SUPPORT
 uint32_t spl_nand_get_uboot_raw_page(void)
 {
-       int end;
+       ulong end;
 
        end = get_imageset_end((void *)NULL, NAND_DEV);
        end = ROUND(end, SZ_16K);
 
-       printf("Load image from NAND 0x%x\n", end);
+       printf("Load image from NAND 0x%lx\n", end);
 
        return end;
 }
@@ -326,7 +343,7 @@ uint32_t spl_nand_get_uboot_raw_page(void)
 #ifdef CONFIG_SPL_NOR_SUPPORT
 unsigned long spl_nor_get_uboot_base(void)
 {
-       int end;
+       ulong end;
 
        /* Calculate the image set end,
         * if it is less than CFG_SYS_UBOOT_BASE(0x8281000),
@@ -339,7 +356,7 @@ unsigned long spl_nor_get_uboot_base(void)
        else
                end = ROUND(end, SZ_1K);
 
-       printf("Load image from NOR 0x%x\n", end);
+       printf("Load image from NOR 0x%lx\n", end);
 
        return end;
 }

-- 
2.34.1

Reply via email to