firewire: nosy: fix device shutdown with active client
[firewire-audio.git] / arch / alpha / kernel / traps.c
blobb14f015008ada5e90d580b0589d4ff5144a1602e
1 /*
2 * arch/alpha/kernel/traps.c
4 * (C) Copyright 1994 Linus Torvalds
5 */
7 /*
8 * This file initializes the trap entry points
9 */
11 #include <linux/jiffies.h>
12 #include <linux/mm.h>
13 #include <linux/sched.h>
14 #include <linux/tty.h>
15 #include <linux/delay.h>
16 #include <linux/smp_lock.h>
17 #include <linux/module.h>
18 #include <linux/init.h>
19 #include <linux/kallsyms.h>
20 #include <linux/ratelimit.h>
22 #include <asm/gentrap.h>
23 #include <asm/uaccess.h>
24 #include <asm/unaligned.h>
25 #include <asm/sysinfo.h>
26 #include <asm/hwrpb.h>
27 #include <asm/mmu_context.h>
29 #include "proto.h"
31 /* Work-around for some SRMs which mishandle opDEC faults. */
33 static int opDEC_fix;
35 static void __cpuinit
36 opDEC_check(void)
38 __asm__ __volatile__ (
39 /* Load the address of... */
40 " br $16, 1f\n"
41 /* A stub instruction fault handler. Just add 4 to the
42 pc and continue. */
43 " ldq $16, 8($sp)\n"
44 " addq $16, 4, $16\n"
45 " stq $16, 8($sp)\n"
46 " call_pal %[rti]\n"
47 /* Install the instruction fault handler. */
48 "1: lda $17, 3\n"
49 " call_pal %[wrent]\n"
50 /* With that in place, the fault from the round-to-minf fp
51 insn will arrive either at the "lda 4" insn (bad) or one
52 past that (good). This places the correct fixup in %0. */
53 " lda %[fix], 0\n"
54 " cvttq/svm $f31,$f31\n"
55 " lda %[fix], 4"
56 : [fix] "=r" (opDEC_fix)
57 : [rti] "n" (PAL_rti), [wrent] "n" (PAL_wrent)
58 : "$0", "$1", "$16", "$17", "$22", "$23", "$24", "$25");
60 if (opDEC_fix)
61 printk("opDEC fixup enabled.\n");
64 void
65 dik_show_regs(struct pt_regs *regs, unsigned long *r9_15)
67 printk("pc = [<%016lx>] ra = [<%016lx>] ps = %04lx %s\n",
68 regs->pc, regs->r26, regs->ps, print_tainted());
69 print_symbol("pc is at %s\n", regs->pc);
70 print_symbol("ra is at %s\n", regs->r26 );
71 printk("v0 = %016lx t0 = %016lx t1 = %016lx\n",
72 regs->r0, regs->r1, regs->r2);
73 printk("t2 = %016lx t3 = %016lx t4 = %016lx\n",
74 regs->r3, regs->r4, regs->r5);
75 printk("t5 = %016lx t6 = %016lx t7 = %016lx\n",
76 regs->r6, regs->r7, regs->r8);
78 if (r9_15) {
79 printk("s0 = %016lx s1 = %016lx s2 = %016lx\n",
80 r9_15[9], r9_15[10], r9_15[11]);
81 printk("s3 = %016lx s4 = %016lx s5 = %016lx\n",
82 r9_15[12], r9_15[13], r9_15[14]);
83 printk("s6 = %016lx\n", r9_15[15]);
86 printk("a0 = %016lx a1 = %016lx a2 = %016lx\n",
87 regs->r16, regs->r17, regs->r18);
88 printk("a3 = %016lx a4 = %016lx a5 = %016lx\n",
89 regs->r19, regs->r20, regs->r21);
90 printk("t8 = %016lx t9 = %016lx t10= %016lx\n",
91 regs->r22, regs->r23, regs->r24);
92 printk("t11= %016lx pv = %016lx at = %016lx\n",
93 regs->r25, regs->r27, regs->r28);
94 printk("gp = %016lx sp = %p\n", regs->gp, regs+1);
95 #if 0
96 __halt();
97 #endif
100 #if 0
101 static char * ireg_name[] = {"v0", "t0", "t1", "t2", "t3", "t4", "t5", "t6",
102 "t7", "s0", "s1", "s2", "s3", "s4", "s5", "s6",
103 "a0", "a1", "a2", "a3", "a4", "a5", "t8", "t9",
104 "t10", "t11", "ra", "pv", "at", "gp", "sp", "zero"};
105 #endif
107 static void
108 dik_show_code(unsigned int *pc)
110 long i;
112 printk("Code:");
113 for (i = -6; i < 2; i++) {
114 unsigned int insn;
115 if (__get_user(insn, (unsigned int __user *)pc + i))
116 break;
117 printk("%c%08x%c", i ? ' ' : '<', insn, i ? ' ' : '>');
119 printk("\n");
122 static void
123 dik_show_trace(unsigned long *sp)
125 long i = 0;
126 printk("Trace:\n");
127 while (0x1ff8 & (unsigned long) sp) {
128 extern char _stext[], _etext[];
129 unsigned long tmp = *sp;
130 sp++;
131 if (tmp < (unsigned long) &_stext)
132 continue;
133 if (tmp >= (unsigned long) &_etext)
134 continue;
135 printk("[<%lx>]", tmp);
136 print_symbol(" %s", tmp);
137 printk("\n");
138 if (i > 40) {
139 printk(" ...");
140 break;
143 printk("\n");
146 static int kstack_depth_to_print = 24;
148 void show_stack(struct task_struct *task, unsigned long *sp)
150 unsigned long *stack;
151 int i;
154 * debugging aid: "show_stack(NULL);" prints the
155 * back trace for this cpu.
157 if(sp==NULL)
158 sp=(unsigned long*)&sp;
160 stack = sp;
161 for(i=0; i < kstack_depth_to_print; i++) {
162 if (((long) stack & (THREAD_SIZE-1)) == 0)
163 break;
164 if (i && ((i % 4) == 0))
165 printk("\n ");
166 printk("%016lx ", *stack++);
168 printk("\n");
169 dik_show_trace(sp);
172 void dump_stack(void)
174 show_stack(NULL, NULL);
177 EXPORT_SYMBOL(dump_stack);
179 void
180 die_if_kernel(char * str, struct pt_regs *regs, long err, unsigned long *r9_15)
182 if (regs->ps & 8)
183 return;
184 #ifdef CONFIG_SMP
185 printk("CPU %d ", hard_smp_processor_id());
186 #endif
187 printk("%s(%d): %s %ld\n", current->comm, task_pid_nr(current), str, err);
188 dik_show_regs(regs, r9_15);
189 add_taint(TAINT_DIE);
190 dik_show_trace((unsigned long *)(regs+1));
191 dik_show_code((unsigned int *)regs->pc);
193 if (test_and_set_thread_flag (TIF_DIE_IF_KERNEL)) {
194 printk("die_if_kernel recursion detected.\n");
195 local_irq_enable();
196 while (1);
198 do_exit(SIGSEGV);
201 #ifndef CONFIG_MATHEMU
202 static long dummy_emul(void) { return 0; }
203 long (*alpha_fp_emul_imprecise)(struct pt_regs *regs, unsigned long writemask)
204 = (void *)dummy_emul;
205 long (*alpha_fp_emul) (unsigned long pc)
206 = (void *)dummy_emul;
207 #else
208 long alpha_fp_emul_imprecise(struct pt_regs *regs, unsigned long writemask);
209 long alpha_fp_emul (unsigned long pc);
210 #endif
212 asmlinkage void
213 do_entArith(unsigned long summary, unsigned long write_mask,
214 struct pt_regs *regs)
216 long si_code = FPE_FLTINV;
217 siginfo_t info;
219 if (summary & 1) {
220 /* Software-completion summary bit is set, so try to
221 emulate the instruction. If the processor supports
222 precise exceptions, we don't have to search. */
223 if (!amask(AMASK_PRECISE_TRAP))
224 si_code = alpha_fp_emul(regs->pc - 4);
225 else
226 si_code = alpha_fp_emul_imprecise(regs, write_mask);
227 if (si_code == 0)
228 return;
230 die_if_kernel("Arithmetic fault", regs, 0, NULL);
232 info.si_signo = SIGFPE;
233 info.si_errno = 0;
234 info.si_code = si_code;
235 info.si_addr = (void __user *) regs->pc;
236 send_sig_info(SIGFPE, &info, current);
239 asmlinkage void
240 do_entIF(unsigned long type, struct pt_regs *regs)
242 siginfo_t info;
243 int signo, code;
245 if ((regs->ps & ~IPL_MAX) == 0) {
246 if (type == 1) {
247 const unsigned int *data
248 = (const unsigned int *) regs->pc;
249 printk("Kernel bug at %s:%d\n",
250 (const char *)(data[1] | (long)data[2] << 32),
251 data[0]);
253 die_if_kernel((type == 1 ? "Kernel Bug" : "Instruction fault"),
254 regs, type, NULL);
257 switch (type) {
258 case 0: /* breakpoint */
259 info.si_signo = SIGTRAP;
260 info.si_errno = 0;
261 info.si_code = TRAP_BRKPT;
262 info.si_trapno = 0;
263 info.si_addr = (void __user *) regs->pc;
265 if (ptrace_cancel_bpt(current)) {
266 regs->pc -= 4; /* make pc point to former bpt */
269 send_sig_info(SIGTRAP, &info, current);
270 return;
272 case 1: /* bugcheck */
273 info.si_signo = SIGTRAP;
274 info.si_errno = 0;
275 info.si_code = __SI_FAULT;
276 info.si_addr = (void __user *) regs->pc;
277 info.si_trapno = 0;
278 send_sig_info(SIGTRAP, &info, current);
279 return;
281 case 2: /* gentrap */
282 info.si_addr = (void __user *) regs->pc;
283 info.si_trapno = regs->r16;
284 switch ((long) regs->r16) {
285 case GEN_INTOVF:
286 signo = SIGFPE;
287 code = FPE_INTOVF;
288 break;
289 case GEN_INTDIV:
290 signo = SIGFPE;
291 code = FPE_INTDIV;
292 break;
293 case GEN_FLTOVF:
294 signo = SIGFPE;
295 code = FPE_FLTOVF;
296 break;
297 case GEN_FLTDIV:
298 signo = SIGFPE;
299 code = FPE_FLTDIV;
300 break;
301 case GEN_FLTUND:
302 signo = SIGFPE;
303 code = FPE_FLTUND;
304 break;
305 case GEN_FLTINV:
306 signo = SIGFPE;
307 code = FPE_FLTINV;
308 break;
309 case GEN_FLTINE:
310 signo = SIGFPE;
311 code = FPE_FLTRES;
312 break;
313 case GEN_ROPRAND:
314 signo = SIGFPE;
315 code = __SI_FAULT;
316 break;
318 case GEN_DECOVF:
319 case GEN_DECDIV:
320 case GEN_DECINV:
321 case GEN_ASSERTERR:
322 case GEN_NULPTRERR:
323 case GEN_STKOVF:
324 case GEN_STRLENERR:
325 case GEN_SUBSTRERR:
326 case GEN_RANGERR:
327 case GEN_SUBRNG:
328 case GEN_SUBRNG1:
329 case GEN_SUBRNG2:
330 case GEN_SUBRNG3:
331 case GEN_SUBRNG4:
332 case GEN_SUBRNG5:
333 case GEN_SUBRNG6:
334 case GEN_SUBRNG7:
335 default:
336 signo = SIGTRAP;
337 code = __SI_FAULT;
338 break;
341 info.si_signo = signo;
342 info.si_errno = 0;
343 info.si_code = code;
344 info.si_addr = (void __user *) regs->pc;
345 send_sig_info(signo, &info, current);
346 return;
348 case 4: /* opDEC */
349 if (implver() == IMPLVER_EV4) {
350 long si_code;
352 /* The some versions of SRM do not handle
353 the opDEC properly - they return the PC of the
354 opDEC fault, not the instruction after as the
355 Alpha architecture requires. Here we fix it up.
356 We do this by intentionally causing an opDEC
357 fault during the boot sequence and testing if
358 we get the correct PC. If not, we set a flag
359 to correct it every time through. */
360 regs->pc += opDEC_fix;
362 /* EV4 does not implement anything except normal
363 rounding. Everything else will come here as
364 an illegal instruction. Emulate them. */
365 si_code = alpha_fp_emul(regs->pc - 4);
366 if (si_code == 0)
367 return;
368 if (si_code > 0) {
369 info.si_signo = SIGFPE;
370 info.si_errno = 0;
371 info.si_code = si_code;
372 info.si_addr = (void __user *) regs->pc;
373 send_sig_info(SIGFPE, &info, current);
374 return;
377 break;
379 case 3: /* FEN fault */
380 /* Irritating users can call PAL_clrfen to disable the
381 FPU for the process. The kernel will then trap in
382 do_switch_stack and undo_switch_stack when we try
383 to save and restore the FP registers.
385 Given that GCC by default generates code that uses the
386 FP registers, PAL_clrfen is not useful except for DoS
387 attacks. So turn the bleeding FPU back on and be done
388 with it. */
389 current_thread_info()->pcb.flags |= 1;
390 __reload_thread(&current_thread_info()->pcb);
391 return;
393 case 5: /* illoc */
394 default: /* unexpected instruction-fault type */
398 info.si_signo = SIGILL;
399 info.si_errno = 0;
400 info.si_code = ILL_ILLOPC;
401 info.si_addr = (void __user *) regs->pc;
402 send_sig_info(SIGILL, &info, current);
405 /* There is an ifdef in the PALcode in MILO that enables a
406 "kernel debugging entry point" as an unprivileged call_pal.
408 We don't want to have anything to do with it, but unfortunately
409 several versions of MILO included in distributions have it enabled,
410 and if we don't put something on the entry point we'll oops. */
412 asmlinkage void
413 do_entDbg(struct pt_regs *regs)
415 siginfo_t info;
417 die_if_kernel("Instruction fault", regs, 0, NULL);
419 info.si_signo = SIGILL;
420 info.si_errno = 0;
421 info.si_code = ILL_ILLOPC;
422 info.si_addr = (void __user *) regs->pc;
423 force_sig_info(SIGILL, &info, current);
428 * entUna has a different register layout to be reasonably simple. It
429 * needs access to all the integer registers (the kernel doesn't use
430 * fp-regs), and it needs to have them in order for simpler access.
432 * Due to the non-standard register layout (and because we don't want
433 * to handle floating-point regs), user-mode unaligned accesses are
434 * handled separately by do_entUnaUser below.
436 * Oh, btw, we don't handle the "gp" register correctly, but if we fault
437 * on a gp-register unaligned load/store, something is _very_ wrong
438 * in the kernel anyway..
440 struct allregs {
441 unsigned long regs[32];
442 unsigned long ps, pc, gp, a0, a1, a2;
445 struct unaligned_stat {
446 unsigned long count, va, pc;
447 } unaligned[2];
450 /* Macro for exception fixup code to access integer registers. */
451 #define una_reg(r) (_regs[(r) >= 16 && (r) <= 18 ? (r)+19 : (r)])
454 asmlinkage void
455 do_entUna(void * va, unsigned long opcode, unsigned long reg,
456 struct allregs *regs)
458 long error, tmp1, tmp2, tmp3, tmp4;
459 unsigned long pc = regs->pc - 4;
460 unsigned long *_regs = regs->regs;
461 const struct exception_table_entry *fixup;
463 unaligned[0].count++;
464 unaligned[0].va = (unsigned long) va;
465 unaligned[0].pc = pc;
467 /* We don't want to use the generic get/put unaligned macros as
468 we want to trap exceptions. Only if we actually get an
469 exception will we decide whether we should have caught it. */
471 switch (opcode) {
472 case 0x0c: /* ldwu */
473 __asm__ __volatile__(
474 "1: ldq_u %1,0(%3)\n"
475 "2: ldq_u %2,1(%3)\n"
476 " extwl %1,%3,%1\n"
477 " extwh %2,%3,%2\n"
478 "3:\n"
479 ".section __ex_table,\"a\"\n"
480 " .long 1b - .\n"
481 " lda %1,3b-1b(%0)\n"
482 " .long 2b - .\n"
483 " lda %2,3b-2b(%0)\n"
484 ".previous"
485 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2)
486 : "r"(va), "0"(0));
487 if (error)
488 goto got_exception;
489 una_reg(reg) = tmp1|tmp2;
490 return;
492 case 0x28: /* ldl */
493 __asm__ __volatile__(
494 "1: ldq_u %1,0(%3)\n"
495 "2: ldq_u %2,3(%3)\n"
496 " extll %1,%3,%1\n"
497 " extlh %2,%3,%2\n"
498 "3:\n"
499 ".section __ex_table,\"a\"\n"
500 " .long 1b - .\n"
501 " lda %1,3b-1b(%0)\n"
502 " .long 2b - .\n"
503 " lda %2,3b-2b(%0)\n"
504 ".previous"
505 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2)
506 : "r"(va), "0"(0));
507 if (error)
508 goto got_exception;
509 una_reg(reg) = (int)(tmp1|tmp2);
510 return;
512 case 0x29: /* ldq */
513 __asm__ __volatile__(
514 "1: ldq_u %1,0(%3)\n"
515 "2: ldq_u %2,7(%3)\n"
516 " extql %1,%3,%1\n"
517 " extqh %2,%3,%2\n"
518 "3:\n"
519 ".section __ex_table,\"a\"\n"
520 " .long 1b - .\n"
521 " lda %1,3b-1b(%0)\n"
522 " .long 2b - .\n"
523 " lda %2,3b-2b(%0)\n"
524 ".previous"
525 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2)
526 : "r"(va), "0"(0));
527 if (error)
528 goto got_exception;
529 una_reg(reg) = tmp1|tmp2;
530 return;
532 /* Note that the store sequences do not indicate that they change
533 memory because it _should_ be affecting nothing in this context.
534 (Otherwise we have other, much larger, problems.) */
535 case 0x0d: /* stw */
536 __asm__ __volatile__(
537 "1: ldq_u %2,1(%5)\n"
538 "2: ldq_u %1,0(%5)\n"
539 " inswh %6,%5,%4\n"
540 " inswl %6,%5,%3\n"
541 " mskwh %2,%5,%2\n"
542 " mskwl %1,%5,%1\n"
543 " or %2,%4,%2\n"
544 " or %1,%3,%1\n"
545 "3: stq_u %2,1(%5)\n"
546 "4: stq_u %1,0(%5)\n"
547 "5:\n"
548 ".section __ex_table,\"a\"\n"
549 " .long 1b - .\n"
550 " lda %2,5b-1b(%0)\n"
551 " .long 2b - .\n"
552 " lda %1,5b-2b(%0)\n"
553 " .long 3b - .\n"
554 " lda $31,5b-3b(%0)\n"
555 " .long 4b - .\n"
556 " lda $31,5b-4b(%0)\n"
557 ".previous"
558 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2),
559 "=&r"(tmp3), "=&r"(tmp4)
560 : "r"(va), "r"(una_reg(reg)), "0"(0));
561 if (error)
562 goto got_exception;
563 return;
565 case 0x2c: /* stl */
566 __asm__ __volatile__(
567 "1: ldq_u %2,3(%5)\n"
568 "2: ldq_u %1,0(%5)\n"
569 " inslh %6,%5,%4\n"
570 " insll %6,%5,%3\n"
571 " msklh %2,%5,%2\n"
572 " mskll %1,%5,%1\n"
573 " or %2,%4,%2\n"
574 " or %1,%3,%1\n"
575 "3: stq_u %2,3(%5)\n"
576 "4: stq_u %1,0(%5)\n"
577 "5:\n"
578 ".section __ex_table,\"a\"\n"
579 " .long 1b - .\n"
580 " lda %2,5b-1b(%0)\n"
581 " .long 2b - .\n"
582 " lda %1,5b-2b(%0)\n"
583 " .long 3b - .\n"
584 " lda $31,5b-3b(%0)\n"
585 " .long 4b - .\n"
586 " lda $31,5b-4b(%0)\n"
587 ".previous"
588 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2),
589 "=&r"(tmp3), "=&r"(tmp4)
590 : "r"(va), "r"(una_reg(reg)), "0"(0));
591 if (error)
592 goto got_exception;
593 return;
595 case 0x2d: /* stq */
596 __asm__ __volatile__(
597 "1: ldq_u %2,7(%5)\n"
598 "2: ldq_u %1,0(%5)\n"
599 " insqh %6,%5,%4\n"
600 " insql %6,%5,%3\n"
601 " mskqh %2,%5,%2\n"
602 " mskql %1,%5,%1\n"
603 " or %2,%4,%2\n"
604 " or %1,%3,%1\n"
605 "3: stq_u %2,7(%5)\n"
606 "4: stq_u %1,0(%5)\n"
607 "5:\n"
608 ".section __ex_table,\"a\"\n\t"
609 " .long 1b - .\n"
610 " lda %2,5b-1b(%0)\n"
611 " .long 2b - .\n"
612 " lda %1,5b-2b(%0)\n"
613 " .long 3b - .\n"
614 " lda $31,5b-3b(%0)\n"
615 " .long 4b - .\n"
616 " lda $31,5b-4b(%0)\n"
617 ".previous"
618 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2),
619 "=&r"(tmp3), "=&r"(tmp4)
620 : "r"(va), "r"(una_reg(reg)), "0"(0));
621 if (error)
622 goto got_exception;
623 return;
626 lock_kernel();
627 printk("Bad unaligned kernel access at %016lx: %p %lx %lu\n",
628 pc, va, opcode, reg);
629 do_exit(SIGSEGV);
631 got_exception:
632 /* Ok, we caught the exception, but we don't want it. Is there
633 someone to pass it along to? */
634 if ((fixup = search_exception_tables(pc)) != 0) {
635 unsigned long newpc;
636 newpc = fixup_exception(una_reg, fixup, pc);
638 printk("Forwarding unaligned exception at %lx (%lx)\n",
639 pc, newpc);
641 regs->pc = newpc;
642 return;
646 * Yikes! No one to forward the exception to.
647 * Since the registers are in a weird format, dump them ourselves.
649 lock_kernel();
651 printk("%s(%d): unhandled unaligned exception\n",
652 current->comm, task_pid_nr(current));
654 printk("pc = [<%016lx>] ra = [<%016lx>] ps = %04lx\n",
655 pc, una_reg(26), regs->ps);
656 printk("r0 = %016lx r1 = %016lx r2 = %016lx\n",
657 una_reg(0), una_reg(1), una_reg(2));
658 printk("r3 = %016lx r4 = %016lx r5 = %016lx\n",
659 una_reg(3), una_reg(4), una_reg(5));
660 printk("r6 = %016lx r7 = %016lx r8 = %016lx\n",
661 una_reg(6), una_reg(7), una_reg(8));
662 printk("r9 = %016lx r10= %016lx r11= %016lx\n",
663 una_reg(9), una_reg(10), una_reg(11));
664 printk("r12= %016lx r13= %016lx r14= %016lx\n",
665 una_reg(12), una_reg(13), una_reg(14));
666 printk("r15= %016lx\n", una_reg(15));
667 printk("r16= %016lx r17= %016lx r18= %016lx\n",
668 una_reg(16), una_reg(17), una_reg(18));
669 printk("r19= %016lx r20= %016lx r21= %016lx\n",
670 una_reg(19), una_reg(20), una_reg(21));
671 printk("r22= %016lx r23= %016lx r24= %016lx\n",
672 una_reg(22), una_reg(23), una_reg(24));
673 printk("r25= %016lx r27= %016lx r28= %016lx\n",
674 una_reg(25), una_reg(27), una_reg(28));
675 printk("gp = %016lx sp = %p\n", regs->gp, regs+1);
677 dik_show_code((unsigned int *)pc);
678 dik_show_trace((unsigned long *)(regs+1));
680 if (test_and_set_thread_flag (TIF_DIE_IF_KERNEL)) {
681 printk("die_if_kernel recursion detected.\n");
682 local_irq_enable();
683 while (1);
685 do_exit(SIGSEGV);
689 * Convert an s-floating point value in memory format to the
690 * corresponding value in register format. The exponent
691 * needs to be remapped to preserve non-finite values
692 * (infinities, not-a-numbers, denormals).
694 static inline unsigned long
695 s_mem_to_reg (unsigned long s_mem)
697 unsigned long frac = (s_mem >> 0) & 0x7fffff;
698 unsigned long sign = (s_mem >> 31) & 0x1;
699 unsigned long exp_msb = (s_mem >> 30) & 0x1;
700 unsigned long exp_low = (s_mem >> 23) & 0x7f;
701 unsigned long exp;
703 exp = (exp_msb << 10) | exp_low; /* common case */
704 if (exp_msb) {
705 if (exp_low == 0x7f) {
706 exp = 0x7ff;
708 } else {
709 if (exp_low == 0x00) {
710 exp = 0x000;
711 } else {
712 exp |= (0x7 << 7);
715 return (sign << 63) | (exp << 52) | (frac << 29);
719 * Convert an s-floating point value in register format to the
720 * corresponding value in memory format.
722 static inline unsigned long
723 s_reg_to_mem (unsigned long s_reg)
725 return ((s_reg >> 62) << 30) | ((s_reg << 5) >> 34);
729 * Handle user-level unaligned fault. Handling user-level unaligned
730 * faults is *extremely* slow and produces nasty messages. A user
731 * program *should* fix unaligned faults ASAP.
733 * Notice that we have (almost) the regular kernel stack layout here,
734 * so finding the appropriate registers is a little more difficult
735 * than in the kernel case.
737 * Finally, we handle regular integer load/stores only. In
738 * particular, load-linked/store-conditionally and floating point
739 * load/stores are not supported. The former make no sense with
740 * unaligned faults (they are guaranteed to fail) and I don't think
741 * the latter will occur in any decent program.
743 * Sigh. We *do* have to handle some FP operations, because GCC will
744 * uses them as temporary storage for integer memory to memory copies.
745 * However, we need to deal with stt/ldt and sts/lds only.
748 #define OP_INT_MASK ( 1L << 0x28 | 1L << 0x2c /* ldl stl */ \
749 | 1L << 0x29 | 1L << 0x2d /* ldq stq */ \
750 | 1L << 0x0c | 1L << 0x0d /* ldwu stw */ \
751 | 1L << 0x0a | 1L << 0x0e ) /* ldbu stb */
753 #define OP_WRITE_MASK ( 1L << 0x26 | 1L << 0x27 /* sts stt */ \
754 | 1L << 0x2c | 1L << 0x2d /* stl stq */ \
755 | 1L << 0x0d | 1L << 0x0e ) /* stw stb */
757 #define R(x) ((size_t) &((struct pt_regs *)0)->x)
759 static int unauser_reg_offsets[32] = {
760 R(r0), R(r1), R(r2), R(r3), R(r4), R(r5), R(r6), R(r7), R(r8),
761 /* r9 ... r15 are stored in front of regs. */
762 -56, -48, -40, -32, -24, -16, -8,
763 R(r16), R(r17), R(r18),
764 R(r19), R(r20), R(r21), R(r22), R(r23), R(r24), R(r25), R(r26),
765 R(r27), R(r28), R(gp),
766 0, 0
769 #undef R
771 asmlinkage void
772 do_entUnaUser(void __user * va, unsigned long opcode,
773 unsigned long reg, struct pt_regs *regs)
775 static DEFINE_RATELIMIT_STATE(ratelimit, 5 * HZ, 5);
777 unsigned long tmp1, tmp2, tmp3, tmp4;
778 unsigned long fake_reg, *reg_addr = &fake_reg;
779 siginfo_t info;
780 long error;
782 /* Check the UAC bits to decide what the user wants us to do
783 with the unaliged access. */
785 if (!test_thread_flag (TIF_UAC_NOPRINT)) {
786 if (__ratelimit(&ratelimit)) {
787 printk("%s(%d): unaligned trap at %016lx: %p %lx %ld\n",
788 current->comm, task_pid_nr(current),
789 regs->pc - 4, va, opcode, reg);
792 if (test_thread_flag (TIF_UAC_SIGBUS))
793 goto give_sigbus;
794 /* Not sure why you'd want to use this, but... */
795 if (test_thread_flag (TIF_UAC_NOFIX))
796 return;
798 /* Don't bother reading ds in the access check since we already
799 know that this came from the user. Also rely on the fact that
800 the page at TASK_SIZE is unmapped and so can't be touched anyway. */
801 if (!__access_ok((unsigned long)va, 0, USER_DS))
802 goto give_sigsegv;
804 ++unaligned[1].count;
805 unaligned[1].va = (unsigned long)va;
806 unaligned[1].pc = regs->pc - 4;
808 if ((1L << opcode) & OP_INT_MASK) {
809 /* it's an integer load/store */
810 if (reg < 30) {
811 reg_addr = (unsigned long *)
812 ((char *)regs + unauser_reg_offsets[reg]);
813 } else if (reg == 30) {
814 /* usp in PAL regs */
815 fake_reg = rdusp();
816 } else {
817 /* zero "register" */
818 fake_reg = 0;
822 /* We don't want to use the generic get/put unaligned macros as
823 we want to trap exceptions. Only if we actually get an
824 exception will we decide whether we should have caught it. */
826 switch (opcode) {
827 case 0x0c: /* ldwu */
828 __asm__ __volatile__(
829 "1: ldq_u %1,0(%3)\n"
830 "2: ldq_u %2,1(%3)\n"
831 " extwl %1,%3,%1\n"
832 " extwh %2,%3,%2\n"
833 "3:\n"
834 ".section __ex_table,\"a\"\n"
835 " .long 1b - .\n"
836 " lda %1,3b-1b(%0)\n"
837 " .long 2b - .\n"
838 " lda %2,3b-2b(%0)\n"
839 ".previous"
840 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2)
841 : "r"(va), "0"(0));
842 if (error)
843 goto give_sigsegv;
844 *reg_addr = tmp1|tmp2;
845 break;
847 case 0x22: /* lds */
848 __asm__ __volatile__(
849 "1: ldq_u %1,0(%3)\n"
850 "2: ldq_u %2,3(%3)\n"
851 " extll %1,%3,%1\n"
852 " extlh %2,%3,%2\n"
853 "3:\n"
854 ".section __ex_table,\"a\"\n"
855 " .long 1b - .\n"
856 " lda %1,3b-1b(%0)\n"
857 " .long 2b - .\n"
858 " lda %2,3b-2b(%0)\n"
859 ".previous"
860 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2)
861 : "r"(va), "0"(0));
862 if (error)
863 goto give_sigsegv;
864 alpha_write_fp_reg(reg, s_mem_to_reg((int)(tmp1|tmp2)));
865 return;
867 case 0x23: /* ldt */
868 __asm__ __volatile__(
869 "1: ldq_u %1,0(%3)\n"
870 "2: ldq_u %2,7(%3)\n"
871 " extql %1,%3,%1\n"
872 " extqh %2,%3,%2\n"
873 "3:\n"
874 ".section __ex_table,\"a\"\n"
875 " .long 1b - .\n"
876 " lda %1,3b-1b(%0)\n"
877 " .long 2b - .\n"
878 " lda %2,3b-2b(%0)\n"
879 ".previous"
880 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2)
881 : "r"(va), "0"(0));
882 if (error)
883 goto give_sigsegv;
884 alpha_write_fp_reg(reg, tmp1|tmp2);
885 return;
887 case 0x28: /* ldl */
888 __asm__ __volatile__(
889 "1: ldq_u %1,0(%3)\n"
890 "2: ldq_u %2,3(%3)\n"
891 " extll %1,%3,%1\n"
892 " extlh %2,%3,%2\n"
893 "3:\n"
894 ".section __ex_table,\"a\"\n"
895 " .long 1b - .\n"
896 " lda %1,3b-1b(%0)\n"
897 " .long 2b - .\n"
898 " lda %2,3b-2b(%0)\n"
899 ".previous"
900 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2)
901 : "r"(va), "0"(0));
902 if (error)
903 goto give_sigsegv;
904 *reg_addr = (int)(tmp1|tmp2);
905 break;
907 case 0x29: /* ldq */
908 __asm__ __volatile__(
909 "1: ldq_u %1,0(%3)\n"
910 "2: ldq_u %2,7(%3)\n"
911 " extql %1,%3,%1\n"
912 " extqh %2,%3,%2\n"
913 "3:\n"
914 ".section __ex_table,\"a\"\n"
915 " .long 1b - .\n"
916 " lda %1,3b-1b(%0)\n"
917 " .long 2b - .\n"
918 " lda %2,3b-2b(%0)\n"
919 ".previous"
920 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2)
921 : "r"(va), "0"(0));
922 if (error)
923 goto give_sigsegv;
924 *reg_addr = tmp1|tmp2;
925 break;
927 /* Note that the store sequences do not indicate that they change
928 memory because it _should_ be affecting nothing in this context.
929 (Otherwise we have other, much larger, problems.) */
930 case 0x0d: /* stw */
931 __asm__ __volatile__(
932 "1: ldq_u %2,1(%5)\n"
933 "2: ldq_u %1,0(%5)\n"
934 " inswh %6,%5,%4\n"
935 " inswl %6,%5,%3\n"
936 " mskwh %2,%5,%2\n"
937 " mskwl %1,%5,%1\n"
938 " or %2,%4,%2\n"
939 " or %1,%3,%1\n"
940 "3: stq_u %2,1(%5)\n"
941 "4: stq_u %1,0(%5)\n"
942 "5:\n"
943 ".section __ex_table,\"a\"\n"
944 " .long 1b - .\n"
945 " lda %2,5b-1b(%0)\n"
946 " .long 2b - .\n"
947 " lda %1,5b-2b(%0)\n"
948 " .long 3b - .\n"
949 " lda $31,5b-3b(%0)\n"
950 " .long 4b - .\n"
951 " lda $31,5b-4b(%0)\n"
952 ".previous"
953 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2),
954 "=&r"(tmp3), "=&r"(tmp4)
955 : "r"(va), "r"(*reg_addr), "0"(0));
956 if (error)
957 goto give_sigsegv;
958 return;
960 case 0x26: /* sts */
961 fake_reg = s_reg_to_mem(alpha_read_fp_reg(reg));
962 /* FALLTHRU */
964 case 0x2c: /* stl */
965 __asm__ __volatile__(
966 "1: ldq_u %2,3(%5)\n"
967 "2: ldq_u %1,0(%5)\n"
968 " inslh %6,%5,%4\n"
969 " insll %6,%5,%3\n"
970 " msklh %2,%5,%2\n"
971 " mskll %1,%5,%1\n"
972 " or %2,%4,%2\n"
973 " or %1,%3,%1\n"
974 "3: stq_u %2,3(%5)\n"
975 "4: stq_u %1,0(%5)\n"
976 "5:\n"
977 ".section __ex_table,\"a\"\n"
978 " .long 1b - .\n"
979 " lda %2,5b-1b(%0)\n"
980 " .long 2b - .\n"
981 " lda %1,5b-2b(%0)\n"
982 " .long 3b - .\n"
983 " lda $31,5b-3b(%0)\n"
984 " .long 4b - .\n"
985 " lda $31,5b-4b(%0)\n"
986 ".previous"
987 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2),
988 "=&r"(tmp3), "=&r"(tmp4)
989 : "r"(va), "r"(*reg_addr), "0"(0));
990 if (error)
991 goto give_sigsegv;
992 return;
994 case 0x27: /* stt */
995 fake_reg = alpha_read_fp_reg(reg);
996 /* FALLTHRU */
998 case 0x2d: /* stq */
999 __asm__ __volatile__(
1000 "1: ldq_u %2,7(%5)\n"
1001 "2: ldq_u %1,0(%5)\n"
1002 " insqh %6,%5,%4\n"
1003 " insql %6,%5,%3\n"
1004 " mskqh %2,%5,%2\n"
1005 " mskql %1,%5,%1\n"
1006 " or %2,%4,%2\n"
1007 " or %1,%3,%1\n"
1008 "3: stq_u %2,7(%5)\n"
1009 "4: stq_u %1,0(%5)\n"
1010 "5:\n"
1011 ".section __ex_table,\"a\"\n\t"
1012 " .long 1b - .\n"
1013 " lda %2,5b-1b(%0)\n"
1014 " .long 2b - .\n"
1015 " lda %1,5b-2b(%0)\n"
1016 " .long 3b - .\n"
1017 " lda $31,5b-3b(%0)\n"
1018 " .long 4b - .\n"
1019 " lda $31,5b-4b(%0)\n"
1020 ".previous"
1021 : "=r"(error), "=&r"(tmp1), "=&r"(tmp2),
1022 "=&r"(tmp3), "=&r"(tmp4)
1023 : "r"(va), "r"(*reg_addr), "0"(0));
1024 if (error)
1025 goto give_sigsegv;
1026 return;
1028 default:
1029 /* What instruction were you trying to use, exactly? */
1030 goto give_sigbus;
1033 /* Only integer loads should get here; everyone else returns early. */
1034 if (reg == 30)
1035 wrusp(fake_reg);
1036 return;
1038 give_sigsegv:
1039 regs->pc -= 4; /* make pc point to faulting insn */
1040 info.si_signo = SIGSEGV;
1041 info.si_errno = 0;
1043 /* We need to replicate some of the logic in mm/fault.c,
1044 since we don't have access to the fault code in the
1045 exception handling return path. */
1046 if (!__access_ok((unsigned long)va, 0, USER_DS))
1047 info.si_code = SEGV_ACCERR;
1048 else {
1049 struct mm_struct *mm = current->mm;
1050 down_read(&mm->mmap_sem);
1051 if (find_vma(mm, (unsigned long)va))
1052 info.si_code = SEGV_ACCERR;
1053 else
1054 info.si_code = SEGV_MAPERR;
1055 up_read(&mm->mmap_sem);
1057 info.si_addr = va;
1058 send_sig_info(SIGSEGV, &info, current);
1059 return;
1061 give_sigbus:
1062 regs->pc -= 4;
1063 info.si_signo = SIGBUS;
1064 info.si_errno = 0;
1065 info.si_code = BUS_ADRALN;
1066 info.si_addr = va;
1067 send_sig_info(SIGBUS, &info, current);
1068 return;
1071 void __cpuinit
1072 trap_init(void)
1074 /* Tell PAL-code what global pointer we want in the kernel. */
1075 register unsigned long gptr __asm__("$29");
1076 wrkgp(gptr);
1078 /* Hack for Multia (UDB) and JENSEN: some of their SRMs have
1079 a bug in the handling of the opDEC fault. Fix it up if so. */
1080 if (implver() == IMPLVER_EV4)
1081 opDEC_check();
1083 wrent(entArith, 1);
1084 wrent(entMM, 2);
1085 wrent(entIF, 3);
1086 wrent(entUna, 4);
1087 wrent(entSys, 5);
1088 wrent(entDbg, 6);