Merge branch 'for-3.10-fixes' of git://git.kernel.org/pub/scm/linux/kernel/git/tj...
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / parisc / kernel / traps.c
1 /*
2 * linux/arch/parisc/traps.c
3 *
4 * Copyright (C) 1991, 1992 Linus Torvalds
5 * Copyright (C) 1999, 2000 Philipp Rumpf <prumpf@tux.org>
6 */
7
8 /*
9 * 'Traps.c' handles hardware traps and faults after we have saved some
10 * state in 'asm.s'.
11 */
12
13 #include <linux/sched.h>
14 #include <linux/kernel.h>
15 #include <linux/string.h>
16 #include <linux/errno.h>
17 #include <linux/ptrace.h>
18 #include <linux/timer.h>
19 #include <linux/delay.h>
20 #include <linux/mm.h>
21 #include <linux/module.h>
22 #include <linux/smp.h>
23 #include <linux/spinlock.h>
24 #include <linux/init.h>
25 #include <linux/interrupt.h>
26 #include <linux/console.h>
27 #include <linux/bug.h>
28
29 #include <asm/assembly.h>
30 #include <asm/uaccess.h>
31 #include <asm/io.h>
32 #include <asm/irq.h>
33 #include <asm/traps.h>
34 #include <asm/unaligned.h>
35 #include <linux/atomic.h>
36 #include <asm/smp.h>
37 #include <asm/pdc.h>
38 #include <asm/pdc_chassis.h>
39 #include <asm/unwind.h>
40 #include <asm/tlbflush.h>
41 #include <asm/cacheflush.h>
42
43 #include "../math-emu/math-emu.h" /* for handle_fpe() */
44
45 #define PRINT_USER_FAULTS /* (turn this on if you want user faults to be */
46 /* dumped to the console via printk) */
47
48 #if defined(CONFIG_SMP) || defined(CONFIG_DEBUG_SPINLOCK)
49 DEFINE_SPINLOCK(pa_dbit_lock);
50 #endif
51
52 static void parisc_show_stack(struct task_struct *task, unsigned long *sp,
53 struct pt_regs *regs);
54
55 static int printbinary(char *buf, unsigned long x, int nbits)
56 {
57 unsigned long mask = 1UL << (nbits - 1);
58 while (mask != 0) {
59 *buf++ = (mask & x ? '1' : '0');
60 mask >>= 1;
61 }
62 *buf = '\0';
63
64 return nbits;
65 }
66
67 #ifdef CONFIG_64BIT
68 #define RFMT "%016lx"
69 #else
70 #define RFMT "%08lx"
71 #endif
72 #define FFMT "%016llx" /* fpregs are 64-bit always */
73
74 #define PRINTREGS(lvl,r,f,fmt,x) \
75 printk("%s%s%02d-%02d " fmt " " fmt " " fmt " " fmt "\n", \
76 lvl, f, (x), (x+3), (r)[(x)+0], (r)[(x)+1], \
77 (r)[(x)+2], (r)[(x)+3])
78
79 static void print_gr(char *level, struct pt_regs *regs)
80 {
81 int i;
82 char buf[64];
83
84 printk("%s\n", level);
85 printk("%s YZrvWESTHLNXBCVMcbcbcbcbOGFRQPDI\n", level);
86 printbinary(buf, regs->gr[0], 32);
87 printk("%sPSW: %s %s\n", level, buf, print_tainted());
88
89 for (i = 0; i < 32; i += 4)
90 PRINTREGS(level, regs->gr, "r", RFMT, i);
91 }
92
93 static void print_fr(char *level, struct pt_regs *regs)
94 {
95 int i;
96 char buf[64];
97 struct { u32 sw[2]; } s;
98
99 /* FR are 64bit everywhere. Need to use asm to get the content
100 * of fpsr/fper1, and we assume that we won't have a FP Identify
101 * in our way, otherwise we're screwed.
102 * The fldd is used to restore the T-bit if there was one, as the
103 * store clears it anyway.
104 * PA2.0 book says "thou shall not use fstw on FPSR/FPERs" - T-Bone */
105 asm volatile ("fstd %%fr0,0(%1) \n\t"
106 "fldd 0(%1),%%fr0 \n\t"
107 : "=m" (s) : "r" (&s) : "r0");
108
109 printk("%s\n", level);
110 printk("%s VZOUICununcqcqcqcqcqcrmunTDVZOUI\n", level);
111 printbinary(buf, s.sw[0], 32);
112 printk("%sFPSR: %s\n", level, buf);
113 printk("%sFPER1: %08x\n", level, s.sw[1]);
114
115 /* here we'll print fr0 again, tho it'll be meaningless */
116 for (i = 0; i < 32; i += 4)
117 PRINTREGS(level, regs->fr, "fr", FFMT, i);
118 }
119
120 void show_regs(struct pt_regs *regs)
121 {
122 int i, user;
123 char *level;
124 unsigned long cr30, cr31;
125
126 user = user_mode(regs);
127 level = user ? KERN_DEBUG : KERN_CRIT;
128
129 show_regs_print_info(level);
130
131 print_gr(level, regs);
132
133 for (i = 0; i < 8; i += 4)
134 PRINTREGS(level, regs->sr, "sr", RFMT, i);
135
136 if (user)
137 print_fr(level, regs);
138
139 cr30 = mfctl(30);
140 cr31 = mfctl(31);
141 printk("%s\n", level);
142 printk("%sIASQ: " RFMT " " RFMT " IAOQ: " RFMT " " RFMT "\n",
143 level, regs->iasq[0], regs->iasq[1], regs->iaoq[0], regs->iaoq[1]);
144 printk("%s IIR: %08lx ISR: " RFMT " IOR: " RFMT "\n",
145 level, regs->iir, regs->isr, regs->ior);
146 printk("%s CPU: %8d CR30: " RFMT " CR31: " RFMT "\n",
147 level, current_thread_info()->cpu, cr30, cr31);
148 printk("%s ORIG_R28: " RFMT "\n", level, regs->orig_r28);
149
150 if (user) {
151 printk("%s IAOQ[0]: " RFMT "\n", level, regs->iaoq[0]);
152 printk("%s IAOQ[1]: " RFMT "\n", level, regs->iaoq[1]);
153 printk("%s RP(r2): " RFMT "\n", level, regs->gr[2]);
154 } else {
155 printk("%s IAOQ[0]: %pS\n", level, (void *) regs->iaoq[0]);
156 printk("%s IAOQ[1]: %pS\n", level, (void *) regs->iaoq[1]);
157 printk("%s RP(r2): %pS\n", level, (void *) regs->gr[2]);
158
159 parisc_show_stack(current, NULL, regs);
160 }
161 }
162
163 static void do_show_stack(struct unwind_frame_info *info)
164 {
165 int i = 1;
166
167 printk(KERN_CRIT "Backtrace:\n");
168 while (i <= 16) {
169 if (unwind_once(info) < 0 || info->ip == 0)
170 break;
171
172 if (__kernel_text_address(info->ip)) {
173 printk(KERN_CRIT " [<" RFMT ">] %pS\n",
174 info->ip, (void *) info->ip);
175 i++;
176 }
177 }
178 printk(KERN_CRIT "\n");
179 }
180
181 static void parisc_show_stack(struct task_struct *task, unsigned long *sp,
182 struct pt_regs *regs)
183 {
184 struct unwind_frame_info info;
185 struct task_struct *t;
186
187 t = task ? task : current;
188 if (regs) {
189 unwind_frame_init(&info, t, regs);
190 goto show_stack;
191 }
192
193 if (t == current) {
194 unsigned long sp;
195
196 HERE:
197 asm volatile ("copy %%r30, %0" : "=r"(sp));
198 {
199 struct pt_regs r;
200
201 memset(&r, 0, sizeof(struct pt_regs));
202 r.iaoq[0] = (unsigned long)&&HERE;
203 r.gr[2] = (unsigned long)__builtin_return_address(0);
204 r.gr[30] = sp;
205
206 unwind_frame_init(&info, current, &r);
207 }
208 } else {
209 unwind_frame_init_from_blocked_task(&info, t);
210 }
211
212 show_stack:
213 do_show_stack(&info);
214 }
215
216 void show_stack(struct task_struct *t, unsigned long *sp)
217 {
218 return parisc_show_stack(t, sp, NULL);
219 }
220
221 int is_valid_bugaddr(unsigned long iaoq)
222 {
223 return 1;
224 }
225
226 void die_if_kernel(char *str, struct pt_regs *regs, long err)
227 {
228 if (user_mode(regs)) {
229 if (err == 0)
230 return; /* STFU */
231
232 printk(KERN_CRIT "%s (pid %d): %s (code %ld) at " RFMT "\n",
233 current->comm, task_pid_nr(current), str, err, regs->iaoq[0]);
234 #ifdef PRINT_USER_FAULTS
235 /* XXX for debugging only */
236 show_regs(regs);
237 #endif
238 return;
239 }
240
241 oops_in_progress = 1;
242
243 oops_enter();
244
245 /* Amuse the user in a SPARC fashion */
246 if (err) printk(KERN_CRIT
247 " _______________________________ \n"
248 " < Your System ate a SPARC! Gah! >\n"
249 " ------------------------------- \n"
250 " \\ ^__^\n"
251 " (__)\\ )\\/\\\n"
252 " U ||----w |\n"
253 " || ||\n");
254
255 /* unlock the pdc lock if necessary */
256 pdc_emergency_unlock();
257
258 /* maybe the kernel hasn't booted very far yet and hasn't been able
259 * to initialize the serial or STI console. In that case we should
260 * re-enable the pdc console, so that the user will be able to
261 * identify the problem. */
262 if (!console_drivers)
263 pdc_console_restart();
264
265 if (err)
266 printk(KERN_CRIT "%s (pid %d): %s (code %ld)\n",
267 current->comm, task_pid_nr(current), str, err);
268
269 /* Wot's wrong wif bein' racy? */
270 if (current->thread.flags & PARISC_KERNEL_DEATH) {
271 printk(KERN_CRIT "%s() recursion detected.\n", __func__);
272 local_irq_enable();
273 while (1);
274 }
275 current->thread.flags |= PARISC_KERNEL_DEATH;
276
277 show_regs(regs);
278 dump_stack();
279 add_taint(TAINT_DIE, LOCKDEP_NOW_UNRELIABLE);
280
281 if (in_interrupt())
282 panic("Fatal exception in interrupt");
283
284 if (panic_on_oops) {
285 printk(KERN_EMERG "Fatal exception: panic in 5 seconds\n");
286 ssleep(5);
287 panic("Fatal exception");
288 }
289
290 oops_exit();
291 do_exit(SIGSEGV);
292 }
293
294 int syscall_ipi(int (*syscall) (struct pt_regs *), struct pt_regs *regs)
295 {
296 return syscall(regs);
297 }
298
299 /* gdb uses break 4,8 */
300 #define GDB_BREAK_INSN 0x10004
301 static void handle_gdb_break(struct pt_regs *regs, int wot)
302 {
303 struct siginfo si;
304
305 si.si_signo = SIGTRAP;
306 si.si_errno = 0;
307 si.si_code = wot;
308 si.si_addr = (void __user *) (regs->iaoq[0] & ~3);
309 force_sig_info(SIGTRAP, &si, current);
310 }
311
312 static void handle_break(struct pt_regs *regs)
313 {
314 unsigned iir = regs->iir;
315
316 if (unlikely(iir == PARISC_BUG_BREAK_INSN && !user_mode(regs))) {
317 /* check if a BUG() or WARN() trapped here. */
318 enum bug_trap_type tt;
319 tt = report_bug(regs->iaoq[0] & ~3, regs);
320 if (tt == BUG_TRAP_TYPE_WARN) {
321 regs->iaoq[0] += 4;
322 regs->iaoq[1] += 4;
323 return; /* return to next instruction when WARN_ON(). */
324 }
325 die_if_kernel("Unknown kernel breakpoint", regs,
326 (tt == BUG_TRAP_TYPE_NONE) ? 9 : 0);
327 }
328
329 #ifdef PRINT_USER_FAULTS
330 if (unlikely(iir != GDB_BREAK_INSN)) {
331 printk(KERN_DEBUG "break %d,%d: pid=%d command='%s'\n",
332 iir & 31, (iir>>13) & ((1<<13)-1),
333 task_pid_nr(current), current->comm);
334 show_regs(regs);
335 }
336 #endif
337
338 /* send standard GDB signal */
339 handle_gdb_break(regs, TRAP_BRKPT);
340 }
341
342 static void default_trap(int code, struct pt_regs *regs)
343 {
344 printk(KERN_ERR "Trap %d on CPU %d\n", code, smp_processor_id());
345 show_regs(regs);
346 }
347
348 void (*cpu_lpmc) (int code, struct pt_regs *regs) __read_mostly = default_trap;
349
350
351 void transfer_pim_to_trap_frame(struct pt_regs *regs)
352 {
353 register int i;
354 extern unsigned int hpmc_pim_data[];
355 struct pdc_hpmc_pim_11 *pim_narrow;
356 struct pdc_hpmc_pim_20 *pim_wide;
357
358 if (boot_cpu_data.cpu_type >= pcxu) {
359
360 pim_wide = (struct pdc_hpmc_pim_20 *)hpmc_pim_data;
361
362 /*
363 * Note: The following code will probably generate a
364 * bunch of truncation error warnings from the compiler.
365 * Could be handled with an ifdef, but perhaps there
366 * is a better way.
367 */
368
369 regs->gr[0] = pim_wide->cr[22];
370
371 for (i = 1; i < 32; i++)
372 regs->gr[i] = pim_wide->gr[i];
373
374 for (i = 0; i < 32; i++)
375 regs->fr[i] = pim_wide->fr[i];
376
377 for (i = 0; i < 8; i++)
378 regs->sr[i] = pim_wide->sr[i];
379
380 regs->iasq[0] = pim_wide->cr[17];
381 regs->iasq[1] = pim_wide->iasq_back;
382 regs->iaoq[0] = pim_wide->cr[18];
383 regs->iaoq[1] = pim_wide->iaoq_back;
384
385 regs->sar = pim_wide->cr[11];
386 regs->iir = pim_wide->cr[19];
387 regs->isr = pim_wide->cr[20];
388 regs->ior = pim_wide->cr[21];
389 }
390 else {
391 pim_narrow = (struct pdc_hpmc_pim_11 *)hpmc_pim_data;
392
393 regs->gr[0] = pim_narrow->cr[22];
394
395 for (i = 1; i < 32; i++)
396 regs->gr[i] = pim_narrow->gr[i];
397
398 for (i = 0; i < 32; i++)
399 regs->fr[i] = pim_narrow->fr[i];
400
401 for (i = 0; i < 8; i++)
402 regs->sr[i] = pim_narrow->sr[i];
403
404 regs->iasq[0] = pim_narrow->cr[17];
405 regs->iasq[1] = pim_narrow->iasq_back;
406 regs->iaoq[0] = pim_narrow->cr[18];
407 regs->iaoq[1] = pim_narrow->iaoq_back;
408
409 regs->sar = pim_narrow->cr[11];
410 regs->iir = pim_narrow->cr[19];
411 regs->isr = pim_narrow->cr[20];
412 regs->ior = pim_narrow->cr[21];
413 }
414
415 /*
416 * The following fields only have meaning if we came through
417 * another path. So just zero them here.
418 */
419
420 regs->ksp = 0;
421 regs->kpc = 0;
422 regs->orig_r28 = 0;
423 }
424
425
426 /*
427 * This routine is called as a last resort when everything else
428 * has gone clearly wrong. We get called for faults in kernel space,
429 * and HPMC's.
430 */
431 void parisc_terminate(char *msg, struct pt_regs *regs, int code, unsigned long offset)
432 {
433 static DEFINE_SPINLOCK(terminate_lock);
434
435 oops_in_progress = 1;
436
437 set_eiem(0);
438 local_irq_disable();
439 spin_lock(&terminate_lock);
440
441 /* unlock the pdc lock if necessary */
442 pdc_emergency_unlock();
443
444 /* restart pdc console if necessary */
445 if (!console_drivers)
446 pdc_console_restart();
447
448 /* Not all paths will gutter the processor... */
449 switch(code){
450
451 case 1:
452 transfer_pim_to_trap_frame(regs);
453 break;
454
455 default:
456 /* Fall through */
457 break;
458
459 }
460
461 {
462 /* show_stack(NULL, (unsigned long *)regs->gr[30]); */
463 struct unwind_frame_info info;
464 unwind_frame_init(&info, current, regs);
465 do_show_stack(&info);
466 }
467
468 printk("\n");
469 printk(KERN_CRIT "%s: Code=%d regs=%p (Addr=" RFMT ")\n",
470 msg, code, regs, offset);
471 show_regs(regs);
472
473 spin_unlock(&terminate_lock);
474
475 /* put soft power button back under hardware control;
476 * if the user had pressed it once at any time, the
477 * system will shut down immediately right here. */
478 pdc_soft_power_button(0);
479
480 /* Call kernel panic() so reboot timeouts work properly
481 * FIXME: This function should be on the list of
482 * panic notifiers, and we should call panic
483 * directly from the location that we wish.
484 * e.g. We should not call panic from
485 * parisc_terminate, but rather the oter way around.
486 * This hack works, prints the panic message twice,
487 * and it enables reboot timers!
488 */
489 panic(msg);
490 }
491
492 void notrace handle_interruption(int code, struct pt_regs *regs)
493 {
494 unsigned long fault_address = 0;
495 unsigned long fault_space = 0;
496 struct siginfo si;
497
498 if (code == 1)
499 pdc_console_restart(); /* switch back to pdc if HPMC */
500 else
501 local_irq_enable();
502
503 /* Security check:
504 * If the priority level is still user, and the
505 * faulting space is not equal to the active space
506 * then the user is attempting something in a space
507 * that does not belong to them. Kill the process.
508 *
509 * This is normally the situation when the user
510 * attempts to jump into the kernel space at the
511 * wrong offset, be it at the gateway page or a
512 * random location.
513 *
514 * We cannot normally signal the process because it
515 * could *be* on the gateway page, and processes
516 * executing on the gateway page can't have signals
517 * delivered.
518 *
519 * We merely readjust the address into the users
520 * space, at a destination address of zero, and
521 * allow processing to continue.
522 */
523 if (((unsigned long)regs->iaoq[0] & 3) &&
524 ((unsigned long)regs->iasq[0] != (unsigned long)regs->sr[7])) {
525 /* Kill the user process later */
526 regs->iaoq[0] = 0 | 3;
527 regs->iaoq[1] = regs->iaoq[0] + 4;
528 regs->iasq[0] = regs->iasq[1] = regs->sr[7];
529 regs->gr[0] &= ~PSW_B;
530 return;
531 }
532
533 #if 0
534 printk(KERN_CRIT "Interruption # %d\n", code);
535 #endif
536
537 switch(code) {
538
539 case 1:
540 /* High-priority machine check (HPMC) */
541
542 /* set up a new led state on systems shipped with a LED State panel */
543 pdc_chassis_send_status(PDC_CHASSIS_DIRECT_HPMC);
544
545 parisc_terminate("High Priority Machine Check (HPMC)",
546 regs, code, 0);
547 /* NOT REACHED */
548
549 case 2:
550 /* Power failure interrupt */
551 printk(KERN_CRIT "Power failure interrupt !\n");
552 return;
553
554 case 3:
555 /* Recovery counter trap */
556 regs->gr[0] &= ~PSW_R;
557 if (user_space(regs))
558 handle_gdb_break(regs, TRAP_TRACE);
559 /* else this must be the start of a syscall - just let it run */
560 return;
561
562 case 5:
563 /* Low-priority machine check */
564 pdc_chassis_send_status(PDC_CHASSIS_DIRECT_LPMC);
565
566 flush_cache_all();
567 flush_tlb_all();
568 cpu_lpmc(5, regs);
569 return;
570
571 case 6:
572 /* Instruction TLB miss fault/Instruction page fault */
573 fault_address = regs->iaoq[0];
574 fault_space = regs->iasq[0];
575 break;
576
577 case 8:
578 /* Illegal instruction trap */
579 die_if_kernel("Illegal instruction", regs, code);
580 si.si_code = ILL_ILLOPC;
581 goto give_sigill;
582
583 case 9:
584 /* Break instruction trap */
585 handle_break(regs);
586 return;
587
588 case 10:
589 /* Privileged operation trap */
590 die_if_kernel("Privileged operation", regs, code);
591 si.si_code = ILL_PRVOPC;
592 goto give_sigill;
593
594 case 11:
595 /* Privileged register trap */
596 if ((regs->iir & 0xffdfffe0) == 0x034008a0) {
597
598 /* This is a MFCTL cr26/cr27 to gr instruction.
599 * PCXS traps on this, so we need to emulate it.
600 */
601
602 if (regs->iir & 0x00200000)
603 regs->gr[regs->iir & 0x1f] = mfctl(27);
604 else
605 regs->gr[regs->iir & 0x1f] = mfctl(26);
606
607 regs->iaoq[0] = regs->iaoq[1];
608 regs->iaoq[1] += 4;
609 regs->iasq[0] = regs->iasq[1];
610 return;
611 }
612
613 die_if_kernel("Privileged register usage", regs, code);
614 si.si_code = ILL_PRVREG;
615 give_sigill:
616 si.si_signo = SIGILL;
617 si.si_errno = 0;
618 si.si_addr = (void __user *) regs->iaoq[0];
619 force_sig_info(SIGILL, &si, current);
620 return;
621
622 case 12:
623 /* Overflow Trap, let the userland signal handler do the cleanup */
624 si.si_signo = SIGFPE;
625 si.si_code = FPE_INTOVF;
626 si.si_addr = (void __user *) regs->iaoq[0];
627 force_sig_info(SIGFPE, &si, current);
628 return;
629
630 case 13:
631 /* Conditional Trap
632 The condition succeeds in an instruction which traps
633 on condition */
634 if(user_mode(regs)){
635 si.si_signo = SIGFPE;
636 /* Set to zero, and let the userspace app figure it out from
637 the insn pointed to by si_addr */
638 si.si_code = 0;
639 si.si_addr = (void __user *) regs->iaoq[0];
640 force_sig_info(SIGFPE, &si, current);
641 return;
642 }
643 /* The kernel doesn't want to handle condition codes */
644 break;
645
646 case 14:
647 /* Assist Exception Trap, i.e. floating point exception. */
648 die_if_kernel("Floating point exception", regs, 0); /* quiet */
649 __inc_irq_stat(irq_fpassist_count);
650 handle_fpe(regs);
651 return;
652
653 case 15:
654 /* Data TLB miss fault/Data page fault */
655 /* Fall through */
656 case 16:
657 /* Non-access instruction TLB miss fault */
658 /* The instruction TLB entry needed for the target address of the FIC
659 is absent, and hardware can't find it, so we get to cleanup */
660 /* Fall through */
661 case 17:
662 /* Non-access data TLB miss fault/Non-access data page fault */
663 /* FIXME:
664 Still need to add slow path emulation code here!
665 If the insn used a non-shadow register, then the tlb
666 handlers could not have their side-effect (e.g. probe
667 writing to a target register) emulated since rfir would
668 erase the changes to said register. Instead we have to
669 setup everything, call this function we are in, and emulate
670 by hand. Technically we need to emulate:
671 fdc,fdce,pdc,"fic,4f",prober,probeir,probew, probeiw
672 */
673 fault_address = regs->ior;
674 fault_space = regs->isr;
675 break;
676
677 case 18:
678 /* PCXS only -- later cpu's split this into types 26,27 & 28 */
679 /* Check for unaligned access */
680 if (check_unaligned(regs)) {
681 handle_unaligned(regs);
682 return;
683 }
684 /* Fall Through */
685 case 26:
686 /* PCXL: Data memory access rights trap */
687 fault_address = regs->ior;
688 fault_space = regs->isr;
689 break;
690
691 case 19:
692 /* Data memory break trap */
693 regs->gr[0] |= PSW_X; /* So we can single-step over the trap */
694 /* fall thru */
695 case 21:
696 /* Page reference trap */
697 handle_gdb_break(regs, TRAP_HWBKPT);
698 return;
699
700 case 25:
701 /* Taken branch trap */
702 regs->gr[0] &= ~PSW_T;
703 if (user_space(regs))
704 handle_gdb_break(regs, TRAP_BRANCH);
705 /* else this must be the start of a syscall - just let it
706 * run.
707 */
708 return;
709
710 case 7:
711 /* Instruction access rights */
712 /* PCXL: Instruction memory protection trap */
713
714 /*
715 * This could be caused by either: 1) a process attempting
716 * to execute within a vma that does not have execute
717 * permission, or 2) an access rights violation caused by a
718 * flush only translation set up by ptep_get_and_clear().
719 * So we check the vma permissions to differentiate the two.
720 * If the vma indicates we have execute permission, then
721 * the cause is the latter one. In this case, we need to
722 * call do_page_fault() to fix the problem.
723 */
724
725 if (user_mode(regs)) {
726 struct vm_area_struct *vma;
727
728 down_read(&current->mm->mmap_sem);
729 vma = find_vma(current->mm,regs->iaoq[0]);
730 if (vma && (regs->iaoq[0] >= vma->vm_start)
731 && (vma->vm_flags & VM_EXEC)) {
732
733 fault_address = regs->iaoq[0];
734 fault_space = regs->iasq[0];
735
736 up_read(&current->mm->mmap_sem);
737 break; /* call do_page_fault() */
738 }
739 up_read(&current->mm->mmap_sem);
740 }
741 /* Fall Through */
742 case 27:
743 /* Data memory protection ID trap */
744 if (code == 27 && !user_mode(regs) &&
745 fixup_exception(regs))
746 return;
747
748 die_if_kernel("Protection id trap", regs, code);
749 si.si_code = SEGV_MAPERR;
750 si.si_signo = SIGSEGV;
751 si.si_errno = 0;
752 if (code == 7)
753 si.si_addr = (void __user *) regs->iaoq[0];
754 else
755 si.si_addr = (void __user *) regs->ior;
756 force_sig_info(SIGSEGV, &si, current);
757 return;
758
759 case 28:
760 /* Unaligned data reference trap */
761 handle_unaligned(regs);
762 return;
763
764 default:
765 if (user_mode(regs)) {
766 #ifdef PRINT_USER_FAULTS
767 printk(KERN_DEBUG "\nhandle_interruption() pid=%d command='%s'\n",
768 task_pid_nr(current), current->comm);
769 show_regs(regs);
770 #endif
771 /* SIGBUS, for lack of a better one. */
772 si.si_signo = SIGBUS;
773 si.si_code = BUS_OBJERR;
774 si.si_errno = 0;
775 si.si_addr = (void __user *) regs->ior;
776 force_sig_info(SIGBUS, &si, current);
777 return;
778 }
779 pdc_chassis_send_status(PDC_CHASSIS_DIRECT_PANIC);
780
781 parisc_terminate("Unexpected interruption", regs, code, 0);
782 /* NOT REACHED */
783 }
784
785 if (user_mode(regs)) {
786 if ((fault_space >> SPACEID_SHIFT) != (regs->sr[7] >> SPACEID_SHIFT)) {
787 #ifdef PRINT_USER_FAULTS
788 if (fault_space == 0)
789 printk(KERN_DEBUG "User Fault on Kernel Space ");
790 else
791 printk(KERN_DEBUG "User Fault (long pointer) (fault %d) ",
792 code);
793 printk(KERN_CONT "pid=%d command='%s'\n",
794 task_pid_nr(current), current->comm);
795 show_regs(regs);
796 #endif
797 si.si_signo = SIGSEGV;
798 si.si_errno = 0;
799 si.si_code = SEGV_MAPERR;
800 si.si_addr = (void __user *) regs->ior;
801 force_sig_info(SIGSEGV, &si, current);
802 return;
803 }
804 }
805 else {
806
807 /*
808 * The kernel should never fault on its own address space.
809 */
810
811 if (fault_space == 0)
812 {
813 pdc_chassis_send_status(PDC_CHASSIS_DIRECT_PANIC);
814 parisc_terminate("Kernel Fault", regs, code, fault_address);
815
816 }
817 }
818
819 do_page_fault(regs, code, fault_address);
820 }
821
822
823 int __init check_ivt(void *iva)
824 {
825 extern u32 os_hpmc_size;
826 extern const u32 os_hpmc[];
827
828 int i;
829 u32 check = 0;
830 u32 *ivap;
831 u32 *hpmcp;
832 u32 length;
833
834 if (strcmp((char *)iva, "cows can fly"))
835 return -1;
836
837 ivap = (u32 *)iva;
838
839 for (i = 0; i < 8; i++)
840 *ivap++ = 0;
841
842 /* Compute Checksum for HPMC handler */
843 length = os_hpmc_size;
844 ivap[7] = length;
845
846 hpmcp = (u32 *)os_hpmc;
847
848 for (i=0; i<length/4; i++)
849 check += *hpmcp++;
850
851 for (i=0; i<8; i++)
852 check += ivap[i];
853
854 ivap[5] = -check;
855
856 return 0;
857 }
858
859 #ifndef CONFIG_64BIT
860 extern const void fault_vector_11;
861 #endif
862 extern const void fault_vector_20;
863
864 void __init trap_init(void)
865 {
866 void *iva;
867
868 if (boot_cpu_data.cpu_type >= pcxu)
869 iva = (void *) &fault_vector_20;
870 else
871 #ifdef CONFIG_64BIT
872 panic("Can't boot 64-bit OS on PA1.1 processor!");
873 #else
874 iva = (void *) &fault_vector_11;
875 #endif
876
877 if (check_ivt(iva))
878 panic("IVT invalid");
879 }