arch/arm/mach-uniphier/board_init.c

   1 /*
   2  * Copyright (C) 2012-2015 Panasonic Corporation
   3  * Copyright (C) 2015-2016 Socionext Inc.
   4  *   Author: Masahiro Yamada <yamada.masahiro@socionext.com>
   5  *
   6  * SPDX-License-Identifier:     GPL-2.0+
   7  */
   8
   9 #include <common.h>
  10 #include <libfdt.h>
  11 #include <linux/io.h>
  12
  13 #include "init.h"
  14 #include "micro-support-card.h"
  15 #include "sg-regs.h"
  16 #include "soc-info.h"
  17
  18 DECLARE_GLOBAL_DATA_PTR;
  19
  20 static void uniphier_setup_xirq(void)
  21 {
  22         const void *fdt = gd->fdt_blob;
  23         int soc_node, aidet_node;
  24         const u32 *val;
  25         unsigned long aidet_base;
  26         u32 tmp;
  27
  28         soc_node = fdt_path_offset(fdt, "/soc");
  29         if (soc_node < 0)
  30                 return;
  31
  32         aidet_node = fdt_subnode_offset_namelen(fdt, soc_node, "aidet", 5);
  33         if (aidet_node < 0)
  34                 return;
  35
  36         val = fdt_getprop(fdt, aidet_node, "reg", NULL);
  37         if (!val)
  38                 return;
  39
  40         aidet_base = fdt32_to_cpu(*val);
  41
  42         tmp = readl(aidet_base + 8);    /* AIDET DETCONFR2 */
  43         tmp |= 0x00ff0000;              /* Set XIRQ0-7 low active */
  44         writel(tmp, aidet_base + 8);
  45
  46         tmp = readl(0x55000090);        /* IRQCTL */
  47         tmp |= 0x000000ff;
  48         writel(tmp, 0x55000090);
  49 }
  50
  51 #ifdef CONFIG_ARCH_UNIPHIER_LD11
  52 static void uniphier_ld11_misc_init(void)
  53 {
  54         sg_set_pinsel(149, 14, 8, 4);   /* XIRQ0    -> XIRQ0 */
  55         sg_set_iectrl(149);
  56         sg_set_pinsel(153, 14, 8, 4);   /* XIRQ4    -> XIRQ4 */
  57         sg_set_iectrl(153);
  58 }
  59 #endif
  60
  61 #ifdef CONFIG_ARCH_UNIPHIER_LD20
  62 static void uniphier_ld20_misc_init(void)
  63 {
  64         sg_set_pinsel(149, 14, 8, 4);   /* XIRQ0    -> XIRQ0 */
  65         sg_set_iectrl(149);
  66         sg_set_pinsel(153, 14, 8, 4);   /* XIRQ4    -> XIRQ4 */
  67         sg_set_iectrl(153);
  68
  69         /* ES1 errata: increase VDD09 supply to suppress VBO noise */
  70         if (uniphier_get_soc_revision() == 1) {
  71                 writel(0x00000003, 0x6184e004);
  72                 writel(0x00000100, 0x6184e040);
  73                 writel(0x0000b500, 0x6184e024);
  74                 writel(0x00000001, 0x6184e000);
  75         }
  76 #ifdef CONFIG_ARMV8_MULTIENTRY
  77         cci500_init(2);
  78 #endif
  79 }
  80 #endif
  81
  82 struct uniphier_initdata {
  83         enum uniphier_soc_id soc_id;
  84         bool nand_2cs;
  85         void (*sbc_init)(void);
  86         void (*pll_init)(void);
  87         void (*clk_init)(void);
  88         void (*misc_init)(void);
  89 };
  90
  91 static const struct uniphier_initdata uniphier_initdata[] = {
  92 #if defined(CONFIG_ARCH_UNIPHIER_SLD3)
  93         {
  94                 .soc_id = SOC_UNIPHIER_SLD3,
  95                 .nand_2cs = true,
  96                 .sbc_init = uniphier_sbc_init_admulti,
  97                 .pll_init = uniphier_sld3_pll_init,
  98                 .clk_init = uniphier_ld4_clk_init,
  99         },
 100 #endif
 101 #if defined(CONFIG_ARCH_UNIPHIER_LD4)
 102         {
 103                 .soc_id = SOC_UNIPHIER_LD4,
 104                 .nand_2cs = true,
 105                 .sbc_init = uniphier_ld4_sbc_init,
 106                 .pll_init = uniphier_ld4_pll_init,
 107                 .clk_init = uniphier_ld4_clk_init,
 108         },
 109 #endif
 110 #if defined(CONFIG_ARCH_UNIPHIER_PRO4)
 111         {
 112                 .soc_id = SOC_UNIPHIER_PRO4,
 113                 .nand_2cs = false,
 114                 .sbc_init = uniphier_sbc_init_savepin,
 115                 .pll_init = uniphier_pro4_pll_init,
 116                 .clk_init = uniphier_pro4_clk_init,
 117         },
 118 #endif
 119 #if defined(CONFIG_ARCH_UNIPHIER_SLD8)
 120         {
 121                 .soc_id = SOC_UNIPHIER_SLD8,
 122                 .nand_2cs = true,
 123                 .sbc_init = uniphier_ld4_sbc_init,
 124                 .pll_init = uniphier_ld4_pll_init,
 125                 .clk_init = uniphier_ld4_clk_init,
 126         },
 127 #endif
 128 #if defined(CONFIG_ARCH_UNIPHIER_PRO5)
 129         {
 130                 .soc_id = SOC_UNIPHIER_PRO5,
 131                 .nand_2cs = true,
 132                 .sbc_init = uniphier_sbc_init_savepin,
 133                 .clk_init = uniphier_pro5_clk_init,
 134         },
 135 #endif
 136 #if defined(CONFIG_ARCH_UNIPHIER_PXS2)
 137         {
 138                 .soc_id = SOC_UNIPHIER_PXS2,
 139                 .nand_2cs = true,
 140                 .sbc_init = uniphier_pxs2_sbc_init,
 141                 .clk_init = uniphier_pxs2_clk_init,
 142         },
 143 #endif
 144 #if defined(CONFIG_ARCH_UNIPHIER_LD6B)
 145         {
 146                 .soc_id = SOC_UNIPHIER_LD6B,
 147                 .nand_2cs = true,
 148                 .sbc_init = uniphier_pxs2_sbc_init,
 149                 .clk_init = uniphier_pxs2_clk_init,
 150         },
 151 #endif
 152 #if defined(CONFIG_ARCH_UNIPHIER_LD11)
 153         {
 154                 .soc_id = SOC_UNIPHIER_LD11,
 155                 .nand_2cs = false,
 156                 .sbc_init = uniphier_ld11_sbc_init,
 157                 .pll_init = uniphier_ld11_pll_init,
 158                 .clk_init = uniphier_ld11_clk_init,
 159                 .misc_init = uniphier_ld11_misc_init,
 160         },
 161 #endif
 162 #if defined(CONFIG_ARCH_UNIPHIER_LD20)
 163         {
 164                 .soc_id = SOC_UNIPHIER_LD20,
 165                 .nand_2cs = false,
 166                 .sbc_init = uniphier_ld11_sbc_init,
 167                 .pll_init = uniphier_ld20_pll_init,
 168                 .misc_init = uniphier_ld20_misc_init,
 169         },
 170 #endif
 171 };
 172
 173 static const struct uniphier_initdata *uniphier_get_initdata(
 174                                                 enum uniphier_soc_id soc_id)
 175 {
 176         int i;
 177
 178         for (i = 0; i < ARRAY_SIZE(uniphier_initdata); i++) {
 179                 if (uniphier_initdata[i].soc_id == soc_id)
 180                         return &uniphier_initdata[i];
 181         }
 182
 183         return NULL;
 184 }
 185
 186 int board_init(void)
 187 {
 188         const struct uniphier_initdata *initdata;
 189         enum uniphier_soc_id soc_id;
 190         int ret;
 191
 192         led_puts("U0");
 193
 194         soc_id = uniphier_get_soc_type();
 195         initdata = uniphier_get_initdata(soc_id);
 196         if (!initdata) {
 197                 pr_err("unsupported board\n");
 198                 return -EINVAL;
 199         }
 200
 201         initdata->sbc_init();
 202
 203         support_card_init();
 204
 205         led_puts("U0");
 206
 207         if (IS_ENABLED(CONFIG_NAND_DENALI)) {
 208                 ret = uniphier_pin_init(initdata->nand_2cs ?
 209                                         "nand2cs_grp" : "nand_grp");
 210                 if (ret)
 211                         pr_err("failed to init NAND pins\n");
 212         }
 213
 214         led_puts("U1");
 215
 216         if (initdata->pll_init)
 217                 initdata->pll_init();
 218
 219         led_puts("U2");
 220
 221         if (initdata->clk_init)
 222                 initdata->clk_init();
 223
 224         led_puts("U3");
 225
 226         if (initdata->misc_init)
 227                 initdata->misc_init();
 228
 229         led_puts("U4");
 230
 231         uniphier_setup_xirq();
 232
 233         led_puts("U5");
 234
 235         support_card_late_init();
 236
 237         led_puts("U6");
 238
 239 #ifdef CONFIG_ARMV8_MULTIENTRY
 240         uniphier_smp_kick_all_cpus();
 241 #endif
 242
 243         led_puts("Uboo");
 244
 245         return 0;
 246 }