package/boot/uboot-mediatek/patches/310-mt7988-select-rootdisk.patch

   1 --- a/board/mediatek/mt7988/mt7988_rfb.c
   2 +++ b/board/mediatek/mt7988/mt7988_rfb.c
   3 @@ -11,6 +11,8 @@
   4  #include <env.h>
   5  #include <init.h>
   6  #include <asm/global_data.h>
   7 +#include <asm/io.h>
   8  #include <linux/delay.h>
   9 +#include <linux/libfdt.h>
  10
  11  #ifndef CONFIG_RESET_BUTTON_LABEL
  12 @@ -44,3 +50,54 @@ int board_late_init(void)
  13         env_relocate();
  14         return 0;
  15  }
  16 +
  17 +#define        MT7988_BOOT_NOR         0
  18 +#define        MT7988_BOOT_SPIM_NAND   1
  19 +#define        MT7988_BOOT_EMMC        2
  20 +#define        MT7988_BOOT_SNFI_NAND   3
  21 +
  22 +int ft_system_setup(void *blob, struct bd_info *bd)
  23 +{
  24 +       const u32 *media_handle_p;
  25 +       int chosen, len, ret;
  26 +       const char *media;
  27 +       u32 media_handle;
  28 +
  29 +       switch ((readl(0x1001f6f0) & 0xc00) >> 10) {
  30 +       case MT7988_BOOT_NOR:
  31 +               media = "rootdisk-nor";
  32 +               break
  33 +               ;;
  34 +       case MT7988_BOOT_SPIM_NAND:
  35 +               media = "rootdisk-spim-nand";
  36 +               break
  37 +               ;;
  38 +       case MT7988_BOOT_EMMC:
  39 +               media = "rootdisk-emmc";
  40 +               break
  41 +               ;;
  42 +       case MT7988_BOOT_SNFI_NAND:
  43 +               media = "rootdisk-sd";
  44 +               break
  45 +               ;;
  46 +       }
  47 +
  48 +       chosen = fdt_path_offset(blob, "/chosen");
  49 +       if (chosen <= 0)
  50 +               return 0;
  51 +
  52 +       media_handle_p = fdt_getprop(blob, chosen, media, &len);
  53 +       if (media_handle_p <= 0 || len != 4)
  54 +               return 0;
  55 +
  56 +       media_handle = *media_handle_p;
  57 +       ret = fdt_setprop(blob, chosen, "rootdisk", &media_handle, sizeof(media_handle));
  58 +       if (ret) {
  59 +               printf("cannot set media phandle %s as rootdisk /chosen node\n", media);
  60 +               return ret;
  61 +       }
  62 +
  63 +       printf("set /chosen/rootdisk to bootrom media: %s (phandle 0x%08x)\n", media, fdt32_to_cpu(media_handle));
  64 +
  65 +       return 0;
  66 +}