arch/arm/mach-uniphier/board_init.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (C) 2012-2015 Panasonic Corporation
   4  * Copyright (C) 2015-2016 Socionext Inc.
   5  *   Author: Masahiro Yamada <yamada.masahiro@socionext.com>
   6  */
   7
   8 #include <linux/errno.h>
   9 #include <linux/io.h>
  10 #include <linux/printk.h>
  11
  12 #include "init.h"
  13 #include "micro-support-card.h"
  14 #include "soc-info.h"
  15
  16 #ifdef CONFIG_ARCH_UNIPHIER_LD20
  17 static void uniphier_ld20_misc_init(void)
  18 {
  19         /* ES1 errata: increase VDD09 supply to suppress VBO noise */
  20         if (uniphier_get_soc_revision() == 1) {
  21                 writel(0x00000003, 0x6184e004);
  22                 writel(0x00000100, 0x6184e040);
  23                 writel(0x0000b500, 0x6184e024);
  24                 writel(0x00000001, 0x6184e000);
  25         }
  26 }
  27 #endif
  28
  29 struct uniphier_initdata {
  30         unsigned int soc_id;
  31         void (*sbc_init)(void);
  32         void (*pll_init)(void);
  33         void (*clk_init)(void);
  34         void (*misc_init)(void);
  35 };
  36
  37 static const struct uniphier_initdata uniphier_initdata[] = {
  38 #if defined(CONFIG_ARCH_UNIPHIER_LD4)
  39         {
  40                 .soc_id = UNIPHIER_LD4_ID,
  41                 .sbc_init = uniphier_ld4_sbc_init,
  42                 .pll_init = uniphier_ld4_pll_init,
  43                 .clk_init = uniphier_ld4_clk_init,
  44         },
  45 #endif
  46 #if defined(CONFIG_ARCH_UNIPHIER_PRO4)
  47         {
  48                 .soc_id = UNIPHIER_PRO4_ID,
  49                 .sbc_init = uniphier_sbc_init_savepin,
  50                 .pll_init = uniphier_pro4_pll_init,
  51                 .clk_init = uniphier_pro4_clk_init,
  52         },
  53 #endif
  54 #if defined(CONFIG_ARCH_UNIPHIER_SLD8)
  55         {
  56                 .soc_id = UNIPHIER_SLD8_ID,
  57                 .sbc_init = uniphier_ld4_sbc_init,
  58                 .pll_init = uniphier_ld4_pll_init,
  59                 .clk_init = uniphier_ld4_clk_init,
  60         },
  61 #endif
  62 #if defined(CONFIG_ARCH_UNIPHIER_PRO5)
  63         {
  64                 .soc_id = UNIPHIER_PRO5_ID,
  65                 .sbc_init = uniphier_sbc_init_savepin,
  66                 .clk_init = uniphier_pro5_clk_init,
  67         },
  68 #endif
  69 #if defined(CONFIG_ARCH_UNIPHIER_PXS2)
  70         {
  71                 .soc_id = UNIPHIER_PXS2_ID,
  72                 .sbc_init = uniphier_pxs2_sbc_init,
  73                 .clk_init = uniphier_pxs2_clk_init,
  74         },
  75 #endif
  76 #if defined(CONFIG_ARCH_UNIPHIER_LD6B)
  77         {
  78                 .soc_id = UNIPHIER_LD6B_ID,
  79                 .sbc_init = uniphier_pxs2_sbc_init,
  80                 .clk_init = uniphier_pxs2_clk_init,
  81         },
  82 #endif
  83 #if defined(CONFIG_ARCH_UNIPHIER_LD11)
  84         {
  85                 .soc_id = UNIPHIER_LD11_ID,
  86                 .sbc_init = uniphier_ld11_sbc_init,
  87                 .pll_init = uniphier_ld11_pll_init,
  88                 .clk_init = uniphier_ld11_clk_init,
  89         },
  90 #endif
  91 #if defined(CONFIG_ARCH_UNIPHIER_LD20)
  92         {
  93                 .soc_id = UNIPHIER_LD20_ID,
  94                 .sbc_init = uniphier_ld11_sbc_init,
  95                 .pll_init = uniphier_ld20_pll_init,
  96                 .clk_init = uniphier_ld20_clk_init,
  97                 .misc_init = uniphier_ld20_misc_init,
  98         },
  99 #endif
 100 #if defined(CONFIG_ARCH_UNIPHIER_PXS3)
 101         {
 102                 .soc_id = UNIPHIER_PXS3_ID,
 103                 .sbc_init = uniphier_pxs2_sbc_init,
 104                 .pll_init = uniphier_pxs3_pll_init,
 105                 .clk_init = uniphier_pxs3_clk_init,
 106         },
 107 #endif
 108 };
 109 UNIPHIER_DEFINE_SOCDATA_FUNC(uniphier_get_initdata, uniphier_initdata)
 110
 111 int board_init(void)
 112 {
 113         const struct uniphier_initdata *initdata;
 114
 115         led_puts("U0");
 116
 117         initdata = uniphier_get_initdata();
 118         if (!initdata) {
 119                 pr_err("unsupported SoC\n");
 120                 return -EINVAL;
 121         }
 122
 123         initdata->sbc_init();
 124
 125         support_card_init();
 126
 127         led_puts("U0");
 128
 129         if (initdata->pll_init)
 130                 initdata->pll_init();
 131
 132         led_puts("U1");
 133
 134         if (initdata->clk_init)
 135                 initdata->clk_init();
 136
 137         led_puts("U2");
 138
 139         if (initdata->misc_init)
 140                 initdata->misc_init();
 141
 142         led_puts("U3");
 143
 144         support_card_late_init();
 145
 146         led_puts("Uboo");
 147
 148         return 0;
 149 }