mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-11-24 21:54:01 +00:00
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:
parent
44564e79eb
commit
0980cbba7b
1 changed files with 18 additions and 7 deletions
|
@ -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;
|
||||||
|
|
Loading…
Reference in a new issue