fsl_esdhc_spl.c 3.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152
  1. /*
  2. * Copyright 2013 Freescale Semiconductor, Inc.
  3. *
  4. * SPDX-License-Identifier: GPL-2.0+
  5. */
  6. #include <common.h>
  7. #include <mmc.h>
  8. #include <malloc.h>
  9. /*
  10. * The environment variables are written to just after the u-boot image
  11. * on SDCard, so we must read the MBR to get the start address and code
  12. * length of the u-boot image, then calculate the address of the env.
  13. */
  14. #define ESDHC_BOOT_IMAGE_SIZE 0x48
  15. #define ESDHC_BOOT_IMAGE_ADDR 0x50
  16. #define MBRDBR_BOOT_SIG_55 0x1fe
  17. #define MBRDBR_BOOT_SIG_AA 0x1ff
  18. #define CONFIG_CFG_DATA_SECTOR 0
  19. void mmc_spl_load_image(uint32_t offs, unsigned int size, void *vdst)
  20. {
  21. uint blk_start, blk_cnt, err;
  22. struct mmc *mmc = find_mmc_device(0);
  23. if (!mmc) {
  24. puts("spl: mmc device not found!!\n");
  25. hang();
  26. }
  27. if (mmc_init(mmc)) {
  28. puts("MMC init failed\n");
  29. return;
  30. }
  31. blk_start = ALIGN(offs, mmc->read_bl_len) / mmc->read_bl_len;
  32. blk_cnt = ALIGN(size, mmc->read_bl_len) / mmc->read_bl_len;
  33. err = mmc->block_dev.block_read(&mmc->block_dev, blk_start, blk_cnt,
  34. vdst);
  35. if (err != blk_cnt) {
  36. puts("spl: mmc read failed!!\n");
  37. hang();
  38. }
  39. }
  40. /*
  41. * The main entry for mmc booting. It's necessary that SDRAM is already
  42. * configured and available since this code loads the main U-Boot image
  43. * from mmc into SDRAM and starts it from there.
  44. */
  45. void __noreturn mmc_boot(void)
  46. {
  47. __attribute__((noreturn)) void (*uboot)(void);
  48. uint blk_start, blk_cnt, err;
  49. #ifndef CONFIG_FSL_CORENET
  50. uchar *tmp_buf;
  51. u32 blklen;
  52. uchar val;
  53. uint i, byte_num;
  54. #endif
  55. u32 offset, code_len;
  56. struct mmc *mmc;
  57. mmc = find_mmc_device(0);
  58. if (!mmc) {
  59. puts("spl: mmc device not found!!\n");
  60. hang();
  61. }
  62. #ifdef CONFIG_FSL_CORENET
  63. offset = CONFIG_SYS_MMC_U_BOOT_OFFS;
  64. code_len = CONFIG_SYS_MMC_U_BOOT_SIZE;
  65. #else
  66. blklen = mmc->read_bl_len;
  67. tmp_buf = malloc(blklen);
  68. if (!tmp_buf) {
  69. puts("spl: malloc memory failed!!\n");
  70. hang();
  71. }
  72. memset(tmp_buf, 0, blklen);
  73. /*
  74. * Read source addr from sd card
  75. */
  76. err = mmc->block_dev.block_read(&mmc->block_dev,
  77. CONFIG_CFG_DATA_SECTOR, 1, tmp_buf);
  78. if (err != 1) {
  79. puts("spl: mmc read failed!!\n");
  80. free(tmp_buf);
  81. hang();
  82. }
  83. val = *(tmp_buf + MBRDBR_BOOT_SIG_55);
  84. if (0x55 != val) {
  85. puts("spl: mmc signature is not valid!!\n");
  86. free(tmp_buf);
  87. hang();
  88. }
  89. val = *(tmp_buf + MBRDBR_BOOT_SIG_AA);
  90. if (0xAA != val) {
  91. puts("spl: mmc signature is not valid!!\n");
  92. free(tmp_buf);
  93. hang();
  94. }
  95. byte_num = 4;
  96. offset = 0;
  97. for (i = 0; i < byte_num; i++) {
  98. val = *(tmp_buf + ESDHC_BOOT_IMAGE_ADDR + i);
  99. offset = (offset << 8) + val;
  100. }
  101. offset += CONFIG_SYS_MMC_U_BOOT_OFFS;
  102. /* Get the code size from offset 0x48 */
  103. byte_num = 4;
  104. code_len = 0;
  105. for (i = 0; i < byte_num; i++) {
  106. val = *(tmp_buf + ESDHC_BOOT_IMAGE_SIZE + i);
  107. code_len = (code_len << 8) + val;
  108. }
  109. code_len -= CONFIG_SYS_MMC_U_BOOT_OFFS;
  110. /*
  111. * Load U-Boot image from mmc into RAM
  112. */
  113. #endif
  114. blk_start = ALIGN(offset, mmc->read_bl_len) / mmc->read_bl_len;
  115. blk_cnt = ALIGN(code_len, mmc->read_bl_len) / mmc->read_bl_len;
  116. err = mmc->block_dev.block_read(&mmc->block_dev, blk_start, blk_cnt,
  117. (uchar *)CONFIG_SYS_MMC_U_BOOT_DST);
  118. if (err != blk_cnt) {
  119. puts("spl: mmc read failed!!\n");
  120. #ifndef CONFIG_FSL_CORENET
  121. free(tmp_buf);
  122. #endif
  123. hang();
  124. }
  125. /*
  126. * Clean d-cache and invalidate i-cache, to
  127. * make sure that no stale data is executed.
  128. */
  129. flush_cache(CONFIG_SYS_MMC_U_BOOT_DST, CONFIG_SYS_MMC_U_BOOT_SIZE);
  130. /*
  131. * Jump to U-Boot image
  132. */
  133. uboot = (void *)CONFIG_SYS_MMC_U_BOOT_START;
  134. (*uboot)();
  135. }