arch/sh/boards/of-generic.c

   1 /*
   2  * SH generic board support, using device tree
   3  *
   4  * Copyright (C) 2015-2016 Smart Energy Instruments, Inc.
   5  *
   6  * This file is subject to the terms and conditions of the GNU General Public
   7  * License.  See the file "COPYING" in the main directory of this archive
   8  * for more details.
   9  */
  10
  11 #include <linux/of.h>
  12 #include <linux/of_fdt.h>
  13 #include <linux/clocksource.h>
  14 #include <linux/irqchip.h>
  15 #include <linux/clk-provider.h>
  16 #include <asm/machvec.h>
  17 #include <asm/rtc.h>
  18
  19 #ifdef CONFIG_SMP
  20
  21 static void dummy_smp_setup(void)
  22 {
  23 }
  24
  25 static void dummy_prepare_cpus(unsigned int max_cpus)
  26 {
  27 }
  28
  29 static void dummy_start_cpu(unsigned int cpu, unsigned long entry_point)
  30 {
  31 }
  32
  33 static unsigned int dummy_smp_processor_id(void)
  34 {
  35         return 0;
  36 }
  37
  38 static void dummy_send_ipi(unsigned int cpu, unsigned int message)
  39 {
  40 }
  41
  42 static struct plat_smp_ops dummy_smp_ops = {
  43         .smp_setup              = dummy_smp_setup,
  44         .prepare_cpus           = dummy_prepare_cpus,
  45         .start_cpu              = dummy_start_cpu,
  46         .smp_processor_id       = dummy_smp_processor_id,
  47         .send_ipi               = dummy_send_ipi,
  48         .cpu_die                = native_cpu_die,
  49         .cpu_disable            = native_cpu_disable,
  50         .play_dead              = native_play_dead,
  51 };
  52
  53 extern const struct of_cpu_method __cpu_method_of_table[];
  54 const struct of_cpu_method __cpu_method_of_table_sentinel
  55         __section(__cpu_method_of_table_end);
  56
  57 static void sh_of_smp_probe(void)
  58 {
  59         struct device_node *np = 0;
  60         const char *method = 0;
  61         const struct of_cpu_method *m = __cpu_method_of_table;
  62
  63         pr_info("SH generic board support: scanning for cpus\n");
  64
  65         init_cpu_possible(cpumask_of(0));
  66
  67         while ((np = of_find_node_by_type(np, "cpu"))) {
  68                 const __be32 *cell = of_get_property(np, "reg", NULL);
  69                 u64 id = -1;
  70                 if (cell) id = of_read_number(cell, of_n_addr_cells(np));
  71                 if (id < NR_CPUS) {
  72                         if (!method)
  73                                 of_property_read_string(np, "enable-method", &method);
  74                         set_cpu_possible(id, true);
  75                         set_cpu_present(id, true);
  76                         __cpu_number_map[id] = id;
  77                         __cpu_logical_map[id] = id;
  78                 }
  79         }
  80         if (!method) {
  81                 np = of_find_node_by_name(NULL, "cpus");
  82                 of_property_read_string(np, "enable-method", &method);
  83         }
  84
  85         pr_info("CPU enable method: %s\n", method);
  86         if (method)
  87                 for (; m->method; m++)
  88                         if (!strcmp(m->method, method)) {
  89                                 register_smp_ops(m->ops);
  90                                 return;
  91                         }
  92
  93         register_smp_ops(&dummy_smp_ops);
  94 }
  95
  96 #else
  97
  98 static void sh_of_smp_probe(void)
  99 {
 100 }
 101
 102 #endif
 103
 104 static void noop(void)
 105 {
 106 }
 107
 108 static int noopi(void)
 109 {
 110         return 0;
 111 }
 112
 113 static void __init sh_of_mem_reserve(void)
 114 {
 115         early_init_fdt_reserve_self();
 116         early_init_fdt_scan_reserved_mem();
 117 }
 118
 119 static void __init sh_of_time_init(void)
 120 {
 121         pr_info("SH generic board support: scanning for clocksource devices\n");
 122         clocksource_probe();
 123 }
 124
 125 static void __init sh_of_setup(char **cmdline_p)
 126 {
 127         struct device_node *root;
 128
 129 #ifdef CONFIG_USE_BUILTIN_DTB
 130         unflatten_and_copy_device_tree();
 131 #else
 132         unflatten_device_tree();
 133 #endif
 134
 135         board_time_init = sh_of_time_init;
 136
 137         sh_mv.mv_name = "Unknown SH model";
 138         root = of_find_node_by_path("/");
 139         if (root) {
 140                 of_property_read_string(root, "model", &sh_mv.mv_name);
 141                 of_node_put(root);
 142         }
 143
 144         sh_of_smp_probe();
 145 }
 146
 147 static int sh_of_irq_demux(int irq)
 148 {
 149         /* FIXME: eventually this should not be used at all;
 150          * the interrupt controller should set_handle_irq(). */
 151         return irq;
 152 }
 153
 154 static void __init sh_of_init_irq(void)
 155 {
 156         pr_info("SH generic board support: scanning for interrupt controllers\n");
 157         irqchip_init();
 158 }
 159
 160 static int __init sh_of_clk_init(void)
 161 {
 162 #ifdef CONFIG_COMMON_CLK
 163         /* Disabled pending move to COMMON_CLK framework. */
 164         pr_info("SH generic board support: scanning for clk providers\n");
 165         of_clk_init(NULL);
 166 #endif
 167         return 0;
 168 }
 169
 170 static struct sh_machine_vector __initmv sh_of_generic_mv = {
 171         .mv_setup       = sh_of_setup,
 172         .mv_name        = "devicetree", /* replaced by DT root's model */
 173         .mv_irq_demux   = sh_of_irq_demux,
 174         .mv_init_irq    = sh_of_init_irq,
 175         .mv_clk_init    = sh_of_clk_init,
 176         .mv_mode_pins   = noopi,
 177         .mv_mem_init    = noop,
 178         .mv_mem_reserve = sh_of_mem_reserve,
 179 };
 180
 181 struct sh_clk_ops;
 182
 183 void __init __weak arch_init_clk_ops(struct sh_clk_ops **ops, int idx)
 184 {
 185 }
 186
 187 void __init __weak plat_irq_setup(void)
 188 {
 189 }