treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / arch / openrisc / kernel / setup.c
blobc0a774b51e45b2d9f74a944d63764a1f5f65850d
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * OpenRISC setup.c
5 * Linux architectural port borrowing liberally from similar works of
6 * others. All original copyrights apply as per the original source
7 * declaration.
9 * Modifications for the OpenRISC architecture:
10 * Copyright (C) 2003 Matjaz Breskvar <phoenix@bsemi.com>
11 * Copyright (C) 2010-2011 Jonas Bonn <jonas@southpole.se>
13 * This file handles the architecture-dependent parts of initialization
16 #include <linux/errno.h>
17 #include <linux/sched.h>
18 #include <linux/kernel.h>
19 #include <linux/mm.h>
20 #include <linux/stddef.h>
21 #include <linux/unistd.h>
22 #include <linux/ptrace.h>
23 #include <linux/slab.h>
24 #include <linux/tty.h>
25 #include <linux/ioport.h>
26 #include <linux/delay.h>
27 #include <linux/console.h>
28 #include <linux/init.h>
29 #include <linux/memblock.h>
30 #include <linux/seq_file.h>
31 #include <linux/serial.h>
32 #include <linux/initrd.h>
33 #include <linux/of_fdt.h>
34 #include <linux/of.h>
35 #include <linux/device.h>
37 #include <asm/sections.h>
38 #include <asm/pgtable.h>
39 #include <asm/types.h>
40 #include <asm/setup.h>
41 #include <asm/io.h>
42 #include <asm/cpuinfo.h>
43 #include <asm/delay.h>
45 #include "vmlinux.h"
47 static void __init setup_memory(void)
49 unsigned long ram_start_pfn;
50 unsigned long ram_end_pfn;
51 phys_addr_t memory_start, memory_end;
52 struct memblock_region *region;
54 memory_end = memory_start = 0;
56 /* Find main memory where is the kernel, we assume its the only one */
57 for_each_memblock(memory, region) {
58 memory_start = region->base;
59 memory_end = region->base + region->size;
60 printk(KERN_INFO "%s: Memory: 0x%x-0x%x\n", __func__,
61 memory_start, memory_end);
64 if (!memory_end) {
65 panic("No memory!");
68 ram_start_pfn = PFN_UP(memory_start);
69 ram_end_pfn = PFN_DOWN(memblock_end_of_DRAM());
71 /* setup bootmem globals (we use no_bootmem, but mm still depends on this) */
72 min_low_pfn = ram_start_pfn;
73 max_low_pfn = ram_end_pfn;
74 max_pfn = ram_end_pfn;
77 * initialize the boot-time allocator (with low memory only).
79 * This makes the memory from the end of the kernel to the end of
80 * RAM usable.
82 memblock_reserve(__pa(_stext), _end - _stext);
84 early_init_fdt_reserve_self();
85 early_init_fdt_scan_reserved_mem();
87 memblock_dump_all();
90 struct cpuinfo_or1k cpuinfo_or1k[NR_CPUS];
92 static void print_cpuinfo(void)
94 unsigned long upr = mfspr(SPR_UPR);
95 unsigned long vr = mfspr(SPR_VR);
96 unsigned int version;
97 unsigned int revision;
98 struct cpuinfo_or1k *cpuinfo = &cpuinfo_or1k[smp_processor_id()];
100 version = (vr & SPR_VR_VER) >> 24;
101 revision = (vr & SPR_VR_REV);
103 printk(KERN_INFO "CPU: OpenRISC-%x (revision %d) @%d MHz\n",
104 version, revision, cpuinfo->clock_frequency / 1000000);
106 if (!(upr & SPR_UPR_UP)) {
107 printk(KERN_INFO
108 "-- no UPR register... unable to detect configuration\n");
109 return;
112 if (upr & SPR_UPR_DCP)
113 printk(KERN_INFO
114 "-- dcache: %4d bytes total, %2d bytes/line, %d way(s)\n",
115 cpuinfo->dcache_size, cpuinfo->dcache_block_size,
116 cpuinfo->dcache_ways);
117 else
118 printk(KERN_INFO "-- dcache disabled\n");
119 if (upr & SPR_UPR_ICP)
120 printk(KERN_INFO
121 "-- icache: %4d bytes total, %2d bytes/line, %d way(s)\n",
122 cpuinfo->icache_size, cpuinfo->icache_block_size,
123 cpuinfo->icache_ways);
124 else
125 printk(KERN_INFO "-- icache disabled\n");
127 if (upr & SPR_UPR_DMP)
128 printk(KERN_INFO "-- dmmu: %4d entries, %lu way(s)\n",
129 1 << ((mfspr(SPR_DMMUCFGR) & SPR_DMMUCFGR_NTS) >> 2),
130 1 + (mfspr(SPR_DMMUCFGR) & SPR_DMMUCFGR_NTW));
131 if (upr & SPR_UPR_IMP)
132 printk(KERN_INFO "-- immu: %4d entries, %lu way(s)\n",
133 1 << ((mfspr(SPR_IMMUCFGR) & SPR_IMMUCFGR_NTS) >> 2),
134 1 + (mfspr(SPR_IMMUCFGR) & SPR_IMMUCFGR_NTW));
136 printk(KERN_INFO "-- additional features:\n");
137 if (upr & SPR_UPR_DUP)
138 printk(KERN_INFO "-- debug unit\n");
139 if (upr & SPR_UPR_PCUP)
140 printk(KERN_INFO "-- performance counters\n");
141 if (upr & SPR_UPR_PMP)
142 printk(KERN_INFO "-- power management\n");
143 if (upr & SPR_UPR_PICP)
144 printk(KERN_INFO "-- PIC\n");
145 if (upr & SPR_UPR_TTP)
146 printk(KERN_INFO "-- timer\n");
147 if (upr & SPR_UPR_CUP)
148 printk(KERN_INFO "-- custom unit(s)\n");
151 static struct device_node *setup_find_cpu_node(int cpu)
153 u32 hwid;
154 struct device_node *cpun;
156 for_each_of_cpu_node(cpun) {
157 if (of_property_read_u32(cpun, "reg", &hwid))
158 continue;
159 if (hwid == cpu)
160 return cpun;
163 return NULL;
166 void __init setup_cpuinfo(void)
168 struct device_node *cpu;
169 unsigned long iccfgr, dccfgr;
170 unsigned long cache_set_size;
171 int cpu_id = smp_processor_id();
172 struct cpuinfo_or1k *cpuinfo = &cpuinfo_or1k[cpu_id];
174 cpu = setup_find_cpu_node(cpu_id);
175 if (!cpu)
176 panic("Couldn't find CPU%d in device tree...\n", cpu_id);
178 iccfgr = mfspr(SPR_ICCFGR);
179 cpuinfo->icache_ways = 1 << (iccfgr & SPR_ICCFGR_NCW);
180 cache_set_size = 1 << ((iccfgr & SPR_ICCFGR_NCS) >> 3);
181 cpuinfo->icache_block_size = 16 << ((iccfgr & SPR_ICCFGR_CBS) >> 7);
182 cpuinfo->icache_size =
183 cache_set_size * cpuinfo->icache_ways * cpuinfo->icache_block_size;
185 dccfgr = mfspr(SPR_DCCFGR);
186 cpuinfo->dcache_ways = 1 << (dccfgr & SPR_DCCFGR_NCW);
187 cache_set_size = 1 << ((dccfgr & SPR_DCCFGR_NCS) >> 3);
188 cpuinfo->dcache_block_size = 16 << ((dccfgr & SPR_DCCFGR_CBS) >> 7);
189 cpuinfo->dcache_size =
190 cache_set_size * cpuinfo->dcache_ways * cpuinfo->dcache_block_size;
192 if (of_property_read_u32(cpu, "clock-frequency",
193 &cpuinfo->clock_frequency)) {
194 printk(KERN_WARNING
195 "Device tree missing CPU 'clock-frequency' parameter."
196 "Assuming frequency 25MHZ"
197 "This is probably not what you want.");
200 cpuinfo->coreid = mfspr(SPR_COREID);
202 of_node_put(cpu);
204 print_cpuinfo();
208 * or32_early_setup
210 * Handles the pointer to the device tree that this kernel is to use
211 * for establishing the available platform devices.
213 * Falls back on built-in device tree in case null pointer is passed.
216 void __init or32_early_setup(void *fdt)
218 if (fdt)
219 pr_info("FDT at %p\n", fdt);
220 else {
221 fdt = __dtb_start;
222 pr_info("Compiled-in FDT at %p\n", fdt);
224 early_init_devtree(fdt);
227 static inline unsigned long extract_value_bits(unsigned long reg,
228 short bit_nr, short width)
230 return (reg >> bit_nr) & (0 << width);
233 static inline unsigned long extract_value(unsigned long reg, unsigned long mask)
235 while (!(mask & 0x1)) {
236 reg = reg >> 1;
237 mask = mask >> 1;
239 return mask & reg;
242 void __init detect_unit_config(unsigned long upr, unsigned long mask,
243 char *text, void (*func) (void))
245 if (text != NULL)
246 printk("%s", text);
248 if (upr & mask) {
249 if (func != NULL)
250 func();
251 else
252 printk("present\n");
253 } else
254 printk("not present\n");
258 * calibrate_delay
260 * Lightweight calibrate_delay implementation that calculates loops_per_jiffy
261 * from the clock frequency passed in via the device tree
265 void calibrate_delay(void)
267 const int *val;
268 struct device_node *cpu = setup_find_cpu_node(smp_processor_id());
270 val = of_get_property(cpu, "clock-frequency", NULL);
271 if (!val)
272 panic("no cpu 'clock-frequency' parameter in device tree");
273 loops_per_jiffy = *val / HZ;
274 pr_cont("%lu.%02lu BogoMIPS (lpj=%lu)\n",
275 loops_per_jiffy / (500000 / HZ),
276 (loops_per_jiffy / (5000 / HZ)) % 100, loops_per_jiffy);
279 void __init setup_arch(char **cmdline_p)
281 unflatten_and_copy_device_tree();
283 setup_cpuinfo();
285 #ifdef CONFIG_SMP
286 smp_init_cpus();
287 #endif
289 /* process 1's initial memory region is the kernel code/data */
290 init_mm.start_code = (unsigned long)_stext;
291 init_mm.end_code = (unsigned long)_etext;
292 init_mm.end_data = (unsigned long)_edata;
293 init_mm.brk = (unsigned long)_end;
295 #ifdef CONFIG_BLK_DEV_INITRD
296 initrd_start = (unsigned long)&__initrd_start;
297 initrd_end = (unsigned long)&__initrd_end;
298 if (initrd_start == initrd_end) {
299 initrd_start = 0;
300 initrd_end = 0;
302 initrd_below_start_ok = 1;
303 #endif
305 /* setup memblock allocator */
306 setup_memory();
308 /* paging_init() sets up the MMU and marks all pages as reserved */
309 paging_init();
311 *cmdline_p = boot_command_line;
313 printk(KERN_INFO "OpenRISC Linux -- http://openrisc.io\n");
316 static int show_cpuinfo(struct seq_file *m, void *v)
318 unsigned int vr, cpucfgr;
319 unsigned int avr;
320 unsigned int version;
321 struct cpuinfo_or1k *cpuinfo = v;
323 vr = mfspr(SPR_VR);
324 cpucfgr = mfspr(SPR_CPUCFGR);
326 #ifdef CONFIG_SMP
327 seq_printf(m, "processor\t\t: %d\n", cpuinfo->coreid);
328 #endif
329 if (vr & SPR_VR_UVRP) {
330 vr = mfspr(SPR_VR2);
331 version = vr & SPR_VR2_VER;
332 avr = mfspr(SPR_AVR);
333 seq_printf(m, "cpu architecture\t: "
334 "OpenRISC 1000 (%d.%d-rev%d)\n",
335 (avr >> 24) & 0xff,
336 (avr >> 16) & 0xff,
337 (avr >> 8) & 0xff);
338 seq_printf(m, "cpu implementation id\t: 0x%x\n",
339 (vr & SPR_VR2_CPUID) >> 24);
340 seq_printf(m, "cpu version\t\t: 0x%x\n", version);
341 } else {
342 version = (vr & SPR_VR_VER) >> 24;
343 seq_printf(m, "cpu\t\t\t: OpenRISC-%x\n", version);
344 seq_printf(m, "revision\t\t: %d\n", vr & SPR_VR_REV);
346 seq_printf(m, "frequency\t\t: %ld\n", loops_per_jiffy * HZ);
347 seq_printf(m, "dcache size\t\t: %d bytes\n", cpuinfo->dcache_size);
348 seq_printf(m, "dcache block size\t: %d bytes\n",
349 cpuinfo->dcache_block_size);
350 seq_printf(m, "dcache ways\t\t: %d\n", cpuinfo->dcache_ways);
351 seq_printf(m, "icache size\t\t: %d bytes\n", cpuinfo->icache_size);
352 seq_printf(m, "icache block size\t: %d bytes\n",
353 cpuinfo->icache_block_size);
354 seq_printf(m, "icache ways\t\t: %d\n", cpuinfo->icache_ways);
355 seq_printf(m, "immu\t\t\t: %d entries, %lu ways\n",
356 1 << ((mfspr(SPR_DMMUCFGR) & SPR_DMMUCFGR_NTS) >> 2),
357 1 + (mfspr(SPR_DMMUCFGR) & SPR_DMMUCFGR_NTW));
358 seq_printf(m, "dmmu\t\t\t: %d entries, %lu ways\n",
359 1 << ((mfspr(SPR_IMMUCFGR) & SPR_IMMUCFGR_NTS) >> 2),
360 1 + (mfspr(SPR_IMMUCFGR) & SPR_IMMUCFGR_NTW));
361 seq_printf(m, "bogomips\t\t: %lu.%02lu\n",
362 (loops_per_jiffy * HZ) / 500000,
363 ((loops_per_jiffy * HZ) / 5000) % 100);
365 seq_puts(m, "features\t\t: ");
366 seq_printf(m, "%s ", cpucfgr & SPR_CPUCFGR_OB32S ? "orbis32" : "");
367 seq_printf(m, "%s ", cpucfgr & SPR_CPUCFGR_OB64S ? "orbis64" : "");
368 seq_printf(m, "%s ", cpucfgr & SPR_CPUCFGR_OF32S ? "orfpx32" : "");
369 seq_printf(m, "%s ", cpucfgr & SPR_CPUCFGR_OF64S ? "orfpx64" : "");
370 seq_printf(m, "%s ", cpucfgr & SPR_CPUCFGR_OV64S ? "orvdx64" : "");
371 seq_puts(m, "\n");
373 seq_puts(m, "\n");
375 return 0;
378 static void *c_start(struct seq_file *m, loff_t *pos)
380 *pos = cpumask_next(*pos - 1, cpu_online_mask);
381 if ((*pos) < nr_cpu_ids)
382 return &cpuinfo_or1k[*pos];
383 return NULL;
386 static void *c_next(struct seq_file *m, void *v, loff_t *pos)
388 (*pos)++;
389 return c_start(m, pos);
392 static void c_stop(struct seq_file *m, void *v)
396 const struct seq_operations cpuinfo_op = {
397 .start = c_start,
398 .next = c_next,
399 .stop = c_stop,
400 .show = show_cpuinfo,