ARM: uniphier: select CONFIG_ARMV8_SPIN_TABLE

[oweals/u-boot.git] / arch / arm / mach-uniphier / board_late_init.c

diff --git a/arch/arm/mach-uniphier/board_late_init.c b/arch/arm/mach-uniphier/board_late_init.c
index c2a32618acc7c607fa8ef60e4ff35a0987f4f8bf..a45412677a0ffcfad93ca01f7a6ee222471f90ce 100644 (file)
--- a/arch/arm/mach-uniphier/board_late_init.c
+++ b/arch/arm/mach-uniphier/board_late_init.c
@@ -11,6 +11,8 @@
 #include <linux/io.h>
 #include <../drivers/mtd/nand/denali.h>
 
+#include "boot-mode/boot-device.h"
+
 static void nand_denali_wp_disable(void)
 {
 #ifdef CONFIG_NAND_DENALI
@@ -26,43 +28,45 @@ static void nand_denali_wp_disable(void)
 #endif
 }
 
-struct uniphier_fdt_file {
-       const char *compatible;
-       const char *file_name;
-};
-
-static const struct uniphier_fdt_file uniphier_fdt_files[] = {
-       { "socionext,ph1-ld4-ref", "uniphier-ph1-ld4-ref.dtb", },
-       { "socionext,ph1-ld6b-ref", "uniphier-ph1-ld6b-ref.dtb", },
-       { "socionext,ph1-ld10-ref", "uniphier-ph1-ld10-ref.dtb", },
-       { "socionext,ph1-pro4-ref", "uniphier-ph1-pro4-ref.dtb", },
-       { "socionext,ph1-pro5-4kbox", "uniphier-ph1-pro5-4kbox.dtb", },
-       { "socionext,ph1-sld3-ref", "uniphier-ph1-sld3-ref.dtb", },
-       { "socionext,ph1-sld8-ref", "uniphier-ph1-sld8-ref.dtb", },
-       { "socionext,proxstream2-gentil", "uniphier-proxstream2-gentil.dtb", },
-       { "socionext,proxstream2-vodka", "uniphier-proxstream2-vodka.dtb", },
-};
-
-static void uniphier_set_fdt_file(void)
+#define VENDOR_PREFIX          "socionext,"
+#define DTB_FILE_PREFIX                "uniphier-"
+
+static int uniphier_set_fdt_file(void)
 {
        DECLARE_GLOBAL_DATA_PTR;
-       int i;
-
-       /* lookup DTB file name based on the compatible string */
-       for (i = 0; i < ARRAY_SIZE(uniphier_fdt_files); i++) {
-               if (!fdt_node_check_compatible(gd->fdt_blob, 0,
-                                       uniphier_fdt_files[i].compatible)) {
-                       setenv("fdt_file", uniphier_fdt_files[i].file_name);
-                       return;
-               }
-       }
+       const char *compat;
+       char dtb_name[256];
+       int buf_len = 256;
+       int ret;
+
+       if (getenv("fdt_file"))
+               return 0;       /* do nothing if it is already set */
+
+       ret = fdt_get_string(gd->fdt_blob, 0, "compatible", &compat);
+       if (ret)
+               return -EINVAL;
+
+       if (strncmp(compat, VENDOR_PREFIX, strlen(VENDOR_PREFIX)))
+               return -EINVAL;
+
+       compat += strlen(VENDOR_PREFIX);
+
+       strncat(dtb_name, DTB_FILE_PREFIX, buf_len);
+       buf_len -= strlen(DTB_FILE_PREFIX);
+
+       strncat(dtb_name, compat, buf_len);
+       buf_len -= strlen(compat);
+
+       strncat(dtb_name, ".dtb", buf_len);
+
+       return setenv("fdt_file", dtb_name);
 }
 
 int board_late_init(void)
 {
        puts("MODE:  ");
 
-       switch (spl_boot_device()) {
+       switch (spl_boot_device_raw()) {
        case BOOT_DEVICE_MMC1:
                printf("eMMC Boot\n");
                setenv("bootmode", "emmcboot");
@@ -76,12 +80,17 @@ int board_late_init(void)
                printf("NOR Boot\n");
                setenv("bootmode", "norboot");
                break;
+       case BOOT_DEVICE_USB:
+               printf("USB Boot\n");
+               setenv("bootmode", "usbboot");
+               break;
        default:
-               printf("Unsupported Boot Mode\n");
-               return -1;
+               printf("Unknown\n");
+               break;
        }
 
-       uniphier_set_fdt_file();
+       if (uniphier_set_fdt_file())
+               printf("fdt_file environment was not set correctly\n");
 
        return 0;
 }