projects / mirror_ubuntu-eoan-kernel.git / blame
| Commit | Line | Data |
|---|---|---|
| 081860b9 GR |
1 | // SPDX-License-Identifier: GPL-2.0 |
| 2 | // Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd. | |
| 3 | ||
| 4 | #include <linux/sched.h> | |
| 5 | #include <linux/signal.h> | |
| 6 | #include <linux/kernel.h> | |
| 7 | #include <linux/mm.h> | |
| 8 | #include <linux/module.h> | |
| 9 | #include <linux/user.h> | |
| 10 | #include <linux/string.h> | |
| 11 | #include <linux/linkage.h> | |
| 12 | #include <linux/init.h> | |
| 13 | #include <linux/ptrace.h> | |
| 14 | #include <linux/kallsyms.h> | |
| 15 | #include <linux/rtc.h> | |
| 16 | #include <linux/uaccess.h> | |
| 17 | ||
| 18 | #include <asm/setup.h> | |
| 19 | #include <asm/traps.h> | |
| 20 | #include <asm/pgalloc.h> | |
| 21 | #include <asm/siginfo.h> | |
| 22 | ||
| 23 | #include <asm/mmu_context.h> | |
| 24 | ||
| 25 | #ifdef CONFIG_CPU_HAS_FPU | |
| 26 | #include <abi/fpu.h> | |
| 27 | #endif | |
| 28 | ||
| 29 | /* Defined in entry.S */ | |
| 30 | asmlinkage void csky_trap(void); | |
| 31 | ||
| 32 | asmlinkage void csky_systemcall(void); | |
| 33 | asmlinkage void csky_cmpxchg(void); | |
| 34 | asmlinkage void csky_get_tls(void); | |
| 35 | asmlinkage void csky_irq(void); | |
| 36 | ||
| 37 | asmlinkage void csky_tlbinvalidl(void); | |
| 38 | asmlinkage void csky_tlbinvalids(void); | |
| 39 | asmlinkage void csky_tlbmodified(void); | |
| 40 | ||
| 41 | /* Defined in head.S */ | |
| 42 | asmlinkage void _start_smp_secondary(void); | |
| 43 | ||
| 44 | void __init pre_trap_init(void) | |
| 45 | { | |
| 46 | int i; | |
| 47 | ||
| 48 | mtcr("vbr", vec_base); | |
| 49 | ||
| 50 | for (i = 1; i < 128; i++) | |
| 51 | VEC_INIT(i, csky_trap); | |
| 52 | } | |
| 53 | ||
| 54 | void __init trap_init(void) | |
| 55 | { | |
| 56 | VEC_INIT(VEC_AUTOVEC, csky_irq); | |
| 57 | ||
| 58 | /* setup trap0 trap2 trap3 */ | |
| 59 | VEC_INIT(VEC_TRAP0, csky_systemcall); | |
| 60 | VEC_INIT(VEC_TRAP2, csky_cmpxchg); | |
| 61 | VEC_INIT(VEC_TRAP3, csky_get_tls); | |
| 62 | ||
| 63 | /* setup MMU TLB exception */ | |
| 64 | VEC_INIT(VEC_TLBINVALIDL, csky_tlbinvalidl); | |
| 65 | VEC_INIT(VEC_TLBINVALIDS, csky_tlbinvalids); | |
| 66 | VEC_INIT(VEC_TLBMODIFIED, csky_tlbmodified); | |
| 67 | ||
| 68 | #ifdef CONFIG_CPU_HAS_FPU | |
| 69 | init_fpu(); | |
| 70 | #endif | |
| 71 | ||
| 72 | #ifdef CONFIG_SMP | |
| 73 | mtcr("cr<28, 0>", virt_to_phys(vec_base)); | |
| 74 | ||
| 75 | VEC_INIT(VEC_RESET, (void *)virt_to_phys(_start_smp_secondary)); | |
| 76 | #endif | |
| 77 | } | |
| 78 | ||
| 79 | void die_if_kernel(char *str, struct pt_regs *regs, int nr) | |
| 80 | { | |
| 81 | if (user_mode(regs)) | |
| 82 | return; | |
| 83 | ||
| 84 | console_verbose(); | |
| 85 | pr_err("%s: %08x\n", str, nr); | |
| 86 | show_regs(regs); | |
| 87 | add_taint(TAINT_DIE, LOCKDEP_NOW_UNRELIABLE); | |
| 88 | do_exit(SIGSEGV); | |
| 89 | } | |
| 90 | ||
| 91 | void buserr(struct pt_regs *regs) | |
| 92 | { | |
| 93 | #ifdef CONFIG_CPU_CK810 | |
| 94 | static unsigned long prev_pc; | |
| 95 | ||
| 96 | if ((regs->pc == prev_pc) && prev_pc != 0) { | |
| 97 | prev_pc = 0; | |
| 98 | } else { | |
| 99 | prev_pc = regs->pc; | |
| 100 | return; | |
| 101 | } | |
| 102 | #endif | |
| 103 | ||
| 104 | die_if_kernel("Kernel mode BUS error", regs, 0); | |
| 105 | ||
| 106 | pr_err("User mode Bus Error\n"); | |
| 107 | show_regs(regs); | |
| 108 | ||
| 081860b9 GR |
109 | force_sig_fault(SIGSEGV, 0, (void __user *)regs->pc, current); |
| 110 | } | |
| 111 | ||
| 112 | #define USR_BKPT 0x1464 | |
| 113 | asmlinkage void trap_c(struct pt_regs *regs) | |
| 114 | { | |
| 115 | int sig; | |
| 116 | unsigned long vector; | |
| 117 | siginfo_t info; | |
| 118 | ||
| 119 | vector = (mfcr("psr") >> 16) & 0xff; | |
| 120 | ||
| 121 | switch (vector) { | |
| 122 | case VEC_ZERODIV: | |
| 123 | sig = SIGFPE; | |
| 124 | break; | |
| 125 | /* ptrace */ | |
| 126 | case VEC_TRACE: | |
| 127 | info.si_code = TRAP_TRACE; | |
| 128 | sig = SIGTRAP; | |
| 129 | break; | |
| 130 | case VEC_ILLEGAL: | |
| 131 | #ifndef CONFIG_CPU_NO_USER_BKPT | |
| 132 | if (*(uint16_t *)instruction_pointer(regs) != USR_BKPT) | |
| 133 | #endif | |
| 134 | { | |
| 135 | sig = SIGILL; | |
| 136 | break; | |
| 137 | } | |
| 138 | /* gdbserver breakpoint */ | |
| 139 | case VEC_TRAP1: | |
| 140 | /* jtagserver breakpoint */ | |
| 141 | case VEC_BREAKPOINT: | |
| 142 | info.si_code = TRAP_BRKPT; | |
| 143 | sig = SIGTRAP; | |
| 144 | break; | |
| 145 | case VEC_ACCESS: | |
| 146 | return buserr(regs); | |
| 147 | #ifdef CONFIG_CPU_NEED_SOFTALIGN | |
| 148 | case VEC_ALIGN: | |
| 149 | return csky_alignment(regs); | |
| 150 | #endif | |
| 151 | #ifdef CONFIG_CPU_HAS_FPU | |
| 152 | case VEC_FPE: | |
| 153 | return fpu_fpe(regs); | |
| 154 | case VEC_PRIV: | |
| 155 | if (fpu_libc_helper(regs)) | |
| 156 | return; | |
| 157 | #endif | |
| 158 | default: | |
| 159 | sig = SIGSEGV; | |
| 160 | break; | |
| 161 | } | |
| 162 | send_sig(sig, current, 0); | |
| 163 | } |