1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/errno.h>
18#include <linux/init.h>
19#include <linux/mm.h>
20#include <linux/proc_fs.h>
21#include <linux/screen_info.h>
22#include <linux/bootmem.h>
23#include <linux/kernel.h>
24#include <linux/percpu.h>
25#include <linux/clk-provider.h>
26#include <linux/cpu.h>
27#include <linux/of_fdt.h>
28#include <linux/of_platform.h>
29
30#if defined(CONFIG_VGA_CONSOLE) || defined(CONFIG_DUMMY_CONSOLE)
31# include <linux/console.h>
32#endif
33
34#ifdef CONFIG_RTC
35# include <linux/timex.h>
36#endif
37
38#ifdef CONFIG_PROC_FS
39# include <linux/seq_file.h>
40#endif
41
42#include <asm/bootparam.h>
43#include <asm/mmu_context.h>
44#include <asm/pgtable.h>
45#include <asm/processor.h>
46#include <asm/timex.h>
47#include <asm/platform.h>
48#include <asm/page.h>
49#include <asm/setup.h>
50#include <asm/param.h>
51#include <asm/traps.h>
52#include <asm/smp.h>
53#include <asm/sysmem.h>
54
55#include <platform/hardware.h>
56
57#if defined(CONFIG_VGA_CONSOLE) || defined(CONFIG_DUMMY_CONSOLE)
58struct screen_info screen_info = { 0, 24, 0, 0, 0, 80, 0, 0, 0, 24, 1, 16};
59#endif
60
61#ifdef CONFIG_BLK_DEV_FD
62extern struct fd_ops no_fd_ops;
63struct fd_ops *fd_ops;
64#endif
65
66extern struct rtc_ops no_rtc_ops;
67struct rtc_ops *rtc_ops;
68
69#ifdef CONFIG_BLK_DEV_INITRD
70extern unsigned long initrd_start;
71extern unsigned long initrd_end;
72int initrd_is_mapped = 0;
73extern int initrd_below_start_ok;
74#endif
75
76#ifdef CONFIG_OF
77void *dtb_start = __dtb_start;
78#endif
79
80unsigned char aux_device_present;
81extern unsigned long loops_per_jiffy;
82
83
84
85static char __initdata command_line[COMMAND_LINE_SIZE];
86
87#ifdef CONFIG_CMDLINE_BOOL
88static char default_command_line[COMMAND_LINE_SIZE] __initdata = CONFIG_CMDLINE;
89#endif
90
91
92
93
94
95
96
97
98
99
100typedef struct tagtable {
101 u32 tag;
102 int (*parse)(const bp_tag_t*);
103} tagtable_t;
104
105#define __tagtable(tag, fn) static tagtable_t __tagtable_##fn \
106 __attribute__((used, section(".taglist"))) = { tag, fn }
107
108
109
110static int __init parse_tag_mem(const bp_tag_t *tag)
111{
112 struct bp_meminfo *mi = (struct bp_meminfo *)(tag->data);
113
114 if (mi->type != MEMORY_TYPE_CONVENTIONAL)
115 return -1;
116
117 return add_sysmem_bank(mi->start, mi->end);
118}
119
120__tagtable(BP_TAG_MEMORY, parse_tag_mem);
121
122#ifdef CONFIG_BLK_DEV_INITRD
123
124static int __init parse_tag_initrd(const bp_tag_t* tag)
125{
126 struct bp_meminfo *mi = (struct bp_meminfo *)(tag->data);
127
128 initrd_start = (unsigned long)__va(mi->start);
129 initrd_end = (unsigned long)__va(mi->end);
130
131 return 0;
132}
133
134__tagtable(BP_TAG_INITRD, parse_tag_initrd);
135
136#ifdef CONFIG_OF
137
138static int __init parse_tag_fdt(const bp_tag_t *tag)
139{
140 dtb_start = __va(tag->data[0]);
141 return 0;
142}
143
144__tagtable(BP_TAG_FDT, parse_tag_fdt);
145
146#endif
147
148#endif
149
150static int __init parse_tag_cmdline(const bp_tag_t* tag)
151{
152 strlcpy(command_line, (char *)(tag->data), COMMAND_LINE_SIZE);
153 return 0;
154}
155
156__tagtable(BP_TAG_COMMAND_LINE, parse_tag_cmdline);
157
158static int __init parse_bootparam(const bp_tag_t* tag)
159{
160 extern tagtable_t __tagtable_begin, __tagtable_end;
161 tagtable_t *t;
162
163
164
165 if (tag->id != BP_TAG_FIRST) {
166 printk(KERN_WARNING "Invalid boot parameters!\n");
167 return 0;
168 }
169
170 tag = (bp_tag_t*)((unsigned long)tag + sizeof(bp_tag_t) + tag->size);
171
172
173
174 while (tag != NULL && tag->id != BP_TAG_LAST) {
175 for (t = &__tagtable_begin; t < &__tagtable_end; t++) {
176 if (tag->id == t->tag) {
177 t->parse(tag);
178 break;
179 }
180 }
181 if (t == &__tagtable_end)
182 printk(KERN_WARNING "Ignoring tag "
183 "0x%08x\n", tag->id);
184 tag = (bp_tag_t*)((unsigned long)(tag + 1) + tag->size);
185 }
186
187 return 0;
188}
189
190#ifdef CONFIG_OF
191bool __initdata dt_memory_scan = false;
192
193#if XCHAL_HAVE_PTP_MMU && XCHAL_HAVE_SPANNING_WAY
194unsigned long xtensa_kio_paddr = XCHAL_KIO_DEFAULT_PADDR;
195EXPORT_SYMBOL(xtensa_kio_paddr);
196
197static int __init xtensa_dt_io_area(unsigned long node, const char *uname,
198 int depth, void *data)
199{
200 const __be32 *ranges;
201 int len;
202
203 if (depth > 1)
204 return 0;
205
206 if (!of_flat_dt_is_compatible(node, "simple-bus"))
207 return 0;
208
209 ranges = of_get_flat_dt_prop(node, "ranges", &len);
210 if (!ranges)
211 return 1;
212 if (len == 0)
213 return 1;
214
215 xtensa_kio_paddr = of_read_ulong(ranges+1, 1);
216
217 xtensa_kio_paddr &= 0xf0000000;
218
219 return 1;
220}
221#else
222static int __init xtensa_dt_io_area(unsigned long node, const char *uname,
223 int depth, void *data)
224{
225 return 1;
226}
227#endif
228
229void __init early_init_dt_add_memory_arch(u64 base, u64 size)
230{
231 if (!dt_memory_scan)
232 return;
233
234 size &= PAGE_MASK;
235 add_sysmem_bank(base, base + size);
236}
237
238void * __init early_init_dt_alloc_memory_arch(u64 size, u64 align)
239{
240 return __alloc_bootmem(size, align, 0);
241}
242
243void __init early_init_devtree(void *params)
244{
245 if (sysmem.nr_banks == 0)
246 dt_memory_scan = true;
247
248 early_init_dt_scan(params);
249 of_scan_flat_dt(xtensa_dt_io_area, NULL);
250
251 if (!command_line[0])
252 strlcpy(command_line, boot_command_line, COMMAND_LINE_SIZE);
253}
254
255static int __init xtensa_device_probe(void)
256{
257 of_clk_init(NULL);
258 of_platform_populate(NULL, of_default_bus_match_table, NULL, NULL);
259 return 0;
260}
261
262device_initcall(xtensa_device_probe);
263
264#endif
265
266
267
268
269
270void __init init_arch(bp_tag_t *bp_start)
271{
272
273
274 if (bp_start)
275 parse_bootparam(bp_start);
276
277#ifdef CONFIG_OF
278 early_init_devtree(dtb_start);
279#endif
280
281 if (sysmem.nr_banks == 0) {
282 add_sysmem_bank(PLATFORM_DEFAULT_MEM_START,
283 PLATFORM_DEFAULT_MEM_START +
284 PLATFORM_DEFAULT_MEM_SIZE);
285 }
286
287#ifdef CONFIG_CMDLINE_BOOL
288 if (!command_line[0])
289 strlcpy(command_line, default_command_line, COMMAND_LINE_SIZE);
290#endif
291
292
293
294 platform_init(bp_start);
295
296
297
298 init_mmu();
299}
300
301
302
303
304
305extern char _end;
306extern char _stext;
307extern char _WindowVectors_text_start;
308extern char _WindowVectors_text_end;
309extern char _DebugInterruptVector_literal_start;
310extern char _DebugInterruptVector_text_end;
311extern char _KernelExceptionVector_literal_start;
312extern char _KernelExceptionVector_text_end;
313extern char _UserExceptionVector_literal_start;
314extern char _UserExceptionVector_text_end;
315extern char _DoubleExceptionVector_literal_start;
316extern char _DoubleExceptionVector_text_end;
317#if XCHAL_EXCM_LEVEL >= 2
318extern char _Level2InterruptVector_text_start;
319extern char _Level2InterruptVector_text_end;
320#endif
321#if XCHAL_EXCM_LEVEL >= 3
322extern char _Level3InterruptVector_text_start;
323extern char _Level3InterruptVector_text_end;
324#endif
325#if XCHAL_EXCM_LEVEL >= 4
326extern char _Level4InterruptVector_text_start;
327extern char _Level4InterruptVector_text_end;
328#endif
329#if XCHAL_EXCM_LEVEL >= 5
330extern char _Level5InterruptVector_text_start;
331extern char _Level5InterruptVector_text_end;
332#endif
333#if XCHAL_EXCM_LEVEL >= 6
334extern char _Level6InterruptVector_text_start;
335extern char _Level6InterruptVector_text_end;
336#endif
337
338
339
340#ifdef CONFIG_S32C1I_SELFTEST
341#if XCHAL_HAVE_S32C1I
342
343static int __initdata rcw_word, rcw_probe_pc, rcw_exc;
344
345
346
347
348
349
350static inline int probed_compare_swap(int *v, int cmp, int set)
351{
352 int tmp;
353
354 __asm__ __volatile__(
355 " movi %1, 1f\n"
356 " s32i %1, %4, 0\n"
357 " wsr %2, scompare1\n"
358 "1: s32c1i %0, %3, 0\n"
359 : "=a" (set), "=&a" (tmp)
360 : "a" (cmp), "a" (v), "a" (&rcw_probe_pc), "0" (set)
361 : "memory"
362 );
363 return set;
364}
365
366
367
368static void __init do_probed_exception(struct pt_regs *regs,
369 unsigned long exccause)
370{
371 if (regs->pc == rcw_probe_pc) {
372 regs->pc += 3;
373 rcw_exc = exccause;
374 } else {
375 do_unhandled(regs, exccause);
376 }
377}
378
379
380
381static int __init check_s32c1i(void)
382{
383 int n, cause1, cause2;
384 void *handbus, *handdata, *handaddr;
385
386 rcw_probe_pc = 0;
387 handbus = trap_set_handler(EXCCAUSE_LOAD_STORE_ERROR,
388 do_probed_exception);
389 handdata = trap_set_handler(EXCCAUSE_LOAD_STORE_DATA_ERROR,
390 do_probed_exception);
391 handaddr = trap_set_handler(EXCCAUSE_LOAD_STORE_ADDR_ERROR,
392 do_probed_exception);
393
394
395 rcw_exc = 0;
396 rcw_word = 1;
397 n = probed_compare_swap(&rcw_word, 0, 2);
398 cause1 = rcw_exc;
399
400
401 if (cause1 != 0) {
402
403 if (n != 2 || rcw_word != 1)
404 panic("S32C1I exception error");
405 } else if (rcw_word != 1 || n != 1) {
406 panic("S32C1I compare error");
407 }
408
409
410 rcw_exc = 0;
411 rcw_word = 0x1234567;
412 n = probed_compare_swap(&rcw_word, 0x1234567, 0xabcde);
413 cause2 = rcw_exc;
414
415 if (cause2 != 0) {
416
417 if (n != 0xabcde || rcw_word != 0x1234567)
418 panic("S32C1I exception error (b)");
419 } else if (rcw_word != 0xabcde || n != 0x1234567) {
420 panic("S32C1I store error");
421 }
422
423
424 if (cause1 || cause2) {
425 pr_warn("S32C1I took exception %d, %d\n", cause1, cause2);
426
427
428 panic("S32C1I exceptions not currently supported");
429 }
430 if (cause1 != cause2)
431 panic("inconsistent S32C1I exceptions");
432
433 trap_set_handler(EXCCAUSE_LOAD_STORE_ERROR, handbus);
434 trap_set_handler(EXCCAUSE_LOAD_STORE_DATA_ERROR, handdata);
435 trap_set_handler(EXCCAUSE_LOAD_STORE_ADDR_ERROR, handaddr);
436 return 0;
437}
438
439#else
440
441
442
443static int __init check_s32c1i(void)
444{
445 pr_warn("Processor configuration lacks atomic compare-and-swap support!\n");
446 return 0;
447}
448
449#endif
450early_initcall(check_s32c1i);
451#endif
452
453
454void __init setup_arch(char **cmdline_p)
455{
456 strlcpy(boot_command_line, command_line, COMMAND_LINE_SIZE);
457 *cmdline_p = command_line;
458
459
460
461#ifdef CONFIG_BLK_DEV_INITRD
462 if (initrd_start < initrd_end) {
463 initrd_is_mapped = mem_reserve(__pa(initrd_start),
464 __pa(initrd_end), 0) == 0;
465 initrd_below_start_ok = 1;
466 } else {
467 initrd_start = 0;
468 }
469#endif
470
471 mem_reserve(__pa(&_stext),__pa(&_end), 1);
472
473 mem_reserve(__pa(&_WindowVectors_text_start),
474 __pa(&_WindowVectors_text_end), 0);
475
476 mem_reserve(__pa(&_DebugInterruptVector_literal_start),
477 __pa(&_DebugInterruptVector_text_end), 0);
478
479 mem_reserve(__pa(&_KernelExceptionVector_literal_start),
480 __pa(&_KernelExceptionVector_text_end), 0);
481
482 mem_reserve(__pa(&_UserExceptionVector_literal_start),
483 __pa(&_UserExceptionVector_text_end), 0);
484
485 mem_reserve(__pa(&_DoubleExceptionVector_literal_start),
486 __pa(&_DoubleExceptionVector_text_end), 0);
487
488#if XCHAL_EXCM_LEVEL >= 2
489 mem_reserve(__pa(&_Level2InterruptVector_text_start),
490 __pa(&_Level2InterruptVector_text_end), 0);
491#endif
492#if XCHAL_EXCM_LEVEL >= 3
493 mem_reserve(__pa(&_Level3InterruptVector_text_start),
494 __pa(&_Level3InterruptVector_text_end), 0);
495#endif
496#if XCHAL_EXCM_LEVEL >= 4
497 mem_reserve(__pa(&_Level4InterruptVector_text_start),
498 __pa(&_Level4InterruptVector_text_end), 0);
499#endif
500#if XCHAL_EXCM_LEVEL >= 5
501 mem_reserve(__pa(&_Level5InterruptVector_text_start),
502 __pa(&_Level5InterruptVector_text_end), 0);
503#endif
504#if XCHAL_EXCM_LEVEL >= 6
505 mem_reserve(__pa(&_Level6InterruptVector_text_start),
506 __pa(&_Level6InterruptVector_text_end), 0);
507#endif
508
509 parse_early_param();
510 bootmem_init();
511
512 unflatten_and_copy_device_tree();
513
514 platform_setup(cmdline_p);
515
516#ifdef CONFIG_SMP
517 smp_init_cpus();
518#endif
519
520 paging_init();
521 zones_init();
522
523#ifdef CONFIG_VT
524# if defined(CONFIG_VGA_CONSOLE)
525 conswitchp = &vga_con;
526# elif defined(CONFIG_DUMMY_CONSOLE)
527 conswitchp = &dummy_con;
528# endif
529#endif
530
531#ifdef CONFIG_PCI
532 platform_pcibios_init();
533#endif
534}
535
536static DEFINE_PER_CPU(struct cpu, cpu_data);
537
538static int __init topology_init(void)
539{
540 int i;
541
542 for_each_possible_cpu(i) {
543 struct cpu *cpu = &per_cpu(cpu_data, i);
544 cpu->hotpluggable = !!i;
545 register_cpu(cpu, i);
546 }
547
548 return 0;
549}
550subsys_initcall(topology_init);
551
552void machine_restart(char * cmd)
553{
554 platform_restart();
555}
556
557void machine_halt(void)
558{
559 platform_halt();
560 while (1);
561}
562
563void machine_power_off(void)
564{
565 platform_power_off();
566 while (1);
567}
568#ifdef CONFIG_PROC_FS
569
570
571
572
573
574static int
575c_show(struct seq_file *f, void *slot)
576{
577 char buf[NR_CPUS * 5];
578
579 cpulist_scnprintf(buf, sizeof(buf), cpu_online_mask);
580
581 seq_printf(f, "CPU count\t: %u\n"
582 "CPU list\t: %s\n"
583 "vendor_id\t: Tensilica\n"
584 "model\t\t: Xtensa " XCHAL_HW_VERSION_NAME "\n"
585 "core ID\t\t: " XCHAL_CORE_ID "\n"
586 "build ID\t: 0x%x\n"
587 "byte order\t: %s\n"
588 "cpu MHz\t\t: %lu.%02lu\n"
589 "bogomips\t: %lu.%02lu\n",
590 num_online_cpus(),
591 buf,
592 XCHAL_BUILD_UNIQUE_ID,
593 XCHAL_HAVE_BE ? "big" : "little",
594 ccount_freq/1000000,
595 (ccount_freq/10000) % 100,
596 loops_per_jiffy/(500000/HZ),
597 (loops_per_jiffy/(5000/HZ)) % 100);
598
599 seq_printf(f,"flags\t\t: "
600#if XCHAL_HAVE_NMI
601 "nmi "
602#endif
603#if XCHAL_HAVE_DEBUG
604 "debug "
605# if XCHAL_HAVE_OCD
606 "ocd "
607# endif
608#endif
609#if XCHAL_HAVE_DENSITY
610 "density "
611#endif
612#if XCHAL_HAVE_BOOLEANS
613 "boolean "
614#endif
615#if XCHAL_HAVE_LOOPS
616 "loop "
617#endif
618#if XCHAL_HAVE_NSA
619 "nsa "
620#endif
621#if XCHAL_HAVE_MINMAX
622 "minmax "
623#endif
624#if XCHAL_HAVE_SEXT
625 "sext "
626#endif
627#if XCHAL_HAVE_CLAMPS
628 "clamps "
629#endif
630#if XCHAL_HAVE_MAC16
631 "mac16 "
632#endif
633#if XCHAL_HAVE_MUL16
634 "mul16 "
635#endif
636#if XCHAL_HAVE_MUL32
637 "mul32 "
638#endif
639#if XCHAL_HAVE_MUL32_HIGH
640 "mul32h "
641#endif
642#if XCHAL_HAVE_FP
643 "fpu "
644#endif
645#if XCHAL_HAVE_S32C1I
646 "s32c1i "
647#endif
648 "\n");
649
650
651 seq_printf(f,"physical aregs\t: %d\n"
652 "misc regs\t: %d\n"
653 "ibreak\t\t: %d\n"
654 "dbreak\t\t: %d\n",
655 XCHAL_NUM_AREGS,
656 XCHAL_NUM_MISC_REGS,
657 XCHAL_NUM_IBREAK,
658 XCHAL_NUM_DBREAK);
659
660
661
662 seq_printf(f,"num ints\t: %d\n"
663 "ext ints\t: %d\n"
664 "int levels\t: %d\n"
665 "timers\t\t: %d\n"
666 "debug level\t: %d\n",
667 XCHAL_NUM_INTERRUPTS,
668 XCHAL_NUM_EXTINTERRUPTS,
669 XCHAL_NUM_INTLEVELS,
670 XCHAL_NUM_TIMERS,
671 XCHAL_DEBUGLEVEL);
672
673
674 seq_printf(f,"icache line size: %d\n"
675 "icache ways\t: %d\n"
676 "icache size\t: %d\n"
677 "icache flags\t: "
678#if XCHAL_ICACHE_LINE_LOCKABLE
679 "lock "
680#endif
681 "\n"
682 "dcache line size: %d\n"
683 "dcache ways\t: %d\n"
684 "dcache size\t: %d\n"
685 "dcache flags\t: "
686#if XCHAL_DCACHE_IS_WRITEBACK
687 "writeback "
688#endif
689#if XCHAL_DCACHE_LINE_LOCKABLE
690 "lock "
691#endif
692 "\n",
693 XCHAL_ICACHE_LINESIZE,
694 XCHAL_ICACHE_WAYS,
695 XCHAL_ICACHE_SIZE,
696 XCHAL_DCACHE_LINESIZE,
697 XCHAL_DCACHE_WAYS,
698 XCHAL_DCACHE_SIZE);
699
700 return 0;
701}
702
703
704
705
706static void *
707c_start(struct seq_file *f, loff_t *pos)
708{
709 return (*pos == 0) ? (void *)1 : NULL;
710}
711
712static void *
713c_next(struct seq_file *f, void *v, loff_t *pos)
714{
715 return NULL;
716}
717
718static void
719c_stop(struct seq_file *f, void *v)
720{
721}
722
723const struct seq_operations cpuinfo_op =
724{
725 .start = c_start,
726 .next = c_next,
727 .stop = c_stop,
728 .show = c_show,
729};
730
731#endif
732