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