ARM: uniphier: reuse uniphier_cache_disable() for lowlevel_init

[u-boot] / arch / arm / mach-uniphier / board_early_init_f.c

diff --git a/arch/arm/mach-uniphier/board_early_init_f.c b/arch/arm/mach-uniphier/board_early_init_f.c
index 5e0d246ce4250187757717878a424ed912e337b3..d35d38dcbf3ef70aa8466642cdc6d32e94e50212 100644 (file)
--- a/arch/arm/mach-uniphier/board_early_init_f.c
+++ b/arch/arm/mach-uniphier/board_early_init_f.c
@@ -4,68 +4,122 @@
  * SPDX-License-Identifier:    GPL-2.0+
  */
 
-#include <mach/init.h>
-#include <mach/micro-support-card.h>
-#include <mach/soc_info.h>
+#include <common.h>
+#include <libfdt.h>
+#include <linux/io.h>
+
+#include "init.h"
+#include "micro-support-card.h"
+#include "soc-info.h"
+
+DECLARE_GLOBAL_DATA_PTR;
+
+static void uniphier_setup_xirq(void)
+{
+       const void *fdt = gd->fdt_blob;
+       int soc_node, aidet_node;
+       const u32 *val;
+       unsigned long aidet_base;
+       u32 tmp;
+
+       soc_node = fdt_path_offset(fdt, "/soc");
+       if (soc_node < 0)
+               return;
+
+       aidet_node = fdt_subnode_offset_namelen(fdt, soc_node, "aidet", 5);
+       if (aidet_node < 0)
+               return;
+
+       val = fdt_getprop(fdt, aidet_node, "reg", NULL);
+       if (!val)
+               return;
+
+       aidet_base = fdt32_to_cpu(*val);
+
+       tmp = readl(aidet_base + 8);    /* AIDET DETCONFR2 */
+       tmp |= 0x00ff0000;              /* Set XIRQ0-7 low active */
+       writel(tmp, aidet_base + 8);
+
+       tmp = readl(0x55000090);        /* IRQCTL */
+       tmp |= 0x000000ff;
+       writel(tmp, 0x55000090);
+}
 
 int board_early_init_f(void)
 {
        led_puts("U0");
 
        switch (uniphier_get_soc_type()) {
-#if defined(CONFIG_ARCH_UNIPHIER_PH1_SLD3)
-       case SOC_UNIPHIER_PH1_SLD3:
-               ph1_sld3_pin_init();
+#if defined(CONFIG_ARCH_UNIPHIER_SLD3)
+       case SOC_UNIPHIER_SLD3:
+               uniphier_sld3_pin_init();
+               led_puts("U1");
+               uniphier_ld4_clk_init();
+               break;
+#endif
+#if defined(CONFIG_ARCH_UNIPHIER_LD4)
+       case SOC_UNIPHIER_LD4:
+               uniphier_ld4_pin_init();
                led_puts("U1");
-               ph1_ld4_clk_init();
+               uniphier_ld4_clk_init();
                break;
 #endif
-#if defined(CONFIG_ARCH_UNIPHIER_PH1_LD4)
-       case SOC_UNIPHIER_PH1_LD4:
-               ph1_ld4_pin_init();
+#if defined(CONFIG_ARCH_UNIPHIER_PRO4)
+       case SOC_UNIPHIER_PRO4:
+               uniphier_pro4_pin_init();
                led_puts("U1");
-               ph1_ld4_clk_init();
+               uniphier_pro4_clk_init();
                break;
 #endif
-#if defined(CONFIG_ARCH_UNIPHIER_PH1_PRO4)
-       case SOC_UNIPHIER_PH1_PRO4:
-               ph1_pro4_pin_init();
+#if defined(CONFIG_ARCH_UNIPHIER_SLD8)
+       case SOC_UNIPHIER_SLD8:
+               uniphier_sld8_pin_init();
                led_puts("U1");
-               ph1_pro4_clk_init();
+               uniphier_ld4_clk_init();
                break;
 #endif
-#if defined(CONFIG_ARCH_UNIPHIER_PH1_SLD8)
-       case SOC_UNIPHIER_PH1_SLD8:
-               ph1_sld8_pin_init();
+#if defined(CONFIG_ARCH_UNIPHIER_PRO5)
+       case SOC_UNIPHIER_PRO5:
+               uniphier_pro5_pin_init();
                led_puts("U1");
-               ph1_ld4_clk_init();
+               uniphier_pro5_clk_init();
                break;
 #endif
-#if defined(CONFIG_ARCH_UNIPHIER_PH1_PRO5)
-       case SOC_UNIPHIER_PH1_PRO5:
-               ph1_pro5_pin_init();
+#if defined(CONFIG_ARCH_UNIPHIER_PXS2)
+       case SOC_UNIPHIER_PXS2:
+               uniphier_pxs2_pin_init();
                led_puts("U1");
-               ph1_pro5_clk_init();
+               uniphier_pxs2_clk_init();
                break;
 #endif
-#if defined(CONFIG_ARCH_UNIPHIER_PROXSTREAM2)
-       case SOC_UNIPHIER_PROXSTREAM2:
-               proxstream2_pin_init();
+#if defined(CONFIG_ARCH_UNIPHIER_LD6B)
+       case SOC_UNIPHIER_LD6B:
+               uniphier_ld6b_pin_init();
                led_puts("U1");
-               proxstream2_clk_init();
+               uniphier_pxs2_clk_init();
                break;
 #endif
-#if defined(CONFIG_ARCH_UNIPHIER_PH1_LD6B)
-       case SOC_UNIPHIER_PH1_LD6B:
-               ph1_ld6b_pin_init();
+#if defined(CONFIG_ARCH_UNIPHIER_LD11)
+       case SOC_UNIPHIER_LD11:
+               uniphier_ld20_pin_init();
                led_puts("U1");
-               proxstream2_clk_init();
+               uniphier_ld11_clk_init();
+               break;
+#endif
+#if defined(CONFIG_ARCH_UNIPHIER_LD20)
+       case SOC_UNIPHIER_LD20:
+               uniphier_ld20_pin_init();
+               led_puts("U1");
+               uniphier_ld20_clk_init();
+               cci500_init(2);
                break;
 #endif
        default:
                break;
        }
 
+       uniphier_setup_xirq();
+
        led_puts("U2");
 
        return 0;