icorem6: Add mmc_late_init

[people/ms/u-boot.git] / board / engicam / icorem6 / icorem6.c

diff --git a/board/engicam/icorem6/icorem6.c b/board/engicam/icorem6/icorem6.c
index f78f8c9da52cd36b69462ef2469e844305883a36..55fc77fe04bc52dfbf32c3907b14b73da26fdcc9 100644 (file)
--- a/board/engicam/icorem6/icorem6.c
+++ b/board/engicam/icorem6/icorem6.c
@@ -7,6 +7,7 @@
  */
 
 #include <common.h>
  */
 
 #include <common.h>

+#include <mmc.h>

 
 #include <asm/io.h>
 #include <asm/gpio.h>
 
 #include <asm/io.h>
 #include <asm/gpio.h>


@@ -205,12 +206,33 @@ int board_early_init_f(void)
        return 0;
 }
 
        return 0;
 }
 

+#ifdef CONFIG_ENV_IS_IN_MMC
+static void mmc_late_init(void)
+{
+       char cmd[32];
+       char mmcblk[32];
+       u32 dev_no = mmc_get_env_dev();
+
+       setenv_ulong("mmcdev", dev_no);
+
+       /* Set mmcblk env */
+       sprintf(mmcblk, "/dev/mmcblk%dp2 rootwait rw", dev_no);
+       setenv("mmcroot", mmcblk);
+
+       sprintf(cmd, "mmc dev %d", dev_no);
+       run_command(cmd, 0);
+}
+#endif
+

 int board_late_init(void)
 {
        switch ((imx6_src_get_boot_mode() & IMX6_BMODE_MASK) >>
                        IMX6_BMODE_SHIFT) {
        case IMX6_BMODE_SD:
        case IMX6_BMODE_ESD:
 int board_late_init(void)
 {
        switch ((imx6_src_get_boot_mode() & IMX6_BMODE_MASK) >>
                        IMX6_BMODE_SHIFT) {
        case IMX6_BMODE_SD:
        case IMX6_BMODE_ESD:

+#ifdef CONFIG_ENV_IS_IN_MMC
+               mmc_late_init();
+#endif

                setenv("modeboot", "mmcboot");
                break;
        case IMX6_BMODE_NAND:
                setenv("modeboot", "mmcboot");
                break;
        case IMX6_BMODE_NAND: