mediatek: mt7622: convert BPi-R64 to all-UBI layout and fitblk
[openwrt/staging/wigyori.git] / package / boot / uboot-mediatek / patches / 312-mt7622-select-rootdisk.patch
diff --git a/package/boot/uboot-mediatek/patches/312-mt7622-select-rootdisk.patch b/package/boot/uboot-mediatek/patches/312-mt7622-select-rootdisk.patch
new file mode 100644 (file)
index 0000000..70cbf6b
--- /dev/null
@@ -0,0 +1,141 @@
+--- a/board/mediatek/mt7622/mt7622_rfb.c
++++ b/board/mediatek/mt7622/mt7622_rfb.c
+@@ -11,7 +11,9 @@
+ #include <env.h>
+ #include <init.h>
+ #include <asm/global_data.h>
++#include <asm/io.h>
+ #include <linux/delay.h>
++#include <linux/libfdt.h>
+ #ifndef CONFIG_RESET_BUTTON_LABEL
+ #define CONFIG_RESET_BUTTON_LABEL "reset"
+@@ -22,10 +24,43 @@
+ #include <nmbm/nmbm.h>
+ #include <nmbm/nmbm-mtd.h>
++#define MT7622_TOPRGUSTRAP_PAR                        0x10212060
++#define MT7622_BOOT_SEQ_MASK                  0x18
++#define MT7622_BOOT_SEQ_SHIFT                 3
++#define MT7622_BOOT_SEQ_NOR_EMMC_SDXC         0x0
++#define MT7622_BOOT_SEQ_SPI_NAND_EMMC_SDXC    0x1
++#define MT7622_BOOT_SEQ_NAND_EMMC_SDXC                0x2
++#define MT7622_BOOT_SEQ_SDXC_EMMC_NAND                0x3
++
++#define MT7622_GPIO_MODE0                     0x10211300
++#define MT7622_GPIO_NAND_MODE_MASK            0x00f00000
++#define MT7622_GPIO_NAND_MODE_SHIFT           20
++#define MT7622_GPIO_NAND_MODE_EMMC            0x2
++#define MT7622_GPIO_RGMII_MODE_MASK           0x0000f000
++#define MT7622_GPIO_RGMII_MODE_SHIFT          12
++#define MT7622_GPIO_RGMII_MODE_SDCX           0x2
++#define MT7622_GPIO_SPI_MODE_MASK             0x00000f00
++#define MT7622_GPIO_SPI_MODE_SHIFT            8
++#define MT7622_GPIO_SPI_MODE_NAND             0x2
++
++#define MT7622_MSDC_INT                               0x1124000C
++#define MT7622_MSDC_INT_BD_CS_ERR             0x200
++
+ DECLARE_GLOBAL_DATA_PTR;
++static int    gpio_mode0;
++static int    msdc_int;
++
+ int board_init(void)
+ {
++      /*
++       * Save content of GPIO_MODE0 as left behind by the BootROM.
++       * Also grab MSDC1 INT status to see if BootROM has been reading
++       * from SD card.
++       * Together this will allow to infer the device used for booting.
++       */
++      gpio_mode0 = readl(MT7622_GPIO_MODE0);
++      msdc_int = readl(MT7622_MSDC_INT);
+       return 0;
+ }
+@@ -83,3 +118,84 @@ int board_nmbm_init(void)
+       return 0;
+ }
++
++int ft_system_setup(void *blob, struct bd_info *bd)
++{
++      bool pinctrl_set_mmc = false;
++      bool pinctrl_set_snfi = false;
++      bool pinctrl_set_emmc = false;
++      bool msdc_bd_cs_err = false;
++
++      const u32 *media_handle_p;
++      int chosen, len, ret;
++      const char *media;
++      u32 media_handle, strap;
++
++      if ((gpio_mode0 & MT7622_GPIO_RGMII_MODE_MASK) >>
++          MT7622_GPIO_RGMII_MODE_SHIFT == MT7622_GPIO_RGMII_MODE_SDCX)
++              pinctrl_set_mmc = true;
++
++      if ((gpio_mode0 & MT7622_GPIO_SPI_MODE_MASK) >>
++          MT7622_GPIO_SPI_MODE_SHIFT == MT7622_GPIO_SPI_MODE_NAND)
++              pinctrl_set_snfi = true;
++
++      if ((gpio_mode0 & MT7622_GPIO_NAND_MODE_MASK) >>
++          MT7622_GPIO_NAND_MODE_SHIFT == MT7622_GPIO_NAND_MODE_EMMC)
++              pinctrl_set_emmc = true;
++
++      if (msdc_int & MT7622_MSDC_INT_BD_CS_ERR)
++              msdc_bd_cs_err = true;
++
++      strap = readl(MT7622_TOPRGUSTRAP_PAR);
++      strap &= MT7622_BOOT_SEQ_MASK;
++      strap >>= MT7622_BOOT_SEQ_SHIFT;
++      switch (strap) {
++      case MT7622_BOOT_SEQ_NOR_EMMC_SDXC:
++              if (!pinctrl_set_emmc)
++                      media = "rootdisk-nor";
++              else if (pinctrl_set_mmc)
++                      media = "rootdisk-emmc";
++              else
++                      media = "rootdisk-sd";
++              break
++              ;;
++      case MT7622_BOOT_SEQ_SPI_NAND_EMMC_SDXC:
++              if (pinctrl_set_snfi)
++                      media = "rootdisk-snfi";
++              else if (pinctrl_set_emmc)
++                      media = "rootdisk-emmc";
++              else
++                      media = "rootdisk-sd";
++              break
++              ;;
++      case MT7622_BOOT_SEQ_NAND_EMMC_SDXC:
++      case MT7622_BOOT_SEQ_SDXC_EMMC_NAND:
++              if (!pinctrl_set_emmc && pinctrl_set_mmc)
++                      media = "rootdisk-nand";
++              else if (pinctrl_set_emmc)
++                      media = "rootdisk-emmc";
++              else
++                      media = "rootdisk-sd";
++              break
++              ;;
++      }
++
++      chosen = fdt_path_offset(blob, "/chosen");
++      if (chosen <= 0)
++              return 0;
++
++      media_handle_p = fdt_getprop(blob, chosen, media, &len);
++      if (media_handle_p <= 0 || len != 4)
++              return 0;
++
++      media_handle = *media_handle_p;
++      ret = fdt_setprop(blob, chosen, "rootdisk", &media_handle, sizeof(media_handle));
++      if (ret) {
++              printf("cannot set media phandle %s as rootdisk /chosen node\n", media);
++              return ret;
++      }
++
++      printf("set /chosen/rootdisk to bootrom media: %s (phandle 0x%08x)\n", media, fdt32_to_cpu(media_handle));
++
++      return 0;
++}