treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / arch / xtensa / kernel / setup.c
blobadead45debe893908c321c75d5f0dc30863df197
1 /*
2 * arch/xtensa/kernel/setup.c
4 * This file is subject to the terms and conditions of the GNU General Public
5 * License. See the file "COPYING" in the main directory of this archive
6 * for more details.
8 * Copyright (C) 1995 Linus Torvalds
9 * Copyright (C) 2001 - 2005 Tensilica Inc.
10 * Copyright (C) 2014 - 2016 Cadence Design Systems Inc.
12 * Chris Zankel <chris@zankel.net>
13 * Joe Taylor <joe@tensilica.com, joetylr@yahoo.com>
14 * Kevin Chea
15 * Marc Gauthier<marc@tensilica.com> <marc@alumni.uwaterloo.ca>
18 #include <linux/errno.h>
19 #include <linux/init.h>
20 #include <linux/mm.h>
21 #include <linux/proc_fs.h>
22 #include <linux/screen_info.h>
23 #include <linux/kernel.h>
24 #include <linux/percpu.h>
25 #include <linux/cpu.h>
26 #include <linux/of.h>
27 #include <linux/of_fdt.h>
29 #if defined(CONFIG_VGA_CONSOLE) || defined(CONFIG_DUMMY_CONSOLE)
30 # include <linux/console.h>
31 #endif
33 #ifdef CONFIG_PROC_FS
34 # include <linux/seq_file.h>
35 #endif
37 #include <asm/bootparam.h>
38 #include <asm/kasan.h>
39 #include <asm/mmu_context.h>
40 #include <asm/pgtable.h>
41 #include <asm/processor.h>
42 #include <asm/timex.h>
43 #include <asm/platform.h>
44 #include <asm/page.h>
45 #include <asm/setup.h>
46 #include <asm/param.h>
47 #include <asm/smp.h>
48 #include <asm/sysmem.h>
50 #if defined(CONFIG_VGA_CONSOLE) || defined(CONFIG_DUMMY_CONSOLE)
51 struct screen_info screen_info = {
52 .orig_x = 0,
53 .orig_y = 24,
54 .orig_video_cols = 80,
55 .orig_video_lines = 24,
56 .orig_video_isVGA = 1,
57 .orig_video_points = 16,
59 #endif
61 #ifdef CONFIG_BLK_DEV_INITRD
62 extern unsigned long initrd_start;
63 extern unsigned long initrd_end;
64 extern int initrd_below_start_ok;
65 #endif
67 #ifdef CONFIG_OF
68 void *dtb_start = __dtb_start;
69 #endif
71 extern unsigned long loops_per_jiffy;
73 /* Command line specified as configuration option. */
75 static char __initdata command_line[COMMAND_LINE_SIZE];
77 #ifdef CONFIG_CMDLINE_BOOL
78 static char default_command_line[COMMAND_LINE_SIZE] __initdata = CONFIG_CMDLINE;
79 #endif
81 #ifdef CONFIG_PARSE_BOOTPARAM
83 * Boot parameter parsing.
85 * The Xtensa port uses a list of variable-sized tags to pass data to
86 * the kernel. The first tag must be a BP_TAG_FIRST tag for the list
87 * to be recognised. The list is terminated with a zero-sized
88 * BP_TAG_LAST tag.
91 typedef struct tagtable {
92 u32 tag;
93 int (*parse)(const bp_tag_t*);
94 } tagtable_t;
96 #define __tagtable(tag, fn) static tagtable_t __tagtable_##fn \
97 __attribute__((used, section(".taglist"))) = { tag, fn }
99 /* parse current tag */
101 static int __init parse_tag_mem(const bp_tag_t *tag)
103 struct bp_meminfo *mi = (struct bp_meminfo *)(tag->data);
105 if (mi->type != MEMORY_TYPE_CONVENTIONAL)
106 return -1;
108 return memblock_add(mi->start, mi->end - mi->start);
111 __tagtable(BP_TAG_MEMORY, parse_tag_mem);
113 #ifdef CONFIG_BLK_DEV_INITRD
115 static int __init parse_tag_initrd(const bp_tag_t* tag)
117 struct bp_meminfo *mi = (struct bp_meminfo *)(tag->data);
119 initrd_start = (unsigned long)__va(mi->start);
120 initrd_end = (unsigned long)__va(mi->end);
122 return 0;
125 __tagtable(BP_TAG_INITRD, parse_tag_initrd);
127 #endif /* CONFIG_BLK_DEV_INITRD */
129 #ifdef CONFIG_OF
131 static int __init parse_tag_fdt(const bp_tag_t *tag)
133 dtb_start = __va(tag->data[0]);
134 return 0;
137 __tagtable(BP_TAG_FDT, parse_tag_fdt);
139 #endif /* CONFIG_OF */
141 static int __init parse_tag_cmdline(const bp_tag_t* tag)
143 strlcpy(command_line, (char *)(tag->data), COMMAND_LINE_SIZE);
144 return 0;
147 __tagtable(BP_TAG_COMMAND_LINE, parse_tag_cmdline);
149 static int __init parse_bootparam(const bp_tag_t* tag)
151 extern tagtable_t __tagtable_begin, __tagtable_end;
152 tagtable_t *t;
154 /* Boot parameters must start with a BP_TAG_FIRST tag. */
156 if (tag->id != BP_TAG_FIRST) {
157 pr_warn("Invalid boot parameters!\n");
158 return 0;
161 tag = (bp_tag_t*)((unsigned long)tag + sizeof(bp_tag_t) + tag->size);
163 /* Parse all tags. */
165 while (tag != NULL && tag->id != BP_TAG_LAST) {
166 for (t = &__tagtable_begin; t < &__tagtable_end; t++) {
167 if (tag->id == t->tag) {
168 t->parse(tag);
169 break;
172 if (t == &__tagtable_end)
173 pr_warn("Ignoring tag 0x%08x\n", tag->id);
174 tag = (bp_tag_t*)((unsigned long)(tag + 1) + tag->size);
177 return 0;
179 #else
180 static int __init parse_bootparam(const bp_tag_t *tag)
182 pr_info("Ignoring boot parameters at %p\n", tag);
183 return 0;
185 #endif
187 #ifdef CONFIG_OF
189 #if !XCHAL_HAVE_PTP_MMU || XCHAL_HAVE_SPANNING_WAY
190 unsigned long xtensa_kio_paddr = XCHAL_KIO_DEFAULT_PADDR;
191 EXPORT_SYMBOL(xtensa_kio_paddr);
193 static int __init xtensa_dt_io_area(unsigned long node, const char *uname,
194 int depth, void *data)
196 const __be32 *ranges;
197 int len;
199 if (depth > 1)
200 return 0;
202 if (!of_flat_dt_is_compatible(node, "simple-bus"))
203 return 0;
205 ranges = of_get_flat_dt_prop(node, "ranges", &len);
206 if (!ranges)
207 return 1;
208 if (len == 0)
209 return 1;
211 xtensa_kio_paddr = of_read_ulong(ranges+1, 1);
212 /* round down to nearest 256MB boundary */
213 xtensa_kio_paddr &= 0xf0000000;
215 init_kio();
217 return 1;
219 #else
220 static int __init xtensa_dt_io_area(unsigned long node, const char *uname,
221 int depth, void *data)
223 return 1;
225 #endif
227 void __init early_init_devtree(void *params)
229 early_init_dt_scan(params);
230 of_scan_flat_dt(xtensa_dt_io_area, NULL);
232 if (!command_line[0])
233 strlcpy(command_line, boot_command_line, COMMAND_LINE_SIZE);
236 #endif /* CONFIG_OF */
239 * Initialize architecture. (Early stage)
242 void __init init_arch(bp_tag_t *bp_start)
244 /* Initialize MMU. */
246 init_mmu();
248 /* Initialize initial KASAN shadow map */
250 kasan_early_init();
252 /* Parse boot parameters */
254 if (bp_start)
255 parse_bootparam(bp_start);
257 #ifdef CONFIG_OF
258 early_init_devtree(dtb_start);
259 #endif
261 #ifdef CONFIG_CMDLINE_BOOL
262 if (!command_line[0])
263 strlcpy(command_line, default_command_line, COMMAND_LINE_SIZE);
264 #endif
266 /* Early hook for platforms */
268 platform_init(bp_start);
272 * Initialize system. Setup memory and reserve regions.
275 extern char _end[];
276 extern char _stext[];
277 extern char _WindowVectors_text_start;
278 extern char _WindowVectors_text_end;
279 extern char _DebugInterruptVector_text_start;
280 extern char _DebugInterruptVector_text_end;
281 extern char _KernelExceptionVector_text_start;
282 extern char _KernelExceptionVector_text_end;
283 extern char _UserExceptionVector_text_start;
284 extern char _UserExceptionVector_text_end;
285 extern char _DoubleExceptionVector_text_start;
286 extern char _DoubleExceptionVector_text_end;
287 #if XCHAL_EXCM_LEVEL >= 2
288 extern char _Level2InterruptVector_text_start;
289 extern char _Level2InterruptVector_text_end;
290 #endif
291 #if XCHAL_EXCM_LEVEL >= 3
292 extern char _Level3InterruptVector_text_start;
293 extern char _Level3InterruptVector_text_end;
294 #endif
295 #if XCHAL_EXCM_LEVEL >= 4
296 extern char _Level4InterruptVector_text_start;
297 extern char _Level4InterruptVector_text_end;
298 #endif
299 #if XCHAL_EXCM_LEVEL >= 5
300 extern char _Level5InterruptVector_text_start;
301 extern char _Level5InterruptVector_text_end;
302 #endif
303 #if XCHAL_EXCM_LEVEL >= 6
304 extern char _Level6InterruptVector_text_start;
305 extern char _Level6InterruptVector_text_end;
306 #endif
307 #ifdef CONFIG_SMP
308 extern char _SecondaryResetVector_text_start;
309 extern char _SecondaryResetVector_text_end;
310 #endif
311 #ifdef CONFIG_XIP_KERNEL
312 extern char _xip_start[];
313 extern char _xip_end[];
314 #endif
316 static inline int __init_memblock mem_reserve(unsigned long start,
317 unsigned long end)
319 return memblock_reserve(start, end - start);
322 void __init setup_arch(char **cmdline_p)
324 pr_info("config ID: %08x:%08x\n",
325 xtensa_get_sr(SREG_EPC), xtensa_get_sr(SREG_EXCSAVE));
326 if (xtensa_get_sr(SREG_EPC) != XCHAL_HW_CONFIGID0 ||
327 xtensa_get_sr(SREG_EXCSAVE) != XCHAL_HW_CONFIGID1)
328 pr_info("built for config ID: %08x:%08x\n",
329 XCHAL_HW_CONFIGID0, XCHAL_HW_CONFIGID1);
331 *cmdline_p = command_line;
332 platform_setup(cmdline_p);
333 strlcpy(boot_command_line, *cmdline_p, COMMAND_LINE_SIZE);
335 /* Reserve some memory regions */
337 #ifdef CONFIG_BLK_DEV_INITRD
338 if (initrd_start < initrd_end &&
339 !mem_reserve(__pa(initrd_start), __pa(initrd_end)))
340 initrd_below_start_ok = 1;
341 else
342 initrd_start = 0;
343 #endif
345 mem_reserve(__pa(_stext), __pa(_end));
346 #ifdef CONFIG_XIP_KERNEL
347 mem_reserve(__pa(_xip_start), __pa(_xip_end));
348 #endif
350 #ifdef CONFIG_VECTORS_OFFSET
351 mem_reserve(__pa(&_WindowVectors_text_start),
352 __pa(&_WindowVectors_text_end));
354 mem_reserve(__pa(&_DebugInterruptVector_text_start),
355 __pa(&_DebugInterruptVector_text_end));
357 mem_reserve(__pa(&_KernelExceptionVector_text_start),
358 __pa(&_KernelExceptionVector_text_end));
360 mem_reserve(__pa(&_UserExceptionVector_text_start),
361 __pa(&_UserExceptionVector_text_end));
363 mem_reserve(__pa(&_DoubleExceptionVector_text_start),
364 __pa(&_DoubleExceptionVector_text_end));
366 #if XCHAL_EXCM_LEVEL >= 2
367 mem_reserve(__pa(&_Level2InterruptVector_text_start),
368 __pa(&_Level2InterruptVector_text_end));
369 #endif
370 #if XCHAL_EXCM_LEVEL >= 3
371 mem_reserve(__pa(&_Level3InterruptVector_text_start),
372 __pa(&_Level3InterruptVector_text_end));
373 #endif
374 #if XCHAL_EXCM_LEVEL >= 4
375 mem_reserve(__pa(&_Level4InterruptVector_text_start),
376 __pa(&_Level4InterruptVector_text_end));
377 #endif
378 #if XCHAL_EXCM_LEVEL >= 5
379 mem_reserve(__pa(&_Level5InterruptVector_text_start),
380 __pa(&_Level5InterruptVector_text_end));
381 #endif
382 #if XCHAL_EXCM_LEVEL >= 6
383 mem_reserve(__pa(&_Level6InterruptVector_text_start),
384 __pa(&_Level6InterruptVector_text_end));
385 #endif
387 #endif /* CONFIG_VECTORS_OFFSET */
389 #ifdef CONFIG_SMP
390 mem_reserve(__pa(&_SecondaryResetVector_text_start),
391 __pa(&_SecondaryResetVector_text_end));
392 #endif
393 parse_early_param();
394 bootmem_init();
395 kasan_init();
396 unflatten_and_copy_device_tree();
398 #ifdef CONFIG_SMP
399 smp_init_cpus();
400 #endif
402 paging_init();
403 zones_init();
405 #ifdef CONFIG_VT
406 # if defined(CONFIG_VGA_CONSOLE)
407 conswitchp = &vga_con;
408 # endif
409 #endif
412 static DEFINE_PER_CPU(struct cpu, cpu_data);
414 static int __init topology_init(void)
416 int i;
418 for_each_possible_cpu(i) {
419 struct cpu *cpu = &per_cpu(cpu_data, i);
420 cpu->hotpluggable = !!i;
421 register_cpu(cpu, i);
424 return 0;
426 subsys_initcall(topology_init);
428 void cpu_reset(void)
430 #if XCHAL_HAVE_PTP_MMU && IS_ENABLED(CONFIG_MMU)
431 local_irq_disable();
433 * We have full MMU: all autoload ways, ways 7, 8 and 9 of DTLB must
434 * be flushed.
435 * Way 4 is not currently used by linux.
436 * Ways 5 and 6 shall not be touched on MMUv2 as they are hardwired.
437 * Way 5 shall be flushed and way 6 shall be set to identity mapping
438 * on MMUv3.
440 local_flush_tlb_all();
441 invalidate_page_directory();
442 #if XCHAL_HAVE_SPANNING_WAY
443 /* MMU v3 */
445 unsigned long vaddr = (unsigned long)cpu_reset;
446 unsigned long paddr = __pa(vaddr);
447 unsigned long tmpaddr = vaddr + SZ_512M;
448 unsigned long tmp0, tmp1, tmp2, tmp3;
451 * Find a place for the temporary mapping. It must not be
452 * in the same 512MB region with vaddr or paddr, otherwise
453 * there may be multihit exception either on entry to the
454 * temporary mapping, or on entry to the identity mapping.
455 * (512MB is the biggest page size supported by TLB.)
457 while (((tmpaddr ^ paddr) & -SZ_512M) == 0)
458 tmpaddr += SZ_512M;
460 /* Invalidate mapping in the selected temporary area */
461 if (itlb_probe(tmpaddr) & BIT(ITLB_HIT_BIT))
462 invalidate_itlb_entry(itlb_probe(tmpaddr));
463 if (itlb_probe(tmpaddr + PAGE_SIZE) & BIT(ITLB_HIT_BIT))
464 invalidate_itlb_entry(itlb_probe(tmpaddr + PAGE_SIZE));
467 * Map two consecutive pages starting at the physical address
468 * of this function to the temporary mapping area.
470 write_itlb_entry(__pte((paddr & PAGE_MASK) |
471 _PAGE_HW_VALID |
472 _PAGE_HW_EXEC |
473 _PAGE_CA_BYPASS),
474 tmpaddr & PAGE_MASK);
475 write_itlb_entry(__pte(((paddr & PAGE_MASK) + PAGE_SIZE) |
476 _PAGE_HW_VALID |
477 _PAGE_HW_EXEC |
478 _PAGE_CA_BYPASS),
479 (tmpaddr & PAGE_MASK) + PAGE_SIZE);
481 /* Reinitialize TLB */
482 __asm__ __volatile__ ("movi %0, 1f\n\t"
483 "movi %3, 2f\n\t"
484 "add %0, %0, %4\n\t"
485 "add %3, %3, %5\n\t"
486 "jx %0\n"
488 * No literal, data or stack access
489 * below this point
491 "1:\n\t"
492 /* Initialize *tlbcfg */
493 "movi %0, 0\n\t"
494 "wsr %0, itlbcfg\n\t"
495 "wsr %0, dtlbcfg\n\t"
496 /* Invalidate TLB way 5 */
497 "movi %0, 4\n\t"
498 "movi %1, 5\n"
499 "1:\n\t"
500 "iitlb %1\n\t"
501 "idtlb %1\n\t"
502 "add %1, %1, %6\n\t"
503 "addi %0, %0, -1\n\t"
504 "bnez %0, 1b\n\t"
505 /* Initialize TLB way 6 */
506 "movi %0, 7\n\t"
507 "addi %1, %9, 3\n\t"
508 "addi %2, %9, 6\n"
509 "1:\n\t"
510 "witlb %1, %2\n\t"
511 "wdtlb %1, %2\n\t"
512 "add %1, %1, %7\n\t"
513 "add %2, %2, %7\n\t"
514 "addi %0, %0, -1\n\t"
515 "bnez %0, 1b\n\t"
516 "isync\n\t"
517 /* Jump to identity mapping */
518 "jx %3\n"
519 "2:\n\t"
520 /* Complete way 6 initialization */
521 "witlb %1, %2\n\t"
522 "wdtlb %1, %2\n\t"
523 /* Invalidate temporary mapping */
524 "sub %0, %9, %7\n\t"
525 "iitlb %0\n\t"
526 "add %0, %0, %8\n\t"
527 "iitlb %0"
528 : "=&a"(tmp0), "=&a"(tmp1), "=&a"(tmp2),
529 "=&a"(tmp3)
530 : "a"(tmpaddr - vaddr),
531 "a"(paddr - vaddr),
532 "a"(SZ_128M), "a"(SZ_512M),
533 "a"(PAGE_SIZE),
534 "a"((tmpaddr + SZ_512M) & PAGE_MASK)
535 : "memory");
537 #endif
538 #endif
539 __asm__ __volatile__ ("movi a2, 0\n\t"
540 "wsr a2, icountlevel\n\t"
541 "movi a2, 0\n\t"
542 "wsr a2, icount\n\t"
543 #if XCHAL_NUM_IBREAK > 0
544 "wsr a2, ibreakenable\n\t"
545 #endif
546 #if XCHAL_HAVE_LOOPS
547 "wsr a2, lcount\n\t"
548 #endif
549 "movi a2, 0x1f\n\t"
550 "wsr a2, ps\n\t"
551 "isync\n\t"
552 "jx %0\n\t"
554 : "a" (XCHAL_RESET_VECTOR_VADDR)
555 : "a2");
556 for (;;)
560 void machine_restart(char * cmd)
562 platform_restart();
565 void machine_halt(void)
567 platform_halt();
568 while (1);
571 void machine_power_off(void)
573 platform_power_off();
574 while (1);
576 #ifdef CONFIG_PROC_FS
579 * Display some core information through /proc/cpuinfo.
582 static int
583 c_show(struct seq_file *f, void *slot)
585 /* high-level stuff */
586 seq_printf(f, "CPU count\t: %u\n"
587 "CPU list\t: %*pbl\n"
588 "vendor_id\t: Tensilica\n"
589 "model\t\t: Xtensa " XCHAL_HW_VERSION_NAME "\n"
590 "core ID\t\t: " XCHAL_CORE_ID "\n"
591 "build ID\t: 0x%x\n"
592 "config ID\t: %08x:%08x\n"
593 "byte order\t: %s\n"
594 "cpu MHz\t\t: %lu.%02lu\n"
595 "bogomips\t: %lu.%02lu\n",
596 num_online_cpus(),
597 cpumask_pr_args(cpu_online_mask),
598 XCHAL_BUILD_UNIQUE_ID,
599 xtensa_get_sr(SREG_EPC), xtensa_get_sr(SREG_EXCSAVE),
600 XCHAL_HAVE_BE ? "big" : "little",
601 ccount_freq/1000000,
602 (ccount_freq/10000) % 100,
603 loops_per_jiffy/(500000/HZ),
604 (loops_per_jiffy/(5000/HZ)) % 100);
605 seq_puts(f, "flags\t\t: "
606 #if XCHAL_HAVE_NMI
607 "nmi "
608 #endif
609 #if XCHAL_HAVE_DEBUG
610 "debug "
611 # if XCHAL_HAVE_OCD
612 "ocd "
613 # endif
614 #endif
615 #if XCHAL_HAVE_DENSITY
616 "density "
617 #endif
618 #if XCHAL_HAVE_BOOLEANS
619 "boolean "
620 #endif
621 #if XCHAL_HAVE_LOOPS
622 "loop "
623 #endif
624 #if XCHAL_HAVE_NSA
625 "nsa "
626 #endif
627 #if XCHAL_HAVE_MINMAX
628 "minmax "
629 #endif
630 #if XCHAL_HAVE_SEXT
631 "sext "
632 #endif
633 #if XCHAL_HAVE_CLAMPS
634 "clamps "
635 #endif
636 #if XCHAL_HAVE_MAC16
637 "mac16 "
638 #endif
639 #if XCHAL_HAVE_MUL16
640 "mul16 "
641 #endif
642 #if XCHAL_HAVE_MUL32
643 "mul32 "
644 #endif
645 #if XCHAL_HAVE_MUL32_HIGH
646 "mul32h "
647 #endif
648 #if XCHAL_HAVE_FP
649 "fpu "
650 #endif
651 #if XCHAL_HAVE_S32C1I
652 "s32c1i "
653 #endif
654 #if XCHAL_HAVE_EXCLUSIVE
655 "exclusive "
656 #endif
657 "\n");
659 /* Registers. */
660 seq_printf(f,"physical aregs\t: %d\n"
661 "misc regs\t: %d\n"
662 "ibreak\t\t: %d\n"
663 "dbreak\t\t: %d\n",
664 XCHAL_NUM_AREGS,
665 XCHAL_NUM_MISC_REGS,
666 XCHAL_NUM_IBREAK,
667 XCHAL_NUM_DBREAK);
670 /* Interrupt. */
671 seq_printf(f,"num ints\t: %d\n"
672 "ext ints\t: %d\n"
673 "int levels\t: %d\n"
674 "timers\t\t: %d\n"
675 "debug level\t: %d\n",
676 XCHAL_NUM_INTERRUPTS,
677 XCHAL_NUM_EXTINTERRUPTS,
678 XCHAL_NUM_INTLEVELS,
679 XCHAL_NUM_TIMERS,
680 XCHAL_DEBUGLEVEL);
682 /* Cache */
683 seq_printf(f,"icache line size: %d\n"
684 "icache ways\t: %d\n"
685 "icache size\t: %d\n"
686 "icache flags\t: "
687 #if XCHAL_ICACHE_LINE_LOCKABLE
688 "lock "
689 #endif
690 "\n"
691 "dcache line size: %d\n"
692 "dcache ways\t: %d\n"
693 "dcache size\t: %d\n"
694 "dcache flags\t: "
695 #if XCHAL_DCACHE_IS_WRITEBACK
696 "writeback "
697 #endif
698 #if XCHAL_DCACHE_LINE_LOCKABLE
699 "lock "
700 #endif
701 "\n",
702 XCHAL_ICACHE_LINESIZE,
703 XCHAL_ICACHE_WAYS,
704 XCHAL_ICACHE_SIZE,
705 XCHAL_DCACHE_LINESIZE,
706 XCHAL_DCACHE_WAYS,
707 XCHAL_DCACHE_SIZE);
709 return 0;
713 * We show only CPU #0 info.
715 static void *
716 c_start(struct seq_file *f, loff_t *pos)
718 return (*pos == 0) ? (void *)1 : NULL;
721 static void *
722 c_next(struct seq_file *f, void *v, loff_t *pos)
724 return NULL;
727 static void
728 c_stop(struct seq_file *f, void *v)
732 const struct seq_operations cpuinfo_op =
734 .start = c_start,
735 .next = c_next,
736 .stop = c_stop,
737 .show = c_show,
740 #endif /* CONFIG_PROC_FS */