--- a/board/mediatek/mt7988/mt7988_rfb.c +++ b/board/mediatek/mt7988/mt7988_rfb.c @@ -10,7 +10,9 @@ #include #include #include +#include #include +#include #ifndef CONFIG_RESET_BUTTON_LABEL #define CONFIG_RESET_BUTTON_LABEL "reset" @@ -43,3 +45,54 @@ int board_late_init(void) env_relocate(); return 0; } + +#define MT7988_BOOT_NOR 0 +#define MT7988_BOOT_SPIM_NAND 1 +#define MT7988_BOOT_EMMC 2 +#define MT7988_BOOT_SNFI_NAND 3 + +int ft_system_setup(void *blob, struct bd_info *bd) +{ + const u32 *media_handle_p; + int chosen, len, ret; + const char *media; + u32 media_handle; + + switch ((readl(0x1001f6f0) & 0xc00) >> 10) { + case MT7988_BOOT_NOR: + media = "rootdisk-nor"; + break + ;; + case MT7988_BOOT_SPIM_NAND: + media = "rootdisk-spim-nand"; + break + ;; + case MT7988_BOOT_EMMC: + media = "rootdisk-emmc"; + break + ;; + case MT7988_BOOT_SNFI_NAND: + 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; +}