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