mmc: fsl_esdhc_spl: pre-PBL: implement redundancy support

QorIQ pre-PBL BootROM scans first 24 SD card sectors (each with fixed 512
bytes length) for boot signature. Implement same redundancy behavior in
fsl_esdhc_spl driver to allow loading proper U-Boot when boot sector is not
the first one.

Signed-off-by: Pali Rohár <pali@kernel.org>
Reviewed-by: Priyanka Jain <priyanka.jain@nxp.com>
This commit is contained in:
Pali Rohár 2022-04-04 18:33:11 +02:00 committed by Priyanka Jain
parent 44564e79eb
commit 0980cbba7b

View file

@ -20,7 +20,6 @@
#define ESDHC_BOOT_IMAGE_ADDR 0x50 #define ESDHC_BOOT_IMAGE_ADDR 0x50
#define MBRDBR_BOOT_SIG_55 0x1fe #define MBRDBR_BOOT_SIG_55 0x1fe
#define MBRDBR_BOOT_SIG_AA 0x1ff #define MBRDBR_BOOT_SIG_AA 0x1ff
#define CONFIG_CFG_DATA_SECTOR 0
void mmc_spl_load_image(uint32_t offs, unsigned int size, void *vdst) void mmc_spl_load_image(uint32_t offs, unsigned int size, void *vdst)
@ -62,11 +61,13 @@ void __noreturn mmc_boot(void)
#ifndef CONFIG_FSL_CORENET #ifndef CONFIG_FSL_CORENET
uchar *tmp_buf; uchar *tmp_buf;
u32 blklen; u32 blklen;
u32 blk_off;
uchar val; uchar val;
#ifndef CONFIG_SPL_FSL_PBL #ifndef CONFIG_SPL_FSL_PBL
u32 val32; u32 val32;
#endif #endif
uint i, byte_num; uint i, byte_num;
u32 sector;
#endif #endif
u32 offset, code_len; u32 offset, code_len;
struct mmc *mmc; struct mmc *mmc;
@ -86,30 +87,37 @@ void __noreturn mmc_boot(void)
offset = CONFIG_SYS_MMC_U_BOOT_OFFS; offset = CONFIG_SYS_MMC_U_BOOT_OFFS;
#else #else
blklen = mmc->read_bl_len; blklen = mmc->read_bl_len;
if (blklen < 512)
blklen = 512;
tmp_buf = malloc(blklen); tmp_buf = malloc(blklen);
if (!tmp_buf) { if (!tmp_buf) {
puts("spl: malloc memory failed!!\n"); puts("spl: malloc memory failed!!\n");
hang(); hang();
} }
sector = 0;
again:
memset(tmp_buf, 0, blklen); memset(tmp_buf, 0, blklen);
/* /*
* Read source addr from sd card * Read source addr from sd card
*/ */
err = mmc->block_dev.block_read(&mmc->block_dev, blk_start = (sector * 512) / mmc->read_bl_len;
CONFIG_CFG_DATA_SECTOR, 1, tmp_buf); blk_off = (sector * 512) % mmc->read_bl_len;
blk_cnt = DIV_ROUND_UP(512, mmc->read_bl_len);
err = mmc->block_dev.block_read(&mmc->block_dev, blk_start, blk_cnt, tmp_buf);
if (err != 1) { if (err != 1) {
puts("spl: mmc read failed!!\n"); puts("spl: mmc read failed!!\n");
hang(); hang();
} }
#ifdef CONFIG_SPL_FSL_PBL #ifdef CONFIG_SPL_FSL_PBL
val = *(tmp_buf + MBRDBR_BOOT_SIG_55); val = *(tmp_buf + blk_off + MBRDBR_BOOT_SIG_55);
if (0x55 != val) { if (0x55 != val) {
puts("spl: mmc MBR/DBR signature is not valid!!\n"); puts("spl: mmc MBR/DBR signature is not valid!!\n");
hang(); hang();
} }
val = *(tmp_buf + MBRDBR_BOOT_SIG_AA); val = *(tmp_buf + blk_off + MBRDBR_BOOT_SIG_AA);
if (0xAA != val) { if (0xAA != val) {
puts("spl: mmc MBR/DBR signature is not valid!!\n"); puts("spl: mmc MBR/DBR signature is not valid!!\n");
hang(); hang();
@ -123,10 +131,13 @@ void __noreturn mmc_boot(void)
byte_num = 4; byte_num = 4;
val32 = 0; val32 = 0;
for (i = 0; i < byte_num; i++) { for (i = 0; i < byte_num; i++) {
val = *(tmp_buf + ESDHC_BOOT_SIGNATURE_OFF + i); val = *(tmp_buf + blk_off + ESDHC_BOOT_SIGNATURE_OFF + i);
val32 = (val32 << 8) + val; val32 = (val32 << 8) + val;
} }
if (val32 != ESDHC_BOOT_SIGNATURE) { if (val32 != ESDHC_BOOT_SIGNATURE) {
/* BOOT signature may be on the first 24 sectors (each being 512 bytes) */
if (++sector < 24)
goto again;
puts("spl: mmc BOOT signature is not valid!!\n"); puts("spl: mmc BOOT signature is not valid!!\n");
hang(); hang();
} }
@ -135,7 +146,7 @@ void __noreturn mmc_boot(void)
byte_num = 4; byte_num = 4;
offset = 0; offset = 0;
for (i = 0; i < byte_num; i++) { for (i = 0; i < byte_num; i++) {
val = *(tmp_buf + ESDHC_BOOT_IMAGE_ADDR + i); val = *(tmp_buf + blk_off + ESDHC_BOOT_IMAGE_ADDR + i);
offset = (offset << 8) + val; offset = (offset << 8) + val;
} }
offset += CONFIG_SYS_MMC_U_BOOT_OFFS; offset += CONFIG_SYS_MMC_U_BOOT_OFFS;