/* * arch/xtensa/kernel/setup.c * * This file is subject to the terms and conditions of the GNU General Public * License. See the file "COPYING" in the main directory of this archive * for more details. * * Copyright (C) 1995 Linus Torvalds * Copyright (C) 2001 - 2005 Tensilica Inc. * * Chris Zankel <chris@zankel.net> * Joe Taylor <joe@tensilica.com, joetylr@yahoo.com> * Kevin Chea * Marc Gauthier<marc@tensilica.com> <marc@alumni.uwaterloo.ca> */ #include <linux/errno.h>#include <linux/init.h>#include <linux/mm.h>#include <linux/proc_fs.h>#include <linux/screen_info.h>#include <linux/bootmem.h>#include <linux/kernel.h>#include <linux/of_fdt.h>#include <linux/of_platform.h> #if defined(CONFIG_VGA_CONSOLE) || defined(CONFIG_DUMMY_CONSOLE)# include <linux/console.h>#endif #ifdef CONFIG_RTC# include <linux/timex.h>#endif #ifdef CONFIG_PROC_FS# include <linux/seq_file.h>#endif #include <asm/bootparam.h>#include <asm/pgtable.h>#include <asm/processor.h>#include <asm/timex.h>#include <asm/platform.h>#include <asm/page.h>#include <asm/setup.h>#include <asm/param.h>#include <asm/traps.h> #include <platform/hardware.h> #if defined(CONFIG_VGA_CONSOLE) || defined(CONFIG_DUMMY_CONSOLE)struct screen_info screen_info = { 0, 24, 0, 0, 0, 80, 0, 0, 0, 24, 1, 16};#endif #ifdef CONFIG_BLK_DEV_FDextern struct fd_ops no_fd_ops;struct fd_ops *fd_ops;#endif extern struct rtc_ops no_rtc_ops;struct rtc_ops *rtc_ops; #ifdef CONFIG_BLK_DEV_INITRDextern unsigned long initrd_start;extern unsigned long initrd_end;int initrd_is_mapped = 0;extern int initrd_below_start_ok;#endif #ifdef CONFIG_OFextern u32 __dtb_start[];void *dtb_start = __dtb_start;#endif unsigned char aux_device_present;extern unsigned long loops_per_jiffy; /* Command line specified as configuration option. */ static char __initdata command_line[COMMAND_LINE_SIZE]; #ifdef CONFIG_CMDLINE_BOOLstatic char default_command_line[COMMAND_LINE_SIZE] __initdata = CONFIG_CMDLINE;#endif sysmem_info_t __initdata sysmem; #ifdef CONFIG_MMUextern void init_mmu(void);#elsestatic inline void init_mmu(void) { }#endif extern int mem_reserve(unsigned long, unsigned long, int);extern void bootmem_init(void);extern void zones_init(void); /* * Boot parameter parsing. * * The Xtensa port uses a list of variable-sized tags to pass data to * the kernel. The first tag must be a BP_TAG_FIRST tag for the list * to be recognised. The list is terminated with a zero-sized * BP_TAG_LAST tag. */ typedef struct tagtable { u32 tag; int (*parse)(const bp_tag_t*);} tagtable_t; #define __tagtable(tag, fn) static tagtable_t __tagtable_##fn \ __attribute__((used, section(".taglist"))) = { tag, fn } /* parse current tag */ static int __init add_sysmem_bank(unsigned long type, unsigned long start, unsigned long end){ if (sysmem.nr_banks >= SYSMEM_BANKS_MAX) { printk(KERN_WARNING "Ignoring memory bank 0x%08lx size %ldKB\n", start, end - start); return -EINVAL; } sysmem.bank[sysmem.nr_banks].type = type; sysmem.bank[sysmem.nr_banks].start = PAGE_ALIGN(start); sysmem.bank[sysmem.nr_banks].end = end & PAGE_MASK; sysmem.nr_banks++; return 0;} static int __init parse_tag_mem(const bp_tag_t *tag){ meminfo_t *mi = (meminfo_t *)(tag->data); if (mi->type != MEMORY_TYPE_CONVENTIONAL) return -1; return add_sysmem_bank(mi->type, mi->start, mi->end);} __tagtable(BP_TAG_MEMORY, parse_tag_mem); #ifdef CONFIG_BLK_DEV_INITRD static int __init parse_tag_initrd(const bp_tag_t* tag){ meminfo_t* mi; mi = (meminfo_t*)(tag->data); initrd_start = (unsigned long)__va(mi->start); initrd_end = (unsigned long)__va(mi->end); return 0;} __tagtable(BP_TAG_INITRD, parse_tag_initrd); #ifdef CONFIG_OF static int __init parse_tag_fdt(const bp_tag_t *tag){ dtb_start = __va(tag->data[0]); return 0;} __tagtable(BP_TAG_FDT, parse_tag_fdt); #endif /* CONFIG_OF */ #endif /* CONFIG_BLK_DEV_INITRD */ static int __init parse_tag_cmdline(const bp_tag_t* tag){ strlcpy(command_line, (char *)(tag->data), COMMAND_LINE_SIZE); return 0;} __tagtable(BP_TAG_COMMAND_LINE, parse_tag_cmdline); static int __init parse_bootparam(const bp_tag_t* tag){ extern tagtable_t __tagtable_begin, __tagtable_end; tagtable_t *t; /* Boot parameters must start with a BP_TAG_FIRST tag. */ if (tag->id != BP_TAG_FIRST) { printk(KERN_WARNING "Invalid boot parameters!\n"); return 0; } tag = (bp_tag_t*)((unsigned long)tag + sizeof(bp_tag_t) + tag->size); /* Parse all tags. */ while (tag != NULL && tag->id != BP_TAG_LAST) { for (t = &__tagtable_begin; t < &__tagtable_end; t++) { if (tag->id == t->tag) { t->parse(tag); break; } } if (t == &__tagtable_end) printk(KERN_WARNING "Ignoring tag " "0x%08x\n", tag->id); tag = (bp_tag_t*)((unsigned long)(tag + 1) + tag->size); } return 0;} #ifdef CONFIG_OFbool __initdata dt_memory_scan = false; void __init early_init_dt_add_memory_arch(u64 base, u64 size){ if (!dt_memory_scan) return; size &= PAGE_MASK; add_sysmem_bank(MEMORY_TYPE_CONVENTIONAL, base, base + size);} void * __init early_init_dt_alloc_memory_arch(u64 size, u64 align){ return __alloc_bootmem(size, align, 0);} void __init early_init_devtree(void *params){ if (sysmem.nr_banks == 0) dt_memory_scan = true; early_init_dt_scan(params); if (!command_line[0]) strlcpy(command_line, boot_command_line, COMMAND_LINE_SIZE);} static int __init xtensa_device_probe(void){ of_platform_populate(NULL, NULL, NULL, NULL); return 0;} device_initcall(xtensa_device_probe); #endif /* CONFIG_OF */ /* * Initialize architecture. (Early stage) */ void __init init_arch(bp_tag_t *bp_start){ sysmem.nr_banks = 0; /* Parse boot parameters */ if (bp_start) parse_bootparam(bp_start); #ifdef CONFIG_OF early_init_devtree(dtb_start);#endif if (sysmem.nr_banks == 0) { sysmem.nr_banks = 1; sysmem.bank[0].start = PLATFORM_DEFAULT_MEM_START; sysmem.bank[0].end = PLATFORM_DEFAULT_MEM_START + PLATFORM_DEFAULT_MEM_SIZE; } #ifdef CONFIG_CMDLINE_BOOL if (!command_line[0]) strlcpy(command_line, default_command_line, COMMAND_LINE_SIZE);#endif /* Early hook for platforms */ platform_init(bp_start); /* Initialize MMU. */ init_mmu();} /* * Initialize system. Setup memory and reserve regions. */ extern char _end;extern char _stext;extern char _WindowVectors_text_start;extern char _WindowVectors_text_end;extern char _DebugInterruptVector_literal_start;extern char _DebugInterruptVector_text_end;extern char _KernelExceptionVector_literal_start;extern char _KernelExceptionVector_text_end;extern char _UserExceptionVector_literal_start;extern char _UserExceptionVector_text_end;extern char _DoubleExceptionVector_literal_start;extern char _DoubleExceptionVector_text_end;#if XCHAL_EXCM_LEVEL >= 2extern char _Level2InterruptVector_text_start;extern char _Level2InterruptVector_text_end;#endif#if XCHAL_EXCM_LEVEL >= 3extern char _Level3InterruptVector_text_start;extern char _Level3InterruptVector_text_end;#endif#if XCHAL_EXCM_LEVEL >= 4extern char _Level4InterruptVector_text_start;extern char _Level4InterruptVector_text_end;#endif#if XCHAL_EXCM_LEVEL >= 5extern char _Level5InterruptVector_text_start;extern char _Level5InterruptVector_text_end;#endif#if XCHAL_EXCM_LEVEL >= 6extern char _Level6InterruptVector_text_start;extern char _Level6InterruptVector_text_end;#endif #ifdef CONFIG_S32C1I_SELFTEST#if XCHAL_HAVE_S32C1I static int __initdata rcw_word, rcw_probe_pc, rcw_exc; /* * Basic atomic compare-and-swap, that records PC of S32C1I for probing. * * If *v == cmp, set *v = set. Return previous *v. */static inline int probed_compare_swap(int *v, int cmp, int set){ int tmp; __asm__ __volatile__( " movi %1, 1f\n" " s32i %1, %4, 0\n" " wsr %2, scompare1\n" "1: s32c1i %0, %3, 0\n" : "=a" (set), "=&a" (tmp) : "a" (cmp), "a" (v), "a" (&rcw_probe_pc), "0" (set) : "memory" ); return set;} /* Handle probed exception */ void __init do_probed_exception(struct pt_regs *regs, unsigned long exccause){ if (regs->pc == rcw_probe_pc) { /* exception on s32c1i ? */ regs->pc += 3; /* skip the s32c1i instruction */ rcw_exc = exccause; } else { do_unhandled(regs, exccause); }} /* Simple test of S32C1I (soc bringup assist) */ void __init check_s32c1i(void){ int n, cause1, cause2; void *handbus, *handdata, *handaddr; /* temporarily saved handlers */ rcw_probe_pc = 0; handbus = trap_set_handler(EXCCAUSE_LOAD_STORE_ERROR, do_probed_exception); handdata = trap_set_handler(EXCCAUSE_LOAD_STORE_DATA_ERROR, do_probed_exception); handaddr = trap_set_handler(EXCCAUSE_LOAD_STORE_ADDR_ERROR, do_probed_exception); /* First try an S32C1I that does not store: */ rcw_exc = 0; rcw_word = 1; n = probed_compare_swap(&rcw_word, 0, 2); cause1 = rcw_exc; /* took exception? */ if (cause1 != 0) { /* unclean exception? */ if (n != 2 || rcw_word != 1) panic("S32C1I exception error"); } else if (rcw_word != 1 || n != 1) { panic("S32C1I compare error"); } /* Then an S32C1I that stores: */ rcw_exc = 0; rcw_word = 0x1234567; n = probed_compare_swap(&rcw_word, 0x1234567, 0xabcde); cause2 = rcw_exc; if (cause2 != 0) { /* unclean exception? */ if (n != 0xabcde || rcw_word != 0x1234567) panic("S32C1I exception error (b)"); } else if (rcw_word != 0xabcde || n != 0x1234567) { panic("S32C1I store error"); } /* Verify consistency of exceptions: */ if (cause1 || cause2) { pr_warn("S32C1I took exception %d, %d\n", cause1, cause2); /* If emulation of S32C1I upon bus error gets implemented, we can get rid of this panic for single core (not SMP) */ panic("S32C1I exceptions not currently supported"); } if (cause1 != cause2) panic("inconsistent S32C1I exceptions"); trap_set_handler(EXCCAUSE_LOAD_STORE_ERROR, handbus); trap_set_handler(EXCCAUSE_LOAD_STORE_DATA_ERROR, handdata); trap_set_handler(EXCCAUSE_LOAD_STORE_ADDR_ERROR, handaddr);} #else /* XCHAL_HAVE_S32C1I */ /* This condition should not occur with a commercially deployed processor. Display reminder for early engr test or demo chips / FPGA bitstreams */void __init check_s32c1i(void){ pr_warn("Processor configuration lacks atomic compare-and-swap support!\n");} #endif /* XCHAL_HAVE_S32C1I */#else /* CONFIG_S32C1I_SELFTEST */ void __init check_s32c1i(void){} #endif /* CONFIG_S32C1I_SELFTEST */ void __init setup_arch(char **cmdline_p){ strlcpy(boot_command_line, command_line, COMMAND_LINE_SIZE); *cmdline_p = command_line; check_s32c1i(); /* Reserve some memory regions */ #ifdef CONFIG_BLK_DEV_INITRD if (initrd_start < initrd_end) { initrd_is_mapped = mem_reserve(__pa(initrd_start), __pa(initrd_end), 0); initrd_below_start_ok = 1; } else { initrd_start = 0; }#endif mem_reserve(__pa(&_stext),__pa(&_end), 1); mem_reserve(__pa(&_WindowVectors_text_start), __pa(&_WindowVectors_text_end), 0); mem_reserve(__pa(&_DebugInterruptVector_literal_start), __pa(&_DebugInterruptVector_text_end), 0); mem_reserve(__pa(&_KernelExceptionVector_literal_start), __pa(&_KernelExceptionVector_text_end), 0); mem_reserve(__pa(&_UserExceptionVector_literal_start), __pa(&_UserExceptionVector_text_end), 0); mem_reserve(__pa(&_DoubleExceptionVector_literal_start), __pa(&_DoubleExceptionVector_text_end), 0); #if XCHAL_EXCM_LEVEL >= 2 mem_reserve(__pa(&_Level2InterruptVector_text_start), __pa(&_Level2InterruptVector_text_end), 0);#endif#if XCHAL_EXCM_LEVEL >= 3 mem_reserve(__pa(&_Level3InterruptVector_text_start), __pa(&_Level3InterruptVector_text_end), 0);#endif#if XCHAL_EXCM_LEVEL >= 4 mem_reserve(__pa(&_Level4InterruptVector_text_start), __pa(&_Level4InterruptVector_text_end), 0);#endif#if XCHAL_EXCM_LEVEL >= 5 mem_reserve(__pa(&_Level5InterruptVector_text_start), __pa(&_Level5InterruptVector_text_end), 0);#endif#if XCHAL_EXCM_LEVEL >= 6 mem_reserve(__pa(&_Level6InterruptVector_text_start), __pa(&_Level6InterruptVector_text_end), 0);#endifLines 1–500 of 697. Load more
/* * arch/xtensa/kernel/setup.c * * This file is subject to the terms and conditions of the GNU General Public * License. See the file "COPYING" in the main directory of this archive * for more details. * * Copyright (C) 1995 Linus Torvalds * Copyright (C) 2001 - 2005 Tensilica Inc. * * Chris Zankel <chris@zankel.net> * Joe Taylor <joe@tensilica.com, joetylr@yahoo.com> * Kevin Chea * Marc Gauthier<marc@tensilica.com> <marc@alumni.uwaterloo.ca> */ #include <linux/errno.h> #include <linux/init.h> #include <linux/mm.h> #include <linux/proc_fs.h> #include <linux/screen_info.h> #include <linux/bootmem.h> #include <linux/kernel.h> #include <linux/of_fdt.h> #include <linux/of_platform.h> #if defined(CONFIG_VGA_CONSOLE) || defined(CONFIG_DUMMY_CONSOLE) # include <linux/console.h> #endif #ifdef CONFIG_RTC # include <linux/timex.h> #endif #ifdef CONFIG_PROC_FS # include <linux/seq_file.h> #endif #include <asm/bootparam.h> #include <asm/pgtable.h> #include <asm/processor.h> #include <asm/timex.h> #include <asm/platform.h> #include <asm/page.h> #include <asm/setup.h> #include <asm/param.h> #include <asm/traps.h> #include <platform/hardware.h> #if defined(CONFIG_VGA_CONSOLE) || defined(CONFIG_DUMMY_CONSOLE) struct screen_info screen_info = { 0, 24, 0, 0, 0, 80, 0, 0, 0, 24, 1, 16}; #endif #ifdef CONFIG_BLK_DEV_FD extern struct fd_ops no_fd_ops; struct fd_ops *fd_ops; #endif extern struct rtc_ops no_rtc_ops; struct rtc_ops *rtc_ops; #ifdef CONFIG_BLK_DEV_INITRD extern unsigned long initrd_start; extern unsigned long initrd_end; int initrd_is_mapped = 0; extern int initrd_below_start_ok; #endif #ifdef CONFIG_OF extern u32 __dtb_start[]; void *dtb_start = __dtb_start; #endif unsigned char aux_device_present; extern unsigned long loops_per_jiffy; /* Command line specified as configuration option. */ static char __initdata command_line[COMMAND_LINE_SIZE]; #ifdef CONFIG_CMDLINE_BOOL static char default_command_line[COMMAND_LINE_SIZE] __initdata = CONFIG_CMDLINE; #endif sysmem_info_t __initdata sysmem; #ifdef CONFIG_MMU extern void init_mmu(void); #else static inline void init_mmu(void) { } #endif extern int mem_reserve(unsigned long, unsigned long, int); extern void bootmem_init(void); extern void zones_init(void); /* * Boot parameter parsing. * * The Xtensa port uses a list of variable-sized tags to pass data to * the kernel. The first tag must be a BP_TAG_FIRST tag for the list * to be recognised. The list is terminated with a zero-sized * BP_TAG_LAST tag. */ typedef struct tagtable { u32 tag; int (*parse)(const bp_tag_t*); } tagtable_t; #define __tagtable(tag, fn) static tagtable_t __tagtable_##fn \ __attribute__((used, section(".taglist"))) = { tag, fn } /* parse current tag */ static int __init add_sysmem_bank(unsigned long type, unsigned long start, unsigned long end) { if (sysmem.nr_banks >= SYSMEM_BANKS_MAX) { printk(KERN_WARNING "Ignoring memory bank 0x%08lx size %ldKB\n", start, end - start); return -EINVAL; } sysmem.bank[sysmem.nr_banks].type = type; sysmem.bank[sysmem.nr_banks].start = PAGE_ALIGN(start); sysmem.bank[sysmem.nr_banks].end = end & PAGE_MASK; sysmem.nr_banks++; return 0; } static int __init parse_tag_mem(const bp_tag_t *tag) { meminfo_t *mi = (meminfo_t *)(tag->data); if (mi->type != MEMORY_TYPE_CONVENTIONAL) return -1; return add_sysmem_bank(mi->type, mi->start, mi->end); } __tagtable(BP_TAG_MEMORY, parse_tag_mem); #ifdef CONFIG_BLK_DEV_INITRD static int __init parse_tag_initrd(const bp_tag_t* tag) { meminfo_t* mi; mi = (meminfo_t*)(tag->data); initrd_start = (unsigned long)__va(mi->start); initrd_end = (unsigned long)__va(mi->end); return 0; } __tagtable(BP_TAG_INITRD, parse_tag_initrd); #ifdef CONFIG_OF static int __init parse_tag_fdt(const bp_tag_t *tag) { dtb_start = __va(tag->data[0]); return 0; } __tagtable(BP_TAG_FDT, parse_tag_fdt); #endif /* CONFIG_OF */ #endif /* CONFIG_BLK_DEV_INITRD */ static int __init parse_tag_cmdline(const bp_tag_t* tag) { strlcpy(command_line, (char *)(tag->data), COMMAND_LINE_SIZE); return 0; } __tagtable(BP_TAG_COMMAND_LINE, parse_tag_cmdline); static int __init parse_bootparam(const bp_tag_t* tag) { extern tagtable_t __tagtable_begin, __tagtable_end; tagtable_t *t; /* Boot parameters must start with a BP_TAG_FIRST tag. */ if (tag->id != BP_TAG_FIRST) { printk(KERN_WARNING "Invalid boot parameters!\n"); return 0; } tag = (bp_tag_t*)((unsigned long)tag + sizeof(bp_tag_t) + tag->size); /* Parse all tags. */ while (tag != NULL && tag->id != BP_TAG_LAST) { for (t = &__tagtable_begin; t < &__tagtable_end; t++) { if (tag->id == t->tag) { t->parse(tag); break; } } if (t == &__tagtable_end) printk(KERN_WARNING "Ignoring tag " "0x%08x\n", tag->id); tag = (bp_tag_t*)((unsigned long)(tag + 1) + tag->size); } return 0; } #ifdef CONFIG_OF bool __initdata dt_memory_scan = false; void __init early_init_dt_add_memory_arch(u64 base, u64 size) { if (!dt_memory_scan) return; size &= PAGE_MASK; add_sysmem_bank(MEMORY_TYPE_CONVENTIONAL, base, base + size); } void * __init early_init_dt_alloc_memory_arch(u64 size, u64 align) { return __alloc_bootmem(size, align, 0); } void __init early_init_devtree(void *params) { if (sysmem.nr_banks == 0) dt_memory_scan = true; early_init_dt_scan(params); if (!command_line[0]) strlcpy(command_line, boot_command_line, COMMAND_LINE_SIZE); } static int __init xtensa_device_probe(void) { of_platform_populate(NULL, NULL, NULL, NULL); return 0; } device_initcall(xtensa_device_probe); #endif /* CONFIG_OF */ /* * Initialize architecture. (Early stage) */ void __init init_arch(bp_tag_t *bp_start) { sysmem.nr_banks = 0; /* Parse boot parameters */ if (bp_start) parse_bootparam(bp_start); #ifdef CONFIG_OF early_init_devtree(dtb_start); #endif if (sysmem.nr_banks == 0) { sysmem.nr_banks = 1; sysmem.bank[0].start = PLATFORM_DEFAULT_MEM_START; sysmem.bank[0].end = PLATFORM_DEFAULT_MEM_START + PLATFORM_DEFAULT_MEM_SIZE; } #ifdef CONFIG_CMDLINE_BOOL if (!command_line[0]) strlcpy(command_line, default_command_line, COMMAND_LINE_SIZE); #endif /* Early hook for platforms */ platform_init(bp_start); /* Initialize MMU. */ init_mmu(); } /* * Initialize system. Setup memory and reserve regions. */ extern char _end; extern char _stext; extern char _WindowVectors_text_start; extern char _WindowVectors_text_end; extern char _DebugInterruptVector_literal_start; extern char _DebugInterruptVector_text_end; extern char _KernelExceptionVector_literal_start; extern char _KernelExceptionVector_text_end; extern char _UserExceptionVector_literal_start; extern char _UserExceptionVector_text_end; extern char _DoubleExceptionVector_literal_start; extern char _DoubleExceptionVector_text_end; #if XCHAL_EXCM_LEVEL >= 2 extern char _Level2InterruptVector_text_start; extern char _Level2InterruptVector_text_end; #endif #if XCHAL_EXCM_LEVEL >= 3 extern char _Level3InterruptVector_text_start; extern char _Level3InterruptVector_text_end; #endif #if XCHAL_EXCM_LEVEL >= 4 extern char _Level4InterruptVector_text_start; extern char _Level4InterruptVector_text_end; #endif #if XCHAL_EXCM_LEVEL >= 5 extern char _Level5InterruptVector_text_start; extern char _Level5InterruptVector_text_end; #endif #if XCHAL_EXCM_LEVEL >= 6 extern char _Level6InterruptVector_text_start; extern char _Level6InterruptVector_text_end; #endif #ifdef CONFIG_S32C1I_SELFTEST #if XCHAL_HAVE_S32C1I static int __initdata rcw_word, rcw_probe_pc, rcw_exc; /* * Basic atomic compare-and-swap, that records PC of S32C1I for probing. * * If *v == cmp, set *v = set. Return previous *v. */ static inline int probed_compare_swap(int *v, int cmp, int set) { int tmp; __asm__ __volatile__( " movi %1, 1f\n" " s32i %1, %4, 0\n" " wsr %2, scompare1\n" "1: s32c1i %0, %3, 0\n" : "=a" (set), "=&a" (tmp) : "a" (cmp), "a" (v), "a" (&rcw_probe_pc), "0" (set) : "memory" ); return set; } /* Handle probed exception */ void __init do_probed_exception(struct pt_regs *regs, unsigned long exccause) { if (regs->pc == rcw_probe_pc) { /* exception on s32c1i ? */ regs->pc += 3; /* skip the s32c1i instruction */ rcw_exc = exccause; } else { do_unhandled(regs, exccause); } } /* Simple test of S32C1I (soc bringup assist) */ void __init check_s32c1i(void) { int n, cause1, cause2; void *handbus, *handdata, *handaddr; /* temporarily saved handlers */ rcw_probe_pc = 0; handbus = trap_set_handler(EXCCAUSE_LOAD_STORE_ERROR, do_probed_exception); handdata = trap_set_handler(EXCCAUSE_LOAD_STORE_DATA_ERROR, do_probed_exception); handaddr = trap_set_handler(EXCCAUSE_LOAD_STORE_ADDR_ERROR, do_probed_exception); /* First try an S32C1I that does not store: */ rcw_exc = 0; rcw_word = 1; n = probed_compare_swap(&rcw_word, 0, 2); cause1 = rcw_exc; /* took exception? */ if (cause1 != 0) { /* unclean exception? */ if (n != 2 || rcw_word != 1) panic("S32C1I exception error"); } else if (rcw_word != 1 || n != 1) { panic("S32C1I compare error"); } /* Then an S32C1I that stores: */ rcw_exc = 0; rcw_word = 0x1234567; n = probed_compare_swap(&rcw_word, 0x1234567, 0xabcde); cause2 = rcw_exc; if (cause2 != 0) { /* unclean exception? */ if (n != 0xabcde || rcw_word != 0x1234567) panic("S32C1I exception error (b)"); } else if (rcw_word != 0xabcde || n != 0x1234567) { panic("S32C1I store error"); } /* Verify consistency of exceptions: */ if (cause1 || cause2) { pr_warn("S32C1I took exception %d, %d\n", cause1, cause2); /* If emulation of S32C1I upon bus error gets implemented, we can get rid of this panic for single core (not SMP) */ panic("S32C1I exceptions not currently supported"); } if (cause1 != cause2) panic("inconsistent S32C1I exceptions"); trap_set_handler(EXCCAUSE_LOAD_STORE_ERROR, handbus); trap_set_handler(EXCCAUSE_LOAD_STORE_DATA_ERROR, handdata); trap_set_handler(EXCCAUSE_LOAD_STORE_ADDR_ERROR, handaddr); } #else /* XCHAL_HAVE_S32C1I */ /* This condition should not occur with a commercially deployed processor. Display reminder for early engr test or demo chips / FPGA bitstreams */ void __init check_s32c1i(void) { pr_warn("Processor configuration lacks atomic compare-and-swap support!\n"); } #endif /* XCHAL_HAVE_S32C1I */ #else /* CONFIG_S32C1I_SELFTEST */ void __init check_s32c1i(void) { } #endif /* CONFIG_S32C1I_SELFTEST */ void __init setup_arch(char **cmdline_p) { strlcpy(boot_command_line, command_line, COMMAND_LINE_SIZE); *cmdline_p = command_line; check_s32c1i(); /* Reserve some memory regions */ #ifdef CONFIG_BLK_DEV_INITRD if (initrd_start < initrd_end) { initrd_is_mapped = mem_reserve(__pa(initrd_start), __pa(initrd_end), 0); initrd_below_start_ok = 1; } else { initrd_start = 0; } #endif mem_reserve(__pa(&_stext),__pa(&_end), 1); mem_reserve(__pa(&_WindowVectors_text_start), __pa(&_WindowVectors_text_end), 0); mem_reserve(__pa(&_DebugInterruptVector_literal_start), __pa(&_DebugInterruptVector_text_end), 0); mem_reserve(__pa(&_KernelExceptionVector_literal_start), __pa(&_KernelExceptionVector_text_end), 0); mem_reserve(__pa(&_UserExceptionVector_literal_start), __pa(&_UserExceptionVector_text_end), 0); mem_reserve(__pa(&_DoubleExceptionVector_literal_start), __pa(&_DoubleExceptionVector_text_end), 0); #if XCHAL_EXCM_LEVEL >= 2 mem_reserve(__pa(&_Level2InterruptVector_text_start), __pa(&_Level2InterruptVector_text_end), 0); #endif #if XCHAL_EXCM_LEVEL >= 3 mem_reserve(__pa(&_Level3InterruptVector_text_start), __pa(&_Level3InterruptVector_text_end), 0); #endif #if XCHAL_EXCM_LEVEL >= 4 mem_reserve(__pa(&_Level4InterruptVector_text_start), __pa(&_Level4InterruptVector_text_end), 0); #endif #if XCHAL_EXCM_LEVEL >= 5 mem_reserve(__pa(&_Level5InterruptVector_text_start), __pa(&_Level5InterruptVector_text_end), 0); #endif #if XCHAL_EXCM_LEVEL >= 6 mem_reserve(__pa(&_Level6InterruptVector_text_start), __pa(&_Level6InterruptVector_text_end), 0); #endif