package/boot/uboot-mediatek/patches/311-mt7986-select-roodisk.patch

   1 --- a/board/mediatek/mt7986/mt7986_rfb.c
   2 +++ b/board/mediatek/mt7986/mt7986_rfb.c
   3 @@ -11,7 +11,9 @@
   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  #define CONFIG_RESET_BUTTON_LABEL "reset"
  13 @@ -83,3 +85,54 @@ int board_nmbm_init(void)
  14
  15         return 0;
  16  }
  17 +
  18 +#define        MT7986_BOOT_NOR         0
  19 +#define        MT7986_BOOT_SPIM_NAND   1
  20 +#define        MT7986_BOOT_EMMC        2
  21 +#define        MT7986_BOOT_SNFI_NAND   3
  22 +
  23 +int ft_system_setup(void *blob, struct bd_info *bd)
  24 +{
  25 +       const u32 *media_handle_p;
  26 +       int chosen, len, ret;
  27 +       const char *media;
  28 +       u32 media_handle;
  29 +
  30 +       switch ((readl(0x1001f6f0) & 0x300) >> 8) {
  31 +       case MT7986_BOOT_NOR:
  32 +               media = "rootdisk-nor";
  33 +               break
  34 +               ;;
  35 +       case MT7986_BOOT_SPIM_NAND:
  36 +               media = "rootdisk-spim-nand";
  37 +               break
  38 +               ;;
  39 +       case MT7986_BOOT_EMMC:
  40 +               media = "rootdisk-emmc";
  41 +               break
  42 +               ;;
  43 +       case MT7986_BOOT_SNFI_NAND:
  44 +               media = "rootdisk-sd";
  45 +               break
  46 +               ;;
  47 +       }
  48 +
  49 +       chosen = fdt_path_offset(blob, "/chosen");
  50 +       if (chosen <= 0)
  51 +               return 0;
  52 +
  53 +       media_handle_p = fdt_getprop(blob, chosen, media, &len);
  54 +       if (media_handle_p <= 0 || len != 4)
  55 +               return 0;
  56 +
  57 +       media_handle = *media_handle_p;
  58 +       ret = fdt_setprop(blob, chosen, "rootdisk", &media_handle, sizeof(media_handle));
  59 +       if (ret) {
  60 +               printf("cannot set media phandle %s as rootdisk /chosen node\n", media);
  61 +               return ret;
  62 +       }
  63 +
  64 +       printf("set /chosen/rootdisk to bootrom media: %s (phandle 0x%08x)\n", media, fdt32_to_cpu(media_handle));
  65 +
  66 +       return 0;
  67 +}