Linux Audio

Check our new training course

Loading...
v5.9
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * OpenRISC setup.c
  4 *
  5 * Linux architectural port borrowing liberally from similar works of
  6 * others.  All original copyrights apply as per the original source
  7 * declaration.
  8 *
  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>
 12 *
 
 
 
 
 
 13 * This file handles the architecture-dependent parts of initialization
 14 */
 15
 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>
 
 36
 37#include <asm/sections.h>
 
 
 38#include <asm/types.h>
 39#include <asm/setup.h>
 40#include <asm/io.h>
 41#include <asm/cpuinfo.h>
 42#include <asm/delay.h>
 43
 44#include "vmlinux.h"
 45
 46static void __init setup_memory(void)
 47{
 
 48	unsigned long ram_start_pfn;
 
 49	unsigned long ram_end_pfn;
 50	phys_addr_t memory_start, memory_end;
 51	struct memblock_region *region;
 52
 53	memory_end = memory_start = 0;
 54
 55	/* Find main memory where is the kernel, we assume its the only one */
 56	for_each_memblock(memory, region) {
 57		memory_start = region->base;
 58		memory_end = region->base + region->size;
 59		printk(KERN_INFO "%s: Memory: 0x%x-0x%x\n", __func__,
 60		       memory_start, memory_end);
 61	}
 62
 63	if (!memory_end) {
 64		panic("No memory!");
 65	}
 66
 67	ram_start_pfn = PFN_UP(memory_start);
 
 
 68	ram_end_pfn = PFN_DOWN(memblock_end_of_DRAM());
 69
 70	/* setup bootmem globals (we use no_bootmem, but mm still depends on this) */
 71	min_low_pfn = ram_start_pfn;
 72	max_low_pfn = ram_end_pfn;
 73	max_pfn = ram_end_pfn;
 74
 75	/*
 76	 * initialize the boot-time allocator (with low memory only).
 77	 *
 78	 * This makes the memory from the end of the kernel to the end of
 79	 * RAM usable.
 
 80	 */
 81	memblock_reserve(__pa(_stext), _end - _stext);
 82
 83#ifdef CONFIG_BLK_DEV_INITRD
 84	/* Then reserve the initrd, if any */
 85	if (initrd_start && (initrd_end > initrd_start)) {
 86		unsigned long aligned_start = ALIGN_DOWN(initrd_start, PAGE_SIZE);
 87		unsigned long aligned_end = ALIGN(initrd_end, PAGE_SIZE);
 88
 89		memblock_reserve(__pa(aligned_start), aligned_end - aligned_start);
 
 
 90	}
 91#endif /* CONFIG_BLK_DEV_INITRD */
 92
 93	early_init_fdt_reserve_self();
 94	early_init_fdt_scan_reserved_mem();
 95
 96	memblock_dump_all();
 97}
 98
 99struct cpuinfo_or1k cpuinfo_or1k[NR_CPUS];
100
101static void print_cpuinfo(void)
102{
103	unsigned long upr = mfspr(SPR_UPR);
104	unsigned long vr = mfspr(SPR_VR);
105	unsigned int version;
106	unsigned int revision;
107	struct cpuinfo_or1k *cpuinfo = &cpuinfo_or1k[smp_processor_id()];
108
109	version = (vr & SPR_VR_VER) >> 24;
110	revision = (vr & SPR_VR_REV);
111
112	printk(KERN_INFO "CPU: OpenRISC-%x (revision %d) @%d MHz\n",
113	       version, revision, cpuinfo->clock_frequency / 1000000);
114
115	if (!(upr & SPR_UPR_UP)) {
116		printk(KERN_INFO
117		       "-- no UPR register... unable to detect configuration\n");
118		return;
119	}
120
121	if (upr & SPR_UPR_DCP)
122		printk(KERN_INFO
123		       "-- dcache: %4d bytes total, %2d bytes/line, %d way(s)\n",
124		       cpuinfo->dcache_size, cpuinfo->dcache_block_size,
125		       cpuinfo->dcache_ways);
126	else
127		printk(KERN_INFO "-- dcache disabled\n");
128	if (upr & SPR_UPR_ICP)
129		printk(KERN_INFO
130		       "-- icache: %4d bytes total, %2d bytes/line, %d way(s)\n",
131		       cpuinfo->icache_size, cpuinfo->icache_block_size,
132		       cpuinfo->icache_ways);
133	else
134		printk(KERN_INFO "-- icache disabled\n");
135
136	if (upr & SPR_UPR_DMP)
137		printk(KERN_INFO "-- dmmu: %4d entries, %lu way(s)\n",
138		       1 << ((mfspr(SPR_DMMUCFGR) & SPR_DMMUCFGR_NTS) >> 2),
139		       1 + (mfspr(SPR_DMMUCFGR) & SPR_DMMUCFGR_NTW));
140	if (upr & SPR_UPR_IMP)
141		printk(KERN_INFO "-- immu: %4d entries, %lu way(s)\n",
142		       1 << ((mfspr(SPR_IMMUCFGR) & SPR_IMMUCFGR_NTS) >> 2),
143		       1 + (mfspr(SPR_IMMUCFGR) & SPR_IMMUCFGR_NTW));
144
145	printk(KERN_INFO "-- additional features:\n");
146	if (upr & SPR_UPR_DUP)
147		printk(KERN_INFO "-- debug unit\n");
148	if (upr & SPR_UPR_PCUP)
149		printk(KERN_INFO "-- performance counters\n");
150	if (upr & SPR_UPR_PMP)
151		printk(KERN_INFO "-- power management\n");
152	if (upr & SPR_UPR_PICP)
153		printk(KERN_INFO "-- PIC\n");
154	if (upr & SPR_UPR_TTP)
155		printk(KERN_INFO "-- timer\n");
156	if (upr & SPR_UPR_CUP)
157		printk(KERN_INFO "-- custom unit(s)\n");
158}
159
160static struct device_node *setup_find_cpu_node(int cpu)
161{
162	u32 hwid;
163	struct device_node *cpun;
164
165	for_each_of_cpu_node(cpun) {
166		if (of_property_read_u32(cpun, "reg", &hwid))
167			continue;
168		if (hwid == cpu)
169			return cpun;
170	}
171
172	return NULL;
173}
174
175void __init setup_cpuinfo(void)
176{
177	struct device_node *cpu;
178	unsigned long iccfgr, dccfgr;
179	unsigned long cache_set_size;
180	int cpu_id = smp_processor_id();
181	struct cpuinfo_or1k *cpuinfo = &cpuinfo_or1k[cpu_id];
182
183	cpu = setup_find_cpu_node(cpu_id);
184	if (!cpu)
185		panic("Couldn't find CPU%d in device tree...\n", cpu_id);
186
187	iccfgr = mfspr(SPR_ICCFGR);
188	cpuinfo->icache_ways = 1 << (iccfgr & SPR_ICCFGR_NCW);
189	cache_set_size = 1 << ((iccfgr & SPR_ICCFGR_NCS) >> 3);
190	cpuinfo->icache_block_size = 16 << ((iccfgr & SPR_ICCFGR_CBS) >> 7);
191	cpuinfo->icache_size =
192	    cache_set_size * cpuinfo->icache_ways * cpuinfo->icache_block_size;
193
194	dccfgr = mfspr(SPR_DCCFGR);
195	cpuinfo->dcache_ways = 1 << (dccfgr & SPR_DCCFGR_NCW);
196	cache_set_size = 1 << ((dccfgr & SPR_DCCFGR_NCS) >> 3);
197	cpuinfo->dcache_block_size = 16 << ((dccfgr & SPR_DCCFGR_CBS) >> 7);
198	cpuinfo->dcache_size =
199	    cache_set_size * cpuinfo->dcache_ways * cpuinfo->dcache_block_size;
200
201	if (of_property_read_u32(cpu, "clock-frequency",
202				 &cpuinfo->clock_frequency)) {
203		printk(KERN_WARNING
204		       "Device tree missing CPU 'clock-frequency' parameter."
205		       "Assuming frequency 25MHZ"
206		       "This is probably not what you want.");
207	}
208
209	cpuinfo->coreid = mfspr(SPR_COREID);
210
211	of_node_put(cpu);
212
213	print_cpuinfo();
214}
215
216/**
217 * or32_early_setup
218 *
219 * Handles the pointer to the device tree that this kernel is to use
220 * for establishing the available platform devices.
221 *
222 * Falls back on built-in device tree in case null pointer is passed.
223 */
224
225void __init or32_early_setup(void *fdt)
226{
227	if (fdt)
228		pr_info("FDT at %p\n", fdt);
229	else {
230		fdt = __dtb_start;
231		pr_info("Compiled-in FDT at %p\n", fdt);
232	}
233	early_init_devtree(fdt);
234}
235
 
 
 
 
 
 
 
 
 
236static inline unsigned long extract_value_bits(unsigned long reg,
237					       short bit_nr, short width)
238{
239	return (reg >> bit_nr) & (0 << width);
240}
241
242static inline unsigned long extract_value(unsigned long reg, unsigned long mask)
243{
244	while (!(mask & 0x1)) {
245		reg = reg >> 1;
246		mask = mask >> 1;
247	}
248	return mask & reg;
249}
250
251void __init detect_unit_config(unsigned long upr, unsigned long mask,
252			       char *text, void (*func) (void))
253{
254	if (text != NULL)
255		printk("%s", text);
256
257	if (upr & mask) {
258		if (func != NULL)
259			func();
260		else
261			printk("present\n");
262	} else
263		printk("not present\n");
264}
265
266/*
267 * calibrate_delay
268 *
269 * Lightweight calibrate_delay implementation that calculates loops_per_jiffy
270 * from the clock frequency passed in via the device tree
271 *
272 */
273
274void calibrate_delay(void)
275{
276	const int *val;
277	struct device_node *cpu = setup_find_cpu_node(smp_processor_id());
278
279	val = of_get_property(cpu, "clock-frequency", NULL);
280	if (!val)
281		panic("no cpu 'clock-frequency' parameter in device tree");
282	loops_per_jiffy = *val / HZ;
283	pr_cont("%lu.%02lu BogoMIPS (lpj=%lu)\n",
284		loops_per_jiffy / (500000 / HZ),
285		(loops_per_jiffy / (5000 / HZ)) % 100, loops_per_jiffy);
286}
287
288void __init setup_arch(char **cmdline_p)
289{
 
 
290	unflatten_and_copy_device_tree();
291
292	setup_cpuinfo();
293
294#ifdef CONFIG_SMP
295	smp_init_cpus();
296#endif
297
298	/* process 1's initial memory region is the kernel code/data */
299	init_mm.start_code = (unsigned long)_stext;
300	init_mm.end_code = (unsigned long)_etext;
301	init_mm.end_data = (unsigned long)_edata;
302	init_mm.brk = (unsigned long)_end;
303
304#ifdef CONFIG_BLK_DEV_INITRD
 
 
305	if (initrd_start == initrd_end) {
306		printk(KERN_INFO "Initial ramdisk not found\n");
307		initrd_start = 0;
308		initrd_end = 0;
309	} else {
310		printk(KERN_INFO "Initial ramdisk at: 0x%p (%lu bytes)\n",
311		       (void *)(initrd_start), initrd_end - initrd_start);
312		initrd_below_start_ok = 1;
313	}
 
314#endif
315
316	/* setup memblock allocator */
317	setup_memory();
318
319	/* paging_init() sets up the MMU and marks all pages as reserved */
320	paging_init();
321
 
 
 
 
 
322	*cmdline_p = boot_command_line;
323
324	printk(KERN_INFO "OpenRISC Linux -- http://openrisc.io\n");
325}
326
327static int show_cpuinfo(struct seq_file *m, void *v)
328{
329	unsigned int vr, cpucfgr;
330	unsigned int avr;
331	unsigned int version;
332	struct cpuinfo_or1k *cpuinfo = v;
333
334	vr = mfspr(SPR_VR);
335	cpucfgr = mfspr(SPR_CPUCFGR);
336
337#ifdef CONFIG_SMP
338	seq_printf(m, "processor\t\t: %d\n", cpuinfo->coreid);
339#endif
340	if (vr & SPR_VR_UVRP) {
341		vr = mfspr(SPR_VR2);
342		version = vr & SPR_VR2_VER;
343		avr = mfspr(SPR_AVR);
344		seq_printf(m, "cpu architecture\t: "
345			   "OpenRISC 1000 (%d.%d-rev%d)\n",
346			   (avr >> 24) & 0xff,
347			   (avr >> 16) & 0xff,
348			   (avr >> 8) & 0xff);
349		seq_printf(m, "cpu implementation id\t: 0x%x\n",
350			   (vr & SPR_VR2_CPUID) >> 24);
351		seq_printf(m, "cpu version\t\t: 0x%x\n", version);
352	} else {
353		version = (vr & SPR_VR_VER) >> 24;
354		seq_printf(m, "cpu\t\t\t: OpenRISC-%x\n", version);
355		seq_printf(m, "revision\t\t: %d\n", vr & SPR_VR_REV);
356	}
357	seq_printf(m, "frequency\t\t: %ld\n", loops_per_jiffy * HZ);
358	seq_printf(m, "dcache size\t\t: %d bytes\n", cpuinfo->dcache_size);
359	seq_printf(m, "dcache block size\t: %d bytes\n",
360		   cpuinfo->dcache_block_size);
361	seq_printf(m, "dcache ways\t\t: %d\n", cpuinfo->dcache_ways);
362	seq_printf(m, "icache size\t\t: %d bytes\n", cpuinfo->icache_size);
363	seq_printf(m, "icache block size\t: %d bytes\n",
364		   cpuinfo->icache_block_size);
365	seq_printf(m, "icache ways\t\t: %d\n", cpuinfo->icache_ways);
366	seq_printf(m, "immu\t\t\t: %d entries, %lu ways\n",
367		   1 << ((mfspr(SPR_DMMUCFGR) & SPR_DMMUCFGR_NTS) >> 2),
368		   1 + (mfspr(SPR_DMMUCFGR) & SPR_DMMUCFGR_NTW));
369	seq_printf(m, "dmmu\t\t\t: %d entries, %lu ways\n",
370		   1 << ((mfspr(SPR_IMMUCFGR) & SPR_IMMUCFGR_NTS) >> 2),
371		   1 + (mfspr(SPR_IMMUCFGR) & SPR_IMMUCFGR_NTW));
372	seq_printf(m, "bogomips\t\t: %lu.%02lu\n",
373		   (loops_per_jiffy * HZ) / 500000,
374		   ((loops_per_jiffy * HZ) / 5000) % 100);
375
376	seq_puts(m, "features\t\t: ");
377	seq_printf(m, "%s ", cpucfgr & SPR_CPUCFGR_OB32S ? "orbis32" : "");
378	seq_printf(m, "%s ", cpucfgr & SPR_CPUCFGR_OB64S ? "orbis64" : "");
379	seq_printf(m, "%s ", cpucfgr & SPR_CPUCFGR_OF32S ? "orfpx32" : "");
380	seq_printf(m, "%s ", cpucfgr & SPR_CPUCFGR_OF64S ? "orfpx64" : "");
381	seq_printf(m, "%s ", cpucfgr & SPR_CPUCFGR_OV64S ? "orvdx64" : "");
382	seq_puts(m, "\n");
383
384	seq_puts(m, "\n");
385
386	return 0;
387}
388
389static void *c_start(struct seq_file *m, loff_t *pos)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
390{
391	*pos = cpumask_next(*pos - 1, cpu_online_mask);
392	if ((*pos) < nr_cpu_ids)
393		return &cpuinfo_or1k[*pos];
394	return NULL;
395}
396
397static void *c_next(struct seq_file *m, void *v, loff_t *pos)
398{
399	(*pos)++;
400	return c_start(m, pos);
401}
402
403static void c_stop(struct seq_file *m, void *v)
404{
405}
406
407const struct seq_operations cpuinfo_op = {
408	.start = c_start,
409	.next = c_next,
410	.stop = c_stop,
411	.show = show_cpuinfo,
412};
v3.15
 
  1/*
  2 * OpenRISC setup.c
  3 *
  4 * Linux architectural port borrowing liberally from similar works of
  5 * others.  All original copyrights apply as per the original source
  6 * declaration.
  7 *
  8 * Modifications for the OpenRISC architecture:
  9 * Copyright (C) 2003 Matjaz Breskvar <phoenix@bsemi.com>
 10 * Copyright (C) 2010-2011 Jonas Bonn <jonas@southpole.se>
 11 *
 12 *      This program is free software; you can redistribute it and/or
 13 *      modify it under the terms of the GNU General Public License
 14 *      as published by the Free Software Foundation; either version
 15 *      2 of the License, or (at your option) any later version.
 16 *
 17 * This file handles the architecture-dependent parts of initialization
 18 */
 19
 20#include <linux/errno.h>
 21#include <linux/sched.h>
 22#include <linux/kernel.h>
 23#include <linux/mm.h>
 24#include <linux/stddef.h>
 25#include <linux/unistd.h>
 26#include <linux/ptrace.h>
 27#include <linux/slab.h>
 28#include <linux/tty.h>
 29#include <linux/ioport.h>
 30#include <linux/delay.h>
 31#include <linux/console.h>
 32#include <linux/init.h>
 33#include <linux/bootmem.h>
 34#include <linux/seq_file.h>
 35#include <linux/serial.h>
 36#include <linux/initrd.h>
 37#include <linux/of_fdt.h>
 38#include <linux/of.h>
 39#include <linux/memblock.h>
 40#include <linux/device.h>
 41#include <linux/of_platform.h>
 42
 43#include <asm/sections.h>
 44#include <asm/segment.h>
 45#include <asm/pgtable.h>
 46#include <asm/types.h>
 47#include <asm/setup.h>
 48#include <asm/io.h>
 49#include <asm/cpuinfo.h>
 50#include <asm/delay.h>
 51
 52#include "vmlinux.h"
 53
 54static unsigned long __init setup_memory(void)
 55{
 56	unsigned long bootmap_size;
 57	unsigned long ram_start_pfn;
 58	unsigned long free_ram_start_pfn;
 59	unsigned long ram_end_pfn;
 60	phys_addr_t memory_start, memory_end;
 61	struct memblock_region *region;
 62
 63	memory_end = memory_start = 0;
 64
 65	/* Find main memory where is the kernel */
 66	for_each_memblock(memory, region) {
 67		memory_start = region->base;
 68		memory_end = region->base + region->size;
 69		printk(KERN_INFO "%s: Memory: 0x%x-0x%x\n", __func__,
 70		       memory_start, memory_end);
 71	}
 72
 73	if (!memory_end) {
 74		panic("No memory!");
 75	}
 76
 77	ram_start_pfn = PFN_UP(memory_start);
 78	/* free_ram_start_pfn is first page after kernel */
 79	free_ram_start_pfn = PFN_UP(__pa(_end));
 80	ram_end_pfn = PFN_DOWN(memblock_end_of_DRAM());
 81
 
 
 
 82	max_pfn = ram_end_pfn;
 83
 84	/*
 85	 * initialize the boot-time allocator (with low memory only).
 86	 *
 87	 * This makes the memory from the end of the kernel to the end of
 88	 * RAM usable.
 89	 * init_bootmem sets the global values min_low_pfn, max_low_pfn.
 90	 */
 91	bootmap_size = init_bootmem(free_ram_start_pfn,
 92				    ram_end_pfn - ram_start_pfn);
 93	free_bootmem(PFN_PHYS(free_ram_start_pfn),
 94		     (ram_end_pfn - free_ram_start_pfn) << PAGE_SHIFT);
 95	reserve_bootmem(PFN_PHYS(free_ram_start_pfn), bootmap_size,
 96			BOOTMEM_DEFAULT);
 97
 98	for_each_memblock(reserved, region) {
 99		printk(KERN_INFO "Reserved - 0x%08x-0x%08x\n",
100		       (u32) region->base, (u32) region->size);
101		reserve_bootmem(region->base, region->size, BOOTMEM_DEFAULT);
102	}
 
 
 
 
103
104	return ram_end_pfn;
105}
106
107struct cpuinfo cpuinfo;
108
109static void print_cpuinfo(void)
110{
111	unsigned long upr = mfspr(SPR_UPR);
112	unsigned long vr = mfspr(SPR_VR);
113	unsigned int version;
114	unsigned int revision;
 
115
116	version = (vr & SPR_VR_VER) >> 24;
117	revision = (vr & SPR_VR_REV);
118
119	printk(KERN_INFO "CPU: OpenRISC-%x (revision %d) @%d MHz\n",
120	       version, revision, cpuinfo.clock_frequency / 1000000);
121
122	if (!(upr & SPR_UPR_UP)) {
123		printk(KERN_INFO
124		       "-- no UPR register... unable to detect configuration\n");
125		return;
126	}
127
128	if (upr & SPR_UPR_DCP)
129		printk(KERN_INFO
130		       "-- dcache: %4d bytes total, %2d bytes/line, %d way(s)\n",
131		       cpuinfo.dcache_size, cpuinfo.dcache_block_size, 1);
 
132	else
133		printk(KERN_INFO "-- dcache disabled\n");
134	if (upr & SPR_UPR_ICP)
135		printk(KERN_INFO
136		       "-- icache: %4d bytes total, %2d bytes/line, %d way(s)\n",
137		       cpuinfo.icache_size, cpuinfo.icache_block_size, 1);
 
138	else
139		printk(KERN_INFO "-- icache disabled\n");
140
141	if (upr & SPR_UPR_DMP)
142		printk(KERN_INFO "-- dmmu: %4d entries, %lu way(s)\n",
143		       1 << ((mfspr(SPR_DMMUCFGR) & SPR_DMMUCFGR_NTS) >> 2),
144		       1 + (mfspr(SPR_DMMUCFGR) & SPR_DMMUCFGR_NTW));
145	if (upr & SPR_UPR_IMP)
146		printk(KERN_INFO "-- immu: %4d entries, %lu way(s)\n",
147		       1 << ((mfspr(SPR_IMMUCFGR) & SPR_IMMUCFGR_NTS) >> 2),
148		       1 + (mfspr(SPR_IMMUCFGR) & SPR_IMMUCFGR_NTW));
149
150	printk(KERN_INFO "-- additional features:\n");
151	if (upr & SPR_UPR_DUP)
152		printk(KERN_INFO "-- debug unit\n");
153	if (upr & SPR_UPR_PCUP)
154		printk(KERN_INFO "-- performance counters\n");
155	if (upr & SPR_UPR_PMP)
156		printk(KERN_INFO "-- power management\n");
157	if (upr & SPR_UPR_PICP)
158		printk(KERN_INFO "-- PIC\n");
159	if (upr & SPR_UPR_TTP)
160		printk(KERN_INFO "-- timer\n");
161	if (upr & SPR_UPR_CUP)
162		printk(KERN_INFO "-- custom unit(s)\n");
163}
164
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
165void __init setup_cpuinfo(void)
166{
167	struct device_node *cpu;
168	unsigned long iccfgr, dccfgr;
169	unsigned long cache_set_size, cache_ways;
 
 
170
171	cpu = of_find_compatible_node(NULL, NULL, "opencores,or1200-rtlsvn481");
172	if (!cpu)
173		panic("No compatible CPU found in device tree...\n");
174
175	iccfgr = mfspr(SPR_ICCFGR);
176	cache_ways = 1 << (iccfgr & SPR_ICCFGR_NCW);
177	cache_set_size = 1 << ((iccfgr & SPR_ICCFGR_NCS) >> 3);
178	cpuinfo.icache_block_size = 16 << ((iccfgr & SPR_ICCFGR_CBS) >> 7);
179	cpuinfo.icache_size =
180	    cache_set_size * cache_ways * cpuinfo.icache_block_size;
181
182	dccfgr = mfspr(SPR_DCCFGR);
183	cache_ways = 1 << (dccfgr & SPR_DCCFGR_NCW);
184	cache_set_size = 1 << ((dccfgr & SPR_DCCFGR_NCS) >> 3);
185	cpuinfo.dcache_block_size = 16 << ((dccfgr & SPR_DCCFGR_CBS) >> 7);
186	cpuinfo.dcache_size =
187	    cache_set_size * cache_ways * cpuinfo.dcache_block_size;
188
189	if (of_property_read_u32(cpu, "clock-frequency",
190				 &cpuinfo.clock_frequency)) {
191		printk(KERN_WARNING
192		       "Device tree missing CPU 'clock-frequency' parameter."
193		       "Assuming frequency 25MHZ"
194		       "This is probably not what you want.");
195	}
196
 
 
197	of_node_put(cpu);
198
199	print_cpuinfo();
200}
201
202/**
203 * or32_early_setup
204 *
205 * Handles the pointer to the device tree that this kernel is to use
206 * for establishing the available platform devices.
207 *
208 * Falls back on built-in device tree in case null pointer is passed.
209 */
210
211void __init or32_early_setup(void *fdt)
212{
213	if (fdt)
214		pr_info("FDT at %p\n", fdt);
215	else {
216		fdt = __dtb_start;
217		pr_info("Compiled-in FDT at %p\n", fdt);
218	}
219	early_init_devtree(fdt);
220}
221
222static int __init openrisc_device_probe(void)
223{
224	of_platform_populate(NULL, NULL, NULL, NULL);
225
226	return 0;
227}
228
229device_initcall(openrisc_device_probe);
230
231static inline unsigned long extract_value_bits(unsigned long reg,
232					       short bit_nr, short width)
233{
234	return (reg >> bit_nr) & (0 << width);
235}
236
237static inline unsigned long extract_value(unsigned long reg, unsigned long mask)
238{
239	while (!(mask & 0x1)) {
240		reg = reg >> 1;
241		mask = mask >> 1;
242	}
243	return mask & reg;
244}
245
246void __init detect_unit_config(unsigned long upr, unsigned long mask,
247			       char *text, void (*func) (void))
248{
249	if (text != NULL)
250		printk("%s", text);
251
252	if (upr & mask) {
253		if (func != NULL)
254			func();
255		else
256			printk("present\n");
257	} else
258		printk("not present\n");
259}
260
261/*
262 * calibrate_delay
263 *
264 * Lightweight calibrate_delay implementation that calculates loops_per_jiffy
265 * from the clock frequency passed in via the device tree
266 *
267 */
268
269void calibrate_delay(void)
270{
271	const int *val;
272	struct device_node *cpu = NULL;
273	cpu = of_find_compatible_node(NULL, NULL, "opencores,or1200-rtlsvn481");
274	val = of_get_property(cpu, "clock-frequency", NULL);
275	if (!val)
276		panic("no cpu 'clock-frequency' parameter in device tree");
277	loops_per_jiffy = *val / HZ;
278	pr_cont("%lu.%02lu BogoMIPS (lpj=%lu)\n",
279		loops_per_jiffy / (500000 / HZ),
280		(loops_per_jiffy / (5000 / HZ)) % 100, loops_per_jiffy);
281}
282
283void __init setup_arch(char **cmdline_p)
284{
285	unsigned long max_low_pfn;
286
287	unflatten_and_copy_device_tree();
288
289	setup_cpuinfo();
290
 
 
 
 
291	/* process 1's initial memory region is the kernel code/data */
292	init_mm.start_code = (unsigned long)_stext;
293	init_mm.end_code = (unsigned long)_etext;
294	init_mm.end_data = (unsigned long)_edata;
295	init_mm.brk = (unsigned long)_end;
296
297#ifdef CONFIG_BLK_DEV_INITRD
298	initrd_start = (unsigned long)&__initrd_start;
299	initrd_end = (unsigned long)&__initrd_end;
300	if (initrd_start == initrd_end) {
 
301		initrd_start = 0;
302		initrd_end = 0;
 
 
 
 
303	}
304	initrd_below_start_ok = 1;
305#endif
306
307	/* setup bootmem allocator */
308	max_low_pfn = setup_memory();
309
310	/* paging_init() sets up the MMU and marks all pages as reserved */
311	paging_init();
312
313#if defined(CONFIG_VT) && defined(CONFIG_DUMMY_CONSOLE)
314	if (!conswitchp)
315		conswitchp = &dummy_con;
316#endif
317
318	*cmdline_p = boot_command_line;
319
320	printk(KERN_INFO "OpenRISC Linux -- http://openrisc.net\n");
321}
322
323static int show_cpuinfo(struct seq_file *m, void *v)
324{
325	unsigned long vr;
326	int version, revision;
 
 
327
328	vr = mfspr(SPR_VR);
329	version = (vr & SPR_VR_VER) >> 24;
330	revision = vr & SPR_VR_REV;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
331
332	return seq_printf(m,
333			  "cpu\t\t: OpenRISC-%x\n"
334			  "revision\t: %d\n"
335			  "frequency\t: %ld\n"
336			  "dcache size\t: %d bytes\n"
337			  "dcache block size\t: %d bytes\n"
338			  "icache size\t: %d bytes\n"
339			  "icache block size\t: %d bytes\n"
340			  "immu\t\t: %d entries, %lu ways\n"
341			  "dmmu\t\t: %d entries, %lu ways\n"
342			  "bogomips\t: %lu.%02lu\n",
343			  version,
344			  revision,
345			  loops_per_jiffy * HZ,
346			  cpuinfo.dcache_size,
347			  cpuinfo.dcache_block_size,
348			  cpuinfo.icache_size,
349			  cpuinfo.icache_block_size,
350			  1 << ((mfspr(SPR_DMMUCFGR) & SPR_DMMUCFGR_NTS) >> 2),
351			  1 + (mfspr(SPR_DMMUCFGR) & SPR_DMMUCFGR_NTW),
352			  1 << ((mfspr(SPR_IMMUCFGR) & SPR_IMMUCFGR_NTS) >> 2),
353			  1 + (mfspr(SPR_IMMUCFGR) & SPR_IMMUCFGR_NTW),
354			  (loops_per_jiffy * HZ) / 500000,
355			  ((loops_per_jiffy * HZ) / 5000) % 100);
356}
357
358static void *c_start(struct seq_file *m, loff_t * pos)
359{
360	/* We only have one CPU... */
361	return *pos < 1 ? (void *)1 : NULL;
 
 
362}
363
364static void *c_next(struct seq_file *m, void *v, loff_t * pos)
365{
366	++*pos;
367	return NULL;
368}
369
370static void c_stop(struct seq_file *m, void *v)
371{
372}
373
374const struct seq_operations cpuinfo_op = {
375	.start = c_start,
376	.next = c_next,
377	.stop = c_stop,
378	.show = show_cpuinfo,
379};