Loading...
1/*
2 * linux/arch/m32r/kernel/traps.c
3 *
4 * Copyright (C) 2001, 2002 Hirokazu Takata, Hiroyuki Kondo,
5 * Hitoshi Yamamoto
6 */
7
8/*
9 * 'traps.c' handles hardware traps and faults after we have saved some
10 * state in 'entry.S'.
11 */
12#include <linux/init.h>
13#include <linux/kernel.h>
14#include <linux/kallsyms.h>
15#include <linux/stddef.h>
16#include <linux/ptrace.h>
17#include <linux/mm.h>
18#include <asm/page.h>
19#include <asm/processor.h>
20
21#include <asm/system.h>
22#include <asm/uaccess.h>
23#include <asm/io.h>
24#include <linux/atomic.h>
25
26#include <asm/smp.h>
27
28#include <linux/module.h>
29
30asmlinkage void alignment_check(void);
31asmlinkage void ei_handler(void);
32asmlinkage void rie_handler(void);
33asmlinkage void debug_trap(void);
34asmlinkage void cache_flushing_handler(void);
35asmlinkage void ill_trap(void);
36
37#ifdef CONFIG_SMP
38extern void smp_reschedule_interrupt(void);
39extern void smp_invalidate_interrupt(void);
40extern void smp_call_function_interrupt(void);
41extern void smp_ipi_timer_interrupt(void);
42extern void smp_flush_cache_all_interrupt(void);
43extern void smp_call_function_single_interrupt(void);
44
45/*
46 * for Boot AP function
47 */
48asm (
49 " .section .eit_vector4,\"ax\" \n"
50 " .global _AP_RE \n"
51 " .global startup_AP \n"
52 "_AP_RE: \n"
53 " .fill 32, 4, 0 \n"
54 "_AP_EI: bra startup_AP \n"
55 " .previous \n"
56);
57#endif /* CONFIG_SMP */
58
59extern unsigned long eit_vector[];
60#define BRA_INSN(func, entry) \
61 ((unsigned long)func - (unsigned long)eit_vector - entry*4)/4 \
62 + 0xff000000UL
63
64static void set_eit_vector_entries(void)
65{
66 extern void default_eit_handler(void);
67 extern void system_call(void);
68 extern void pie_handler(void);
69 extern void ace_handler(void);
70 extern void tme_handler(void);
71 extern void _flush_cache_copyback_all(void);
72
73 eit_vector[0] = 0xd0c00001; /* seth r0, 0x01 */
74 eit_vector[1] = BRA_INSN(default_eit_handler, 1);
75 eit_vector[4] = 0xd0c00010; /* seth r0, 0x10 */
76 eit_vector[5] = BRA_INSN(default_eit_handler, 5);
77 eit_vector[8] = BRA_INSN(rie_handler, 8);
78 eit_vector[12] = BRA_INSN(alignment_check, 12);
79 eit_vector[16] = BRA_INSN(ill_trap, 16);
80 eit_vector[17] = BRA_INSN(debug_trap, 17);
81 eit_vector[18] = BRA_INSN(system_call, 18);
82 eit_vector[19] = BRA_INSN(ill_trap, 19);
83 eit_vector[20] = BRA_INSN(ill_trap, 20);
84 eit_vector[21] = BRA_INSN(ill_trap, 21);
85 eit_vector[22] = BRA_INSN(ill_trap, 22);
86 eit_vector[23] = BRA_INSN(ill_trap, 23);
87 eit_vector[24] = BRA_INSN(ill_trap, 24);
88 eit_vector[25] = BRA_INSN(ill_trap, 25);
89 eit_vector[26] = BRA_INSN(ill_trap, 26);
90 eit_vector[27] = BRA_INSN(ill_trap, 27);
91 eit_vector[28] = BRA_INSN(cache_flushing_handler, 28);
92 eit_vector[29] = BRA_INSN(ill_trap, 29);
93 eit_vector[30] = BRA_INSN(ill_trap, 30);
94 eit_vector[31] = BRA_INSN(ill_trap, 31);
95 eit_vector[32] = BRA_INSN(ei_handler, 32);
96 eit_vector[64] = BRA_INSN(pie_handler, 64);
97#ifdef CONFIG_MMU
98 eit_vector[68] = BRA_INSN(ace_handler, 68);
99 eit_vector[72] = BRA_INSN(tme_handler, 72);
100#endif /* CONFIG_MMU */
101#ifdef CONFIG_SMP
102 eit_vector[184] = (unsigned long)smp_reschedule_interrupt;
103 eit_vector[185] = (unsigned long)smp_invalidate_interrupt;
104 eit_vector[186] = (unsigned long)smp_call_function_interrupt;
105 eit_vector[187] = (unsigned long)smp_ipi_timer_interrupt;
106 eit_vector[188] = (unsigned long)smp_flush_cache_all_interrupt;
107 eit_vector[189] = 0; /* CPU_BOOT_IPI */
108 eit_vector[190] = (unsigned long)smp_call_function_single_interrupt;
109 eit_vector[191] = 0;
110#endif
111 _flush_cache_copyback_all();
112}
113
114void __init trap_init(void)
115{
116 set_eit_vector_entries();
117
118 /*
119 * Should be a barrier for any external CPU state.
120 */
121 cpu_init();
122}
123
124static int kstack_depth_to_print = 24;
125
126static void show_trace(struct task_struct *task, unsigned long *stack)
127{
128 unsigned long addr;
129
130 if (!stack)
131 stack = (unsigned long*)&stack;
132
133 printk("Call Trace: ");
134 while (!kstack_end(stack)) {
135 addr = *stack++;
136 if (__kernel_text_address(addr)) {
137 printk("[<%08lx>] ", addr);
138 print_symbol("%s\n", addr);
139 }
140 }
141 printk("\n");
142}
143
144void show_stack(struct task_struct *task, unsigned long *sp)
145{
146 unsigned long *stack;
147 int i;
148
149 /*
150 * debugging aid: "show_stack(NULL);" prints the
151 * back trace for this cpu.
152 */
153
154 if(sp==NULL) {
155 if (task)
156 sp = (unsigned long *)task->thread.sp;
157 else
158 sp=(unsigned long*)&sp;
159 }
160
161 stack = sp;
162 for(i=0; i < kstack_depth_to_print; i++) {
163 if (kstack_end(stack))
164 break;
165 if (i && ((i % 4) == 0))
166 printk("\n ");
167 printk("%08lx ", *stack++);
168 }
169 printk("\n");
170 show_trace(task, sp);
171}
172
173void dump_stack(void)
174{
175 unsigned long stack;
176
177 show_trace(current, &stack);
178}
179
180EXPORT_SYMBOL(dump_stack);
181
182static void show_registers(struct pt_regs *regs)
183{
184 int i = 0;
185 int in_kernel = 1;
186 unsigned long sp;
187
188 printk("CPU: %d\n", smp_processor_id());
189 show_regs(regs);
190
191 sp = (unsigned long) (1+regs);
192 if (user_mode(regs)) {
193 in_kernel = 0;
194 sp = regs->spu;
195 printk("SPU: %08lx\n", sp);
196 } else {
197 printk("SPI: %08lx\n", sp);
198 }
199 printk("Process %s (pid: %d, process nr: %d, stackpage=%08lx)",
200 current->comm, task_pid_nr(current), 0xffff & i, 4096+(unsigned long)current);
201
202 /*
203 * When in-kernel, we also print out the stack and code at the
204 * time of the fault..
205 */
206 if (in_kernel) {
207 printk("\nStack: ");
208 show_stack(current, (unsigned long*) sp);
209
210 printk("\nCode: ");
211 if (regs->bpc < PAGE_OFFSET)
212 goto bad;
213
214 for(i=0;i<20;i++) {
215 unsigned char c;
216 if (__get_user(c, &((unsigned char*)regs->bpc)[i])) {
217bad:
218 printk(" Bad PC value.");
219 break;
220 }
221 printk("%02x ", c);
222 }
223 }
224 printk("\n");
225}
226
227static DEFINE_SPINLOCK(die_lock);
228
229void die(const char * str, struct pt_regs * regs, long err)
230{
231 console_verbose();
232 spin_lock_irq(&die_lock);
233 bust_spinlocks(1);
234 printk("%s: %04lx\n", str, err & 0xffff);
235 show_registers(regs);
236 bust_spinlocks(0);
237 spin_unlock_irq(&die_lock);
238 do_exit(SIGSEGV);
239}
240
241static __inline__ void die_if_kernel(const char * str,
242 struct pt_regs * regs, long err)
243{
244 if (!user_mode(regs))
245 die(str, regs, err);
246}
247
248static __inline__ void do_trap(int trapnr, int signr, const char * str,
249 struct pt_regs * regs, long error_code, siginfo_t *info)
250{
251 if (user_mode(regs)) {
252 /* trap_signal */
253 struct task_struct *tsk = current;
254 tsk->thread.error_code = error_code;
255 tsk->thread.trap_no = trapnr;
256 if (info)
257 force_sig_info(signr, info, tsk);
258 else
259 force_sig(signr, tsk);
260 return;
261 } else {
262 /* kernel_trap */
263 if (!fixup_exception(regs))
264 die(str, regs, error_code);
265 return;
266 }
267}
268
269#define DO_ERROR(trapnr, signr, str, name) \
270asmlinkage void do_##name(struct pt_regs * regs, long error_code) \
271{ \
272 do_trap(trapnr, signr, NULL, regs, error_code, NULL); \
273}
274
275#define DO_ERROR_INFO(trapnr, signr, str, name, sicode, siaddr) \
276asmlinkage void do_##name(struct pt_regs * regs, long error_code) \
277{ \
278 siginfo_t info; \
279 info.si_signo = signr; \
280 info.si_errno = 0; \
281 info.si_code = sicode; \
282 info.si_addr = (void __user *)siaddr; \
283 do_trap(trapnr, signr, str, regs, error_code, &info); \
284}
285
286DO_ERROR( 1, SIGTRAP, "debug trap", debug_trap)
287DO_ERROR_INFO(0x20, SIGILL, "reserved instruction ", rie_handler, ILL_ILLOPC, regs->bpc)
288DO_ERROR_INFO(0x100, SIGILL, "privileged instruction", pie_handler, ILL_PRVOPC, regs->bpc)
289DO_ERROR_INFO(-1, SIGILL, "illegal trap", ill_trap, ILL_ILLTRP, regs->bpc)
290
291extern int handle_unaligned_access(unsigned long, struct pt_regs *);
292
293/* This code taken from arch/sh/kernel/traps.c */
294asmlinkage void do_alignment_check(struct pt_regs *regs, long error_code)
295{
296 mm_segment_t oldfs;
297 unsigned long insn;
298 int tmp;
299
300 oldfs = get_fs();
301
302 if (user_mode(regs)) {
303 local_irq_enable();
304 current->thread.error_code = error_code;
305 current->thread.trap_no = 0x17;
306
307 set_fs(USER_DS);
308 if (copy_from_user(&insn, (void *)regs->bpc, 4)) {
309 set_fs(oldfs);
310 goto uspace_segv;
311 }
312 tmp = handle_unaligned_access(insn, regs);
313 set_fs(oldfs);
314
315 if (!tmp)
316 return;
317
318 uspace_segv:
319 printk(KERN_NOTICE "Killing process \"%s\" due to unaligned "
320 "access\n", current->comm);
321 force_sig(SIGSEGV, current);
322 } else {
323 set_fs(KERNEL_DS);
324 if (copy_from_user(&insn, (void *)regs->bpc, 4)) {
325 set_fs(oldfs);
326 die("insn faulting in do_address_error", regs, 0);
327 }
328 handle_unaligned_access(insn, regs);
329 set_fs(oldfs);
330 }
331}
1/*
2 * linux/arch/m32r/kernel/traps.c
3 *
4 * Copyright (C) 2001, 2002 Hirokazu Takata, Hiroyuki Kondo,
5 * Hitoshi Yamamoto
6 */
7
8/*
9 * 'traps.c' handles hardware traps and faults after we have saved some
10 * state in 'entry.S'.
11 */
12#include <linux/init.h>
13#include <linux/kernel.h>
14#include <linux/kallsyms.h>
15#include <linux/stddef.h>
16#include <linux/ptrace.h>
17#include <linux/mm.h>
18#include <asm/page.h>
19#include <asm/processor.h>
20
21#include <asm/uaccess.h>
22#include <asm/io.h>
23#include <linux/atomic.h>
24
25#include <asm/smp.h>
26
27#include <linux/module.h>
28
29asmlinkage void alignment_check(void);
30asmlinkage void ei_handler(void);
31asmlinkage void rie_handler(void);
32asmlinkage void debug_trap(void);
33asmlinkage void cache_flushing_handler(void);
34asmlinkage void ill_trap(void);
35
36#ifdef CONFIG_SMP
37extern void smp_reschedule_interrupt(void);
38extern void smp_invalidate_interrupt(void);
39extern void smp_call_function_interrupt(void);
40extern void smp_ipi_timer_interrupt(void);
41extern void smp_flush_cache_all_interrupt(void);
42extern void smp_call_function_single_interrupt(void);
43
44/*
45 * for Boot AP function
46 */
47asm (
48 " .section .eit_vector4,\"ax\" \n"
49 " .global _AP_RE \n"
50 " .global startup_AP \n"
51 "_AP_RE: \n"
52 " .fill 32, 4, 0 \n"
53 "_AP_EI: bra startup_AP \n"
54 " .previous \n"
55);
56#endif /* CONFIG_SMP */
57
58extern unsigned long eit_vector[];
59#define BRA_INSN(func, entry) \
60 ((unsigned long)func - (unsigned long)eit_vector - entry*4)/4 \
61 + 0xff000000UL
62
63static void set_eit_vector_entries(void)
64{
65 extern void default_eit_handler(void);
66 extern void system_call(void);
67 extern void pie_handler(void);
68 extern void ace_handler(void);
69 extern void tme_handler(void);
70 extern void _flush_cache_copyback_all(void);
71
72 eit_vector[0] = 0xd0c00001; /* seth r0, 0x01 */
73 eit_vector[1] = BRA_INSN(default_eit_handler, 1);
74 eit_vector[4] = 0xd0c00010; /* seth r0, 0x10 */
75 eit_vector[5] = BRA_INSN(default_eit_handler, 5);
76 eit_vector[8] = BRA_INSN(rie_handler, 8);
77 eit_vector[12] = BRA_INSN(alignment_check, 12);
78 eit_vector[16] = BRA_INSN(ill_trap, 16);
79 eit_vector[17] = BRA_INSN(debug_trap, 17);
80 eit_vector[18] = BRA_INSN(system_call, 18);
81 eit_vector[19] = BRA_INSN(ill_trap, 19);
82 eit_vector[20] = BRA_INSN(ill_trap, 20);
83 eit_vector[21] = BRA_INSN(ill_trap, 21);
84 eit_vector[22] = BRA_INSN(ill_trap, 22);
85 eit_vector[23] = BRA_INSN(ill_trap, 23);
86 eit_vector[24] = BRA_INSN(ill_trap, 24);
87 eit_vector[25] = BRA_INSN(ill_trap, 25);
88 eit_vector[26] = BRA_INSN(ill_trap, 26);
89 eit_vector[27] = BRA_INSN(ill_trap, 27);
90 eit_vector[28] = BRA_INSN(cache_flushing_handler, 28);
91 eit_vector[29] = BRA_INSN(ill_trap, 29);
92 eit_vector[30] = BRA_INSN(ill_trap, 30);
93 eit_vector[31] = BRA_INSN(ill_trap, 31);
94 eit_vector[32] = BRA_INSN(ei_handler, 32);
95 eit_vector[64] = BRA_INSN(pie_handler, 64);
96#ifdef CONFIG_MMU
97 eit_vector[68] = BRA_INSN(ace_handler, 68);
98 eit_vector[72] = BRA_INSN(tme_handler, 72);
99#endif /* CONFIG_MMU */
100#ifdef CONFIG_SMP
101 eit_vector[184] = (unsigned long)smp_reschedule_interrupt;
102 eit_vector[185] = (unsigned long)smp_invalidate_interrupt;
103 eit_vector[186] = (unsigned long)smp_call_function_interrupt;
104 eit_vector[187] = (unsigned long)smp_ipi_timer_interrupt;
105 eit_vector[188] = (unsigned long)smp_flush_cache_all_interrupt;
106 eit_vector[189] = 0; /* CPU_BOOT_IPI */
107 eit_vector[190] = (unsigned long)smp_call_function_single_interrupt;
108 eit_vector[191] = 0;
109#endif
110 _flush_cache_copyback_all();
111}
112
113void __init trap_init(void)
114{
115 set_eit_vector_entries();
116
117 /*
118 * Should be a barrier for any external CPU state.
119 */
120 cpu_init();
121}
122
123static int kstack_depth_to_print = 24;
124
125static void show_trace(struct task_struct *task, unsigned long *stack)
126{
127 unsigned long addr;
128
129 if (!stack)
130 stack = (unsigned long*)&stack;
131
132 printk("Call Trace: ");
133 while (!kstack_end(stack)) {
134 addr = *stack++;
135 if (__kernel_text_address(addr)) {
136 printk("[<%08lx>] ", addr);
137 print_symbol("%s\n", addr);
138 }
139 }
140 printk("\n");
141}
142
143void show_stack(struct task_struct *task, unsigned long *sp)
144{
145 unsigned long *stack;
146 int i;
147
148 /*
149 * debugging aid: "show_stack(NULL);" prints the
150 * back trace for this cpu.
151 */
152
153 if(sp==NULL) {
154 if (task)
155 sp = (unsigned long *)task->thread.sp;
156 else
157 sp=(unsigned long*)&sp;
158 }
159
160 stack = sp;
161 for(i=0; i < kstack_depth_to_print; i++) {
162 if (kstack_end(stack))
163 break;
164 if (i && ((i % 4) == 0))
165 printk("\n ");
166 printk("%08lx ", *stack++);
167 }
168 printk("\n");
169 show_trace(task, sp);
170}
171
172void dump_stack(void)
173{
174 unsigned long stack;
175
176 show_trace(current, &stack);
177}
178
179EXPORT_SYMBOL(dump_stack);
180
181static void show_registers(struct pt_regs *regs)
182{
183 int i = 0;
184 int in_kernel = 1;
185 unsigned long sp;
186
187 printk("CPU: %d\n", smp_processor_id());
188 show_regs(regs);
189
190 sp = (unsigned long) (1+regs);
191 if (user_mode(regs)) {
192 in_kernel = 0;
193 sp = regs->spu;
194 printk("SPU: %08lx\n", sp);
195 } else {
196 printk("SPI: %08lx\n", sp);
197 }
198 printk("Process %s (pid: %d, process nr: %d, stackpage=%08lx)",
199 current->comm, task_pid_nr(current), 0xffff & i, 4096+(unsigned long)current);
200
201 /*
202 * When in-kernel, we also print out the stack and code at the
203 * time of the fault..
204 */
205 if (in_kernel) {
206 printk("\nStack: ");
207 show_stack(current, (unsigned long*) sp);
208
209 printk("\nCode: ");
210 if (regs->bpc < PAGE_OFFSET)
211 goto bad;
212
213 for(i=0;i<20;i++) {
214 unsigned char c;
215 if (__get_user(c, &((unsigned char*)regs->bpc)[i])) {
216bad:
217 printk(" Bad PC value.");
218 break;
219 }
220 printk("%02x ", c);
221 }
222 }
223 printk("\n");
224}
225
226static DEFINE_SPINLOCK(die_lock);
227
228void die(const char * str, struct pt_regs * regs, long err)
229{
230 console_verbose();
231 spin_lock_irq(&die_lock);
232 bust_spinlocks(1);
233 printk("%s: %04lx\n", str, err & 0xffff);
234 show_registers(regs);
235 bust_spinlocks(0);
236 spin_unlock_irq(&die_lock);
237 do_exit(SIGSEGV);
238}
239
240static __inline__ void die_if_kernel(const char * str,
241 struct pt_regs * regs, long err)
242{
243 if (!user_mode(regs))
244 die(str, regs, err);
245}
246
247static __inline__ void do_trap(int trapnr, int signr, const char * str,
248 struct pt_regs * regs, long error_code, siginfo_t *info)
249{
250 if (user_mode(regs)) {
251 /* trap_signal */
252 struct task_struct *tsk = current;
253 tsk->thread.error_code = error_code;
254 tsk->thread.trap_no = trapnr;
255 if (info)
256 force_sig_info(signr, info, tsk);
257 else
258 force_sig(signr, tsk);
259 return;
260 } else {
261 /* kernel_trap */
262 if (!fixup_exception(regs))
263 die(str, regs, error_code);
264 return;
265 }
266}
267
268#define DO_ERROR(trapnr, signr, str, name) \
269asmlinkage void do_##name(struct pt_regs * regs, long error_code) \
270{ \
271 do_trap(trapnr, signr, NULL, regs, error_code, NULL); \
272}
273
274#define DO_ERROR_INFO(trapnr, signr, str, name, sicode, siaddr) \
275asmlinkage void do_##name(struct pt_regs * regs, long error_code) \
276{ \
277 siginfo_t info; \
278 info.si_signo = signr; \
279 info.si_errno = 0; \
280 info.si_code = sicode; \
281 info.si_addr = (void __user *)siaddr; \
282 do_trap(trapnr, signr, str, regs, error_code, &info); \
283}
284
285DO_ERROR( 1, SIGTRAP, "debug trap", debug_trap)
286DO_ERROR_INFO(0x20, SIGILL, "reserved instruction ", rie_handler, ILL_ILLOPC, regs->bpc)
287DO_ERROR_INFO(0x100, SIGILL, "privileged instruction", pie_handler, ILL_PRVOPC, regs->bpc)
288DO_ERROR_INFO(-1, SIGILL, "illegal trap", ill_trap, ILL_ILLTRP, regs->bpc)
289
290extern int handle_unaligned_access(unsigned long, struct pt_regs *);
291
292/* This code taken from arch/sh/kernel/traps.c */
293asmlinkage void do_alignment_check(struct pt_regs *regs, long error_code)
294{
295 mm_segment_t oldfs;
296 unsigned long insn;
297 int tmp;
298
299 oldfs = get_fs();
300
301 if (user_mode(regs)) {
302 local_irq_enable();
303 current->thread.error_code = error_code;
304 current->thread.trap_no = 0x17;
305
306 set_fs(USER_DS);
307 if (copy_from_user(&insn, (void *)regs->bpc, 4)) {
308 set_fs(oldfs);
309 goto uspace_segv;
310 }
311 tmp = handle_unaligned_access(insn, regs);
312 set_fs(oldfs);
313
314 if (!tmp)
315 return;
316
317 uspace_segv:
318 printk(KERN_NOTICE "Killing process \"%s\" due to unaligned "
319 "access\n", current->comm);
320 force_sig(SIGSEGV, current);
321 } else {
322 set_fs(KERNEL_DS);
323 if (copy_from_user(&insn, (void *)regs->bpc, 4)) {
324 set_fs(oldfs);
325 die("insn faulting in do_address_error", regs, 0);
326 }
327 handle_unaligned_access(insn, regs);
328 set_fs(oldfs);
329 }
330}