Annotation of sys/arch/mvme68k/mvme68k/trap.c, Revision 1.1.1.1
1.1 nbrk 1: /* $OpenBSD: trap.c,v 1.67 2007/05/15 13:46:22 martin Exp $ */
2:
3: /*
4: * Copyright (c) 1995 Theo de Raadt
5: * Copyright (c) 1999 Steve Murphree, Jr. (68060 support)
6: *
7: * Redistribution and use in source and binary forms, with or without
8: * modification, are permitted provided that the following conditions
9: * are met:
10: * 1. Redistributions of source code must retain the above copyright
11: * notice, this list of conditions and the following disclaimer.
12: * 2. Redistributions in binary form must reproduce the above copyright
13: * notice, this list of conditions and the following disclaimer in the
14: * documentation and/or other materials provided with the distribution.
15: *
16: * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
17: * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
18: * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19: * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
20: * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26: * SUCH DAMAGE.
27: *
28: * Copyright (c) 1988 University of Utah.
29: * Copyright (c) 1982, 1986, 1990, 1993
30: * The Regents of the University of California. All rights reserved.
31: *
32: * This code is derived from software contributed to Berkeley by
33: * the Systems Programming Group of the University of Utah Computer
34: * Science Department.
35: *
36: * Redistribution and use in source and binary forms, with or without
37: * modification, are permitted provided that the following conditions
38: * are met:
39: * 1. Redistributions of source code must retain the above copyright
40: * notice, this list of conditions and the following disclaimer.
41: * 2. Redistributions in binary form must reproduce the above copyright
42: * notice, this list of conditions and the following disclaimer in the
43: * documentation and/or other materials provided with the distribution.
44: * 3. Neither the name of the University nor the names of its contributors
45: * may be used to endorse or promote products derived from this software
46: * without specific prior written permission.
47: *
48: * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
49: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
50: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
51: * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
52: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
53: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
54: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
55: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
56: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
57: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
58: * SUCH DAMAGE.
59: *
60: * from: Utah $Hdr: trap.c 1.37 92/12/20$
61: *
62: * @(#)trap.c 8.5 (Berkeley) 1/4/94
63: */
64:
65: #include <sys/param.h>
66: #include <sys/systm.h>
67: #include <sys/proc.h>
68: #include <sys/acct.h>
69: #include <sys/kernel.h>
70: #include <sys/signalvar.h>
71: #include <sys/resourcevar.h>
72: #include <sys/syscall.h>
73: #include <sys/syslog.h>
74: #include <sys/user.h>
75: #ifdef KTRACE
76: #include <sys/ktrace.h>
77: #endif
78:
79: #include <machine/db_machdep.h>
80: #include <machine/cpu.h>
81: #include <machine/psl.h>
82: #include <machine/reg.h>
83: #include <machine/trap.h>
84:
85: #ifdef COMPAT_SUNOS
86: #include <compat/sunos/sunos_syscall.h>
87: extern struct emul emul_sunos;
88: #endif
89:
90: #include "systrace.h"
91: #include <dev/systrace.h>
92:
93: #include <uvm/uvm_extern.h>
94: #include <uvm/uvm_pmap.h>
95:
96: #ifdef COMPAT_HPUX
97: #include <compat/hpux/hpux.h>
98: #endif
99:
100: int astpending;
101: int want_resched;
102:
103: char *trap_type[] = {
104: "Bus error",
105: "Address error",
106: "Illegal instruction",
107: "Zero divide",
108: "CHK instruction",
109: "TRAPV instruction",
110: "Privilege violation",
111: "Trace trap",
112: "MMU fault",
113: "SSIR trap",
114: "Format error",
115: "68881 exception",
116: "Coprocessor violation",
117: "Async system trap"
118: };
119: int trap_types = sizeof trap_type / sizeof trap_type[0];
120:
121: /*
122: * Size of various exception stack frames (minus the standard 8 bytes)
123: */
124: short exframesize[] = {
125: FMT0SIZE, /* type 0 - normal (68020/030/040/060) */
126: FMT1SIZE, /* type 1 - throwaway (68020/030/040) */
127: FMT2SIZE, /* type 2 - normal 6-word (68020/030/040/060) */
128: FMT3SIZE, /* type 3 - FP post-instruction (68040/060) */
129: FMT4SIZE, /* type 4 - access error/fp disabled (68060) */
130: -1, -1, /* type 5-6 - undefined */
131: FMT7SIZE, /* type 7 - access error (68040) */
132: 58, /* type 8 - bus fault (68010) */
133: FMT9SIZE, /* type 9 - coprocessor mid-instruction (68020/030) */
134: FMTASIZE, /* type A - short bus fault (68020/030) */
135: FMTBSIZE, /* type B - long bus fault (68020/030) */
136: -1, -1, -1, -1 /* type C-F - undefined */
137: };
138:
139:
140: #if defined(M68040) || defined(M68060)
141: #define KDFAULT(c) (mmutype == MMU_68060 ? ((c) & FSLW_TM_SV) : \
142: mmutype == MMU_68040 ? ((c) & SSW4_TMMASK) == SSW4_TMKD : \
143: ((c) & (SSW_DF|FC_SUPERD)) == (SSW_DF|FC_SUPERD))
144: #define WRFAULT(c) (mmutype == MMU_68060 ? ((c) & FSLW_RW_W) : \
145: mmutype == MMU_68040 ? ((c) & SSW4_RW) == 0 : \
146: ((c) & (SSW_DF|SSW_RW)) == SSW_DF)
147: #else
148: #define KDFAULT(c) (((c) & (SSW_DF|SSW_FCMASK)) == (SSW_DF|FC_SUPERD))
149: #define WRFAULT(c) (((c) & (SSW_DF|SSW_RW)) == SSW_DF)
150: #endif
151:
152: #ifdef DEBUG
153: int mmudebug = 0;
154: int mmupid = -1;
155: #define MDB_FOLLOW 1
156: #define MDB_WBFOLLOW 2
157: #define MDB_WBFAILED 4
158: #define MDB_ISPID(p) (p) == mmupid
159: #endif
160:
161: #define NSIR 8
162: void (*sir_routines[NSIR])(void *);
163: void *sir_args[NSIR];
164: u_char next_sir;
165:
166: void trap(int, u_int, u_int, struct frame);
167: void syscall(register_t, struct frame);
168: void init_intrs(void);
169: void hardintr(int, int, void *);
170: int writeback(struct frame *);
171: void wb_userret(struct proc *, struct frame *);
172:
173: /*
174: * trap and syscall both need the following work done before returning
175: * to user mode.
176: */
177: void
178: userret(struct proc *p)
179: {
180: int sig;
181:
182: /* take pending signals */
183: while ((sig = CURSIG(p)) != 0)
184: postsig(sig);
185: curcpu()->ci_schedstate.spc_curpriority = p->p_priority = p->p_usrpri;
186: }
187:
188: #ifdef M68040
189: /*
190: * Same as above, but also handles writeback completion on 68040.
191: */
192: void
193: wb_userret(struct proc *p, struct frame *fp)
194: {
195: int sig;
196: union sigval sv;
197:
198: /* take pending signals */
199: while ((sig = CURSIG(p)) != 0)
200: postsig(sig);
201: p->p_priority = p->p_usrpri;
202:
203: /*
204: * Deal with user mode writebacks (from trap, or from sigreturn).
205: * If any writeback fails, go back and attempt signal delivery.
206: * unless we have already been here and attempted the writeback
207: * (e.g. bad address with user ignoring SIGSEGV). In that case
208: * we just return to the user without successfully completing
209: * the writebacks. Maybe we should just drop the sucker?
210: */
211: if (mmutype == MMU_68040 && fp->f_format == FMT7) {
212: if ((sig = writeback(fp)) != 0) {
213: sv.sival_int = fp->f_fmt7.f_fa;
214: trapsignal(p, sig, T_MMUFLT, SEGV_MAPERR, sv);
215:
216: while ((sig = CURSIG(p)) != 0)
217: postsig(sig);
218: p->p_priority = p->p_usrpri;
219: }
220: }
221: curcpu()->ci_schedstate.spc_curpriority = p->p_priority;
222: }
223: #endif
224:
225: /*
226: * Trap is called from locore to handle most types of processor traps,
227: * including events such as simulated software interrupts/AST's.
228: * System calls are broken out for efficiency.
229: */
230: /*ARGSUSED*/
231: void
232: trap(type, code, v, frame)
233: int type;
234: u_int code;
235: register u_int v;
236: struct frame frame;
237: {
238: register struct proc *p;
239: register int i;
240: u_int ucode;
241: int typ = 0, bit;
242: #ifdef COMPAT_HPUX
243: extern struct emul emul_hpux;
244: #endif
245: #ifdef COMPAT_SUNOS
246: extern struct emul emul_sunos;
247: #endif
248: register union sigval sv;
249:
250: uvmexp.traps++;
251: p = curproc;
252: ucode = 0;
253: if (USERMODE(frame.f_sr)) {
254: type |= T_USER;
255: p->p_md.md_regs = frame.f_regs;
256: }
257: switch (type) {
258: default:
259: dopanic:
260: printf("trap type %d, code = %x, v = %x\n", type, code, v);
261: #ifdef DDB
262: if (kdb_trap(type, (db_regs_t *)&frame))
263: return;
264: #endif
265: regdump(&(frame.F_t), 128);
266: type &= ~T_USER;
267: if ((u_int)type < trap_types)
268: panic(trap_type[type]);
269: panic("trap");
270:
271: case T_BUSERR: /* kernel bus error */
272: if (!p || !p->p_addr->u_pcb.pcb_onfault)
273: goto dopanic;
274: copyfault:
275: /*
276: * If we have arranged to catch this fault in any of the
277: * copy to/from user space routines, set PC to return to
278: * indicated location and set flag informing buserror code
279: * that it may need to clean up stack frame.
280: */
281: frame.f_stackadj = exframesize[frame.f_format];
282: frame.f_format = frame.f_vector = 0;
283: frame.f_pc = (int) p->p_addr->u_pcb.pcb_onfault;
284: return;
285:
286: case T_BUSERR|T_USER: /* bus error */
287: typ = BUS_OBJERR;
288: ucode = code & ~T_USER;
289: i = SIGBUS;
290: break;
291: case T_ADDRERR|T_USER: /* address error */
292: typ = BUS_ADRALN;
293: ucode = code & ~T_USER;
294: i = SIGBUS;
295: break;
296:
297: case T_COPERR: /* kernel coprocessor violation */
298: case T_FMTERR|T_USER: /* do all RTE errors come in as T_USER? */
299: case T_FMTERR: /* ...just in case... */
300: /*
301: * The user has most likely trashed the RTE or FP state info
302: * in the stack frame of a signal handler.
303: */
304: printf("pid %d: kernel %s exception\n", p->p_pid,
305: type==T_COPERR ? "coprocessor" : "format");
306: type |= T_USER;
307: p->p_sigacts->ps_sigact[SIGILL] = SIG_DFL;
308: i = sigmask(SIGILL);
309: p->p_sigignore &= ~i;
310: p->p_sigcatch &= ~i;
311: p->p_sigmask &= ~i;
312: i = SIGILL;
313: ucode = frame.f_format; /* XXX was ILL_RESAD_FAULT */
314: typ = ILL_COPROC;
315: v = frame.f_pc;
316: break;
317:
318: case T_COPERR|T_USER: /* user coprocessor violation */
319: /* What is a proper response here? */
320: typ = FPE_FLTINV;
321: ucode = 0;
322: i = SIGFPE;
323: break;
324:
325: case T_FPERR|T_USER: /* 68881 exceptions */
326: typ = FPE_FLTRES;
327: ucode = code;
328: i = SIGFPE;
329: v = frame.f_pc;
330: break;
331:
332: #if defined(M68040) || defined(M68060)
333: case T_FPEMULI|T_USER: /* unimplemented FP instruction */
334: case T_FPEMULD|T_USER: /* unimplemented FP data type */
335: /* XXX need to FSAVE */
336: printf("pid %d(%s): unimplemented FP %s at %x (EA %x)\n",
337: p->p_pid, p->p_comm,
338: frame.f_format == 2 ? "instruction" : "data type",
339: frame.f_pc, frame.f_fmt2.f_iaddr);
340: /* XXX need to FRESTORE */
341: typ = FPE_FLTINV;
342: i = SIGFPE;
343: v = frame.f_pc;
344: break;
345: #endif
346:
347: case T_ILLINST|T_USER: /* illegal instruction fault */
348: #ifdef COMPAT_HPUX
349: if (p->p_emul == &emul_hpux) {
350: typ = 0;
351: ucode = HPUX_ILL_ILLINST_TRAP;
352: i = SIGILL;
353: break;
354: }
355: #endif
356: ucode = frame.f_format; /* XXX was ILL_PRIVIN_FAULT */
357: typ = ILL_ILLOPC;
358: i = SIGILL;
359: v = frame.f_pc;
360: break;
361:
362: case T_PRIVINST|T_USER: /* privileged instruction fault */
363: #ifdef COMPAT_HPUX
364: if (p->p_emul == &emul_hpux)
365: ucode = HPUX_ILL_PRIV_TRAP;
366: else
367: #endif
368: ucode = frame.f_format; /* XXX was ILL_PRIVIN_FAULT */
369: typ = ILL_PRVOPC;
370: i = SIGILL;
371: v = frame.f_pc;
372: break;
373:
374: case T_ZERODIV|T_USER: /* Divide by zero */
375: #ifdef COMPAT_HPUX
376: if (p->p_emul == &emul_hpux)
377: ucode = HPUX_FPE_INTDIV_TRAP;
378: else
379: #endif
380: ucode = frame.f_format; /* XXX was FPE_INTDIV_TRAP */
381: typ = FPE_INTDIV;
382: i = SIGFPE;
383: v = frame.f_pc;
384: break;
385:
386: case T_CHKINST|T_USER: /* CHK instruction trap */
387: #ifdef COMPAT_HPUX
388: if (p->p_emul == &emul_hpux) {
389: /* handled differently under hp-ux */
390: i = SIGILL;
391: ucode = HPUX_ILL_CHK_TRAP;
392: break;
393: }
394: #endif
395: ucode = frame.f_format; /* XXX was FPE_SUBRNG_TRAP */
396: typ = FPE_FLTSUB;
397: i = SIGFPE;
398: v = frame.f_pc;
399: break;
400:
401: case T_TRAPVINST|T_USER: /* TRAPV instruction trap */
402: #ifdef COMPAT_HPUX
403: if (p->p_emul == &emul_hpux) {
404: /* handled differently under hp-ux */
405: i = SIGILL;
406: ucode = HPUX_ILL_TRAPV_TRAP;
407: break;
408: }
409: #endif
410: ucode = frame.f_format; /* XXX was FPE_INTOVF_TRAP */
411: typ = ILL_ILLTRP;
412: i = SIGILL;
413: v = frame.f_pc;
414: break;
415:
416: /*
417: * XXX: Trace traps are a nightmare.
418: *
419: * HP-UX uses trap #1 for breakpoints,
420: * OpenBSD/m68k uses trap #2,
421: * SUN 3.x uses trap #15,
422: * KGDB uses trap #15 (for kernel breakpoints; handled elsewhere).
423: *
424: * OpenBSD and HP-UX traps both get mapped by locore.s into
425: * T_TRACE.
426: * SUN 3.x traps get passed through as T_TRAP15 and are not really
427: * supported yet.
428: */
429: case T_TRAP15: /* kernel breakpoint */
430: #ifdef DEBUG
431: printf("unexpected kernel trace trap, type = %d\n", type);
432: printf("program counter = 0x%x\n", frame.f_pc);
433: #endif
434: frame.f_sr &= ~PSL_T;
435: return;
436:
437: case T_TRACE|T_USER: /* user trace trap */
438: #ifdef COMPAT_SUNOS
439: /*
440: * SunOS uses Trap #2 for a "CPU cache flush"
441: * Just flush the on-chip caches and return.
442: */
443: if (p->p_emul == &emul_sunos) {
444: ICIA();
445: DCIU();
446: return;
447: }
448: #endif
449: /* FALLTHROUGH */
450:
451: case T_TRACE:
452: case T_TRAP15|T_USER: /* SUN user trace trap */
453: frame.f_sr &= ~PSL_T;
454: i = SIGTRAP;
455: typ = TRAP_TRACE;
456: break;
457:
458: case T_ASTFLT: /* system async trap, cannot happen */
459: goto dopanic;
460:
461: case T_ASTFLT|T_USER: /* user async trap */
462: astpending = 0;
463: /*
464: * We check for software interrupts first. This is because
465: * they are at a higher level than ASTs, and on a VAX would
466: * interrupt the AST. We assume that if we are processing
467: * an AST that we must be at IPL0 so we don't bother to
468: * check. Note that we ensure that we are at least at SIR
469: * IPL while processing the SIR.
470: */
471: splsoft();
472: /* FALLTHROUGH */
473:
474: case T_SSIR: /* software interrupt */
475: case T_SSIR|T_USER:
476: while ((bit = ffs(ssir))) {
477: --bit;
478: ssir &= ~(1 << bit);
479: uvmexp.softs++;
480: if (sir_routines[bit])
481: sir_routines[bit](sir_args[bit]);
482: }
483: /*
484: * If this was not an AST trap, we are all done.
485: */
486: if (type != (T_ASTFLT|T_USER)) {
487: uvmexp.traps--;
488: return;
489: }
490: spl0();
491: if (p->p_flag & P_OWEUPC) {
492: ADDUPROF(p);
493: }
494: if (type == (T_ASTFLT | T_USER) && want_resched) {
495: preempt(NULL);
496: }
497: goto out;
498:
499: case T_MMUFLT: /* kernel mode page fault */
500: case T_MMUFLT|T_USER: /* page fault */
501: {
502: vaddr_t va;
503: struct vmspace *vm = NULL;
504: struct vm_map *map;
505: int rv;
506: vm_prot_t ftype, vftype;
507: extern struct vm_map *kernel_map;
508:
509: /* vmspace only significant if T_USER */
510: if (p)
511: vm = p->p_vmspace;
512:
513: #ifdef DEBUG
514: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid))
515: printf("trap: T_MMUFLT pid=%d, code=%x, v=%x, pc=%x, sr=%x\n",
516: p->p_pid, code, v, frame.f_pc, frame.f_sr);
517: #endif
518: /*
519: * It is only a kernel address space fault iff:
520: * 1. (type & T_USER) == 0 and
521: * 2. pcb_onfault not set or
522: * 3. pcb_onfault set but supervisor space data fault
523: * The last can occur during an exec() copyin where the
524: * argument space is lazy-allocated.
525: */
526: if (type == T_MMUFLT &&
527: ((p && !p->p_addr->u_pcb.pcb_onfault) || KDFAULT(code)))
528: map = kernel_map;
529: else
530: map = vm ? &vm->vm_map : kernel_map;
531: if (WRFAULT(code)) {
532: vftype = VM_PROT_WRITE;
533: ftype = VM_PROT_READ | VM_PROT_WRITE;
534: } else
535: vftype = ftype = VM_PROT_READ;
536: va = trunc_page((vaddr_t)v);
537:
538: if (map == kernel_map && va == 0) {
539: printf("trap: bad kernel access at %x\n", v);
540: goto dopanic;
541: }
542: #ifdef COMPAT_HPUX
543: if (ISHPMMADDR(p, va)) {
544: vaddr_t bva;
545:
546: rv = pmap_mapmulti(map->pmap, va);
547: if (rv) {
548: bva = HPMMBASEADDR(va);
549: rv = uvm_fault(map, bva, 0, ftype);
550: if (rv == 0)
551: (void)pmap_mapmulti(map->pmap, va);
552: }
553: } else
554: #endif
555: rv = uvm_fault(map, va, 0, ftype);
556: #ifdef DEBUG
557: if (rv && MDB_ISPID(p->p_pid))
558: printf("uvm_fault(%x, %x, 0, %x) -> %x\n",
559: map, va, ftype, rv);
560: #endif
561: /*
562: * If this was a stack access we keep track of the maximum
563: * accessed stack size. Also, if vm_fault gets a protection
564: * failure it is due to accessing the stack region outside
565: * the current limit and we need to reflect that as an access
566: * error.
567: */
568: if ((vm != NULL && (caddr_t)va >= vm->vm_maxsaddr)
569: && map != kernel_map) {
570: if (rv == 0)
571: uvm_grow(p, va);
572: else if (rv == EACCES)
573: rv = EFAULT;
574: }
575: if (rv == 0) {
576: if (type == T_MMUFLT) {
577: #if defined(M68040)
578: if (mmutype == MMU_68040)
579: (void)writeback(&frame);
580: #endif
581: return;
582: }
583: goto out;
584: }
585: if (type == T_MMUFLT) {
586: if (p && p->p_addr->u_pcb.pcb_onfault)
587: goto copyfault;
588: printf("uvm_fault(%p, %lx, 0, %x) -> %x\n",
589: map, va, ftype, rv);
590: printf(" type %x, code [mmu,,ssw]: %x\n",
591: type, code);
592: goto dopanic;
593: }
594: frame.f_pad = code & 0xffff;
595: ucode = vftype;
596: typ = SEGV_MAPERR;
597: i = SIGSEGV;
598: }
599: break;
600: }
601: sv.sival_int = v;
602: trapsignal(p, i, ucode, typ, sv);
603: out:
604: if ((type & T_USER) == 0)
605: return;
606: #ifdef M68040
607: wb_userret(p, &frame);
608: #else
609: userret(p);
610: #endif
611: }
612:
613: #if defined(M68040)
614: #ifdef DEBUG
615: struct writebackstats {
616: int calls;
617: int cpushes;
618: int move16s;
619: int wb1s, wb2s, wb3s;
620: int wbsize[4];
621: } wbstats;
622:
623: char *f7sz[] = { "longword", "byte", "word", "line"};
624: char *f7tt[] = { "normal", "MOVE16", "AFC", "ACK"};
625: char *f7tm[] = { "d-push", "u-data", "u-code", "M-data",
626: "M-code", "k-data", "k-code", "RES"};
627: char wberrstr[] =
628: "WARNING: pid %d(%s) writeback [%s] failed, pc=%x fa=%x wba=%x wbd=%x\n";
629: #endif
630:
631: int
632: writeback(struct frame *fp)
633: {
634: struct fmt7 *f = &fp->f_fmt7;
635: struct proc *p = curproc;
636: int err = 0;
637: u_int fa;
638: paddr_t pa;
639: caddr_t oonfault = p->p_addr->u_pcb.pcb_onfault;
640:
641: #ifdef DEBUG
642: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid)) {
643: printf(" pid=%d, fa=%x,", p->p_pid, f->f_fa);
644: dumpssw(f->f_ssw);
645: }
646: wbstats.calls++;
647: #endif
648: /*
649: * Deal with special cases first.
650: */
651: if ((f->f_ssw & SSW4_TMMASK) == SSW4_TMDCP) {
652: /*
653: * Dcache push fault.
654: * Line-align the address and write out the push data to
655: * the indicated physical address.
656: */
657: #ifdef DEBUG
658: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid)) {
659: printf(" pushing %s to PA %x, data %x",
660: f7sz[(f->f_ssw & SSW4_SZMASK) >> 5],
661: f->f_fa, f->f_pd0);
662: if ((f->f_ssw & SSW4_SZMASK) == SSW4_SZLN)
663: printf("/%x/%x/%x",
664: f->f_pd1, f->f_pd2, f->f_pd3);
665: printf("\n");
666: }
667: if (f->f_wb1s & SSW4_WBSV)
668: panic("writeback: cache push with WB1S valid");
669: wbstats.cpushes++;
670: #endif
671: /*
672: * XXX there are security problems if we attempt to do a
673: * cache push after a signal handler has been called.
674: */
675: pmap_kenter_pa((vaddr_t)vmmap,
676: trunc_page(f->f_fa), VM_PROT_WRITE);
677: pmap_update(pmap_kernel());
678: fa = (u_int)&vmmap[(f->f_fa & PGOFSET) & ~0x000f];
679: bcopy((caddr_t)&f->f_pd0, (caddr_t)fa, 16);
680: pmap_extract(pmap_kernel(), (vaddr_t)fa, &pa);
681: DCFL(pa);
682: pmap_kremove((vaddr_t)vmmap, PAGE_SIZE);
683: pmap_update(pmap_kernel());
684: } else if ((f->f_ssw & (SSW4_RW|SSW4_TTMASK)) == SSW4_TTM16) {
685: /*
686: * MOVE16 fault.
687: * Line-align the address and write out the push data to
688: * the indicated virtual address.
689: */
690: #ifdef DEBUG
691: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid))
692: printf(" MOVE16 to VA %x(%x), data %x/%x/%x/%x\n",
693: f->f_fa, f->f_fa & ~0xF, f->f_pd0, f->f_pd1,
694: f->f_pd2, f->f_pd3);
695: if (f->f_wb1s & SSW4_WBSV)
696: panic("writeback: MOVE16 with WB1S valid");
697: wbstats.move16s++;
698: #endif
699: if (KDFAULT(f->f_wb1s))
700: bcopy((caddr_t)&f->f_pd0, (caddr_t)(f->f_fa & ~0xF), 16);
701: else
702: err = suline((caddr_t)(f->f_fa & ~0xF), (caddr_t)&f->f_pd0);
703: if (err) {
704: fa = f->f_fa & ~0xF;
705: #ifdef DEBUG
706: if (mmudebug & MDB_WBFAILED)
707: printf(wberrstr, p->p_pid, p->p_comm,
708: "MOVE16", fp->f_pc, f->f_fa,
709: f->f_fa & ~0xF, f->f_pd0);
710: #endif
711: }
712: } else if (f->f_wb1s & SSW4_WBSV) {
713: /*
714: * Writeback #1.
715: * Position the "memory-aligned" data and write it out.
716: */
717: u_int wb1d = f->f_wb1d;
718: int off;
719:
720: #ifdef DEBUG
721: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid))
722: dumpwb(1, f->f_wb1s, f->f_wb1a, f->f_wb1d);
723: wbstats.wb1s++;
724: wbstats.wbsize[(f->f_wb2s&SSW4_SZMASK)>>5]++;
725: #endif
726: off = (f->f_wb1a & 3) * 8;
727: switch (f->f_wb1s & SSW4_SZMASK) {
728: case SSW4_SZLW:
729: if (off)
730: wb1d = (wb1d >> (32 - off)) | (wb1d << off);
731: if (KDFAULT(f->f_wb1s))
732: *(long *)f->f_wb1a = wb1d;
733: else
734: err = copyout(&wb1d,
735: (caddr_t)f->f_wb1a, sizeof(int));
736: break;
737: case SSW4_SZB:
738: off = 24 - off;
739: if (off)
740: wb1d >>= off;
741: if (KDFAULT(f->f_wb1s))
742: *(char *)f->f_wb1a = wb1d;
743: else {
744: char tmp = wb1d;
745:
746: err = copyout(&tmp,
747: (caddr_t)f->f_wb1a, sizeof(char));
748: }
749: break;
750: case SSW4_SZW:
751: off = (off + 16) % 32;
752: if (off)
753: wb1d = (wb1d >> (32 - off)) | (wb1d << off);
754: if (KDFAULT(f->f_wb1s))
755: *(short *)f->f_wb1a = wb1d;
756: else {
757: short tmp = wb1d;
758:
759: err = copyout(&tmp,
760: (caddr_t)f->f_wb1a, sizeof(short));
761: }
762: break;
763: }
764: if (err) {
765: fa = f->f_wb1a;
766: #ifdef DEBUG
767: if (mmudebug & MDB_WBFAILED)
768: printf(wberrstr, p->p_pid, p->p_comm,
769: "#1", fp->f_pc, f->f_fa,
770: f->f_wb1a, f->f_wb1d);
771: #endif
772: }
773: }
774: /*
775: * Deal with the "normal" writebacks.
776: *
777: * XXX writeback2 is known to reflect a LINE size writeback after
778: * a MOVE16 was already dealt with above. Ignore it.
779: */
780: if (err == 0 && (f->f_wb2s & SSW4_WBSV) &&
781: (f->f_wb2s & SSW4_SZMASK) != SSW4_SZLN) {
782: #ifdef DEBUG
783: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid))
784: dumpwb(2, f->f_wb2s, f->f_wb2a, f->f_wb2d);
785: wbstats.wb2s++;
786: wbstats.wbsize[(f->f_wb2s&SSW4_SZMASK)>>5]++;
787: #endif
788: switch (f->f_wb2s & SSW4_SZMASK) {
789: case SSW4_SZLW:
790: if (KDFAULT(f->f_wb2s))
791: *(long *)f->f_wb2a = f->f_wb2d;
792: else
793: err = copyout(&f->f_wb2d,
794: (caddr_t)f->f_wb2a, sizeof(int));
795: break;
796: case SSW4_SZB:
797: if (KDFAULT(f->f_wb2s))
798: *(char *)f->f_wb2a = f->f_wb2d;
799: else {
800: char tmp = f->f_wb2d;
801:
802: err = copyout(&tmp,
803: (caddr_t)f->f_wb2a, sizeof(char));
804: }
805: break;
806: case SSW4_SZW:
807: if (KDFAULT(f->f_wb2s))
808: *(short *)f->f_wb2a = f->f_wb2d;
809: else {
810: short tmp = f->f_wb2d;
811:
812: err = copyout(&tmp,
813: (caddr_t)f->f_wb2a, sizeof(short));
814: }
815: break;
816: }
817: if (err) {
818: fa = f->f_wb2a;
819: #ifdef DEBUG
820: if (mmudebug & MDB_WBFAILED) {
821: printf(wberrstr, p->p_pid, p->p_comm,
822: "#2", fp->f_pc, f->f_fa,
823: f->f_wb2a, f->f_wb2d);
824: dumpssw(f->f_ssw);
825: dumpwb(2, f->f_wb2s, f->f_wb2a, f->f_wb2d);
826: }
827: #endif
828: }
829: }
830: if (err == 0 && (f->f_wb3s & SSW4_WBSV)) {
831: #ifdef DEBUG
832: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid))
833: dumpwb(3, f->f_wb3s, f->f_wb3a, f->f_wb3d);
834: wbstats.wb3s++;
835: wbstats.wbsize[(f->f_wb3s&SSW4_SZMASK)>>5]++;
836: #endif
837: switch (f->f_wb3s & SSW4_SZMASK) {
838: case SSW4_SZLW:
839: if (KDFAULT(f->f_wb3s))
840: *(long *)f->f_wb3a = f->f_wb3d;
841: else
842: err = copyout(&f->f_wb3d,
843: (caddr_t)f->f_wb3a, sizeof(int));
844: break;
845: case SSW4_SZB:
846: if (KDFAULT(f->f_wb3s))
847: *(char *)f->f_wb3a = f->f_wb3d;
848: else {
849: char tmp = f->f_wb3d;
850:
851: err = copyout(&tmp,
852: (caddr_t)f->f_wb3a, sizeof(char));
853: }
854: break;
855: case SSW4_SZW:
856: if (KDFAULT(f->f_wb3s))
857: *(short *)f->f_wb3a = f->f_wb3d;
858: else {
859: short tmp = f->f_wb3d;
860:
861: err = copyout(&tmp,
862: (caddr_t)f->f_wb3a, sizeof(short));
863: }
864: break;
865: #ifdef DEBUG
866: case SSW4_SZLN:
867: panic("writeback: wb3s indicates LINE write");
868: #endif
869: }
870: if (err) {
871: fa = f->f_wb3a;
872: #ifdef DEBUG
873: if (mmudebug & MDB_WBFAILED)
874: printf(wberrstr, p->p_pid, p->p_comm,
875: "#3", fp->f_pc, f->f_fa,
876: f->f_wb3a, f->f_wb3d);
877: #endif
878: }
879: }
880: p->p_addr->u_pcb.pcb_onfault = oonfault;
881: /*
882: * Any problems are SIGSEGV's
883: */
884: if (err)
885: err = SIGSEGV;
886: return (err);
887: }
888:
889: #ifdef DEBUG
890: void
891: dumpssw(ssw)
892: register u_short ssw;
893: {
894: printf(" SSW: %x: ", ssw);
895: if (ssw & SSW4_CP)
896: printf("CP,");
897: if (ssw & SSW4_CU)
898: printf("CU,");
899: if (ssw & SSW4_CT)
900: printf("CT,");
901: if (ssw & SSW4_CM)
902: printf("CM,");
903: if (ssw & SSW4_MA)
904: printf("MA,");
905: if (ssw & SSW4_ATC)
906: printf("ATC,");
907: if (ssw & SSW4_LK)
908: printf("LK,");
909: if (ssw & SSW4_RW)
910: printf("RW,");
911: printf(" SZ=%s, TT=%s, TM=%s\n",
912: f7sz[(ssw & SSW4_SZMASK) >> 5],
913: f7tt[(ssw & SSW4_TTMASK) >> 3],
914: f7tm[ssw & SSW4_TMMASK]);
915: }
916:
917: void
918: dumpwb(num, s, a, d)
919: int num;
920: u_short s;
921: u_int a, d;
922: {
923: register struct proc *p = curproc;
924: paddr_t pa;
925: int tmp;
926:
927: printf(" writeback #%d: VA %x, data %x, SZ=%s, TT=%s, TM=%s\n",
928: num, a, d, f7sz[(s & SSW4_SZMASK) >> 5],
929: f7tt[(s & SSW4_TTMASK) >> 3], f7tm[s & SSW4_TMMASK]);
930: printf(" PA ");
931: if (pmap_extract(p->p_vmspace->vm_map.pmap, (vaddr_t)a, &pa) == FALSE)
932: printf("<invalid address>");
933: else {
934: if (copyin((caddr_t)a, &tmp, sizeof(int)) == 0)
935: printf("%lx, current value %lx", pa, tmp);
936: else
937: printf("%lx, current value inaccessible", pa);
938: }
939: printf("\n");
940: }
941: #endif
942: #endif
943:
944: /*
945: * Process a system call.
946: */
947: void
948: syscall(code, frame)
949: register_t code;
950: struct frame frame;
951: {
952: register caddr_t params;
953: register struct sysent *callp;
954: register struct proc *p;
955: int error, opc, nsys;
956: size_t argsize;
957: register_t args[8], rval[2];
958: #ifdef COMPAT_SUNOS
959: extern struct emul emul_sunos;
960: #endif
961: uvmexp.syscalls++;
962:
963: if (!USERMODE(frame.f_sr))
964: panic("syscall");
965: p = curproc;
966: p->p_md.md_regs = frame.f_regs;
967: opc = frame.f_pc;
968:
969: nsys = p->p_emul->e_nsysent;
970: callp = p->p_emul->e_sysent;
971:
972: #ifdef COMPAT_SUNOS
973: if (p->p_emul == &emul_sunos) {
974: /*
975: * SunOS passes the syscall-number on the stack, whereas
976: * BSD passes it in D0. So, we have to get the real "code"
977: * from the stack, and clean up the stack, as SunOS glue
978: * code assumes the kernel pops the syscall argument the
979: * glue pushed on the stack. Sigh...
980: */
981: if (copyin((caddr_t)frame.f_regs[SP], &code,
982: sizeof(register_t)) != 0)
983: code = -1;
984:
985: /*
986: * XXX
987: * Don't do this for sunos_sigreturn, as there's no stored pc
988: * on the stack to skip, the argument follows the syscall
989: * number without a gap.
990: */
991: if (code != SUNOS_SYS_sigreturn) {
992: frame.f_regs[SP] += sizeof (int);
993: /*
994: * remember that we adjusted the SP,
995: * might have to undo this if the system call
996: * returns ERESTART.
997: */
998: p->p_md.md_flags |= MDP_STACKADJ;
999: } else
1000: p->p_md.md_flags &= ~MDP_STACKADJ;
1001: }
1002: #endif
1003:
1004: params = (caddr_t)frame.f_regs[SP] + sizeof(int);
1005:
1006: switch (code) {
1007: case SYS_syscall:
1008: /*
1009: * Code is first argument, followed by actual args.
1010: */
1011: if (copyin(params, &code, sizeof(register_t)) != 0)
1012: code = -1;
1013: params += sizeof(int);
1014: /*
1015: * XXX sigreturn requires special stack manipulation
1016: * that is only done if entered via the sigreturn
1017: * trap. Cannot allow it here so make sure we fail.
1018: */
1019: if (code == SYS_sigreturn)
1020: code = nsys;
1021: break;
1022: case SYS___syscall:
1023: /*
1024: * Like syscall, but code is a quad, so as to maintain
1025: * quad alignment for the rest of the arguments.
1026: */
1027: if (callp != sysent)
1028: break;
1029: if (copyin(params + _QUAD_LOWWORD * sizeof(int), &code,
1030: sizeof(register_t)) != 0)
1031: code = -1;
1032: params += sizeof(quad_t);
1033: break;
1034: default:
1035: break;
1036: }
1037: if (code < 0 || code >= nsys)
1038: callp += p->p_emul->e_nosys; /* illegal */
1039: else
1040: callp += code;
1041: argsize = callp->sy_argsize;
1042: if (argsize)
1043: error = copyin(params, (caddr_t)args, argsize);
1044: else
1045: error = 0;
1046: #ifdef SYSCALL_DEBUG
1047: scdebug_call(p, code, args);
1048: #endif
1049: #ifdef KTRACE
1050: if (KTRPOINT(p, KTR_SYSCALL))
1051: ktrsyscall(p, code, argsize, args);
1052: #endif
1053: if (error)
1054: goto bad;
1055: rval[0] = 0;
1056: rval[1] = frame.f_regs[D1];
1057: #if NSYSTRACE > 0
1058: if (ISSET(p->p_flag, P_SYSTRACE))
1059: error = systrace_redirect(code, p, args, rval);
1060: else
1061: #endif
1062: error = (*callp->sy_call)(p, args, rval);
1063: switch (error) {
1064: case 0:
1065: frame.f_regs[D0] = rval[0];
1066: frame.f_regs[D1] = rval[1];
1067: frame.f_sr &= ~PSL_C; /* carry bit */
1068: break;
1069: case ERESTART:
1070: /*
1071: * We always enter through a `trap' instruction, which is 2
1072: * bytes, so adjust the pc by that amount.
1073: */
1074: frame.f_pc = opc - 2;
1075: break;
1076: case EJUSTRETURN:
1077: /* nothing to do */
1078: break;
1079: default:
1080: bad:
1081: if (p->p_emul->e_errno)
1082: error = p->p_emul->e_errno[error];
1083: frame.f_regs[D0] = error;
1084: frame.f_sr |= PSL_C; /* carry bit */
1085: break;
1086: }
1087:
1088: #ifdef SYSCALL_DEBUG
1089: scdebug_ret(p, code, error, rval);
1090: #endif
1091: #ifdef COMPAT_SUNOS
1092: /* need new p-value for this */
1093: if (error == ERESTART && (p->p_md.md_flags & MDP_STACKADJ))
1094: frame.f_regs[SP] -= sizeof (int);
1095: #endif
1096: userret(p);
1097: #ifdef KTRACE
1098: if (KTRPOINT(p, KTR_SYSRET))
1099: ktrsysret(p, code, error, rval[0]);
1100: #endif
1101: }
1102:
1103: /*
1104: * Allocation routines for software interrupts.
1105: */
1106: u_int8_t
1107: allocate_sir(proc, arg)
1108: void (*proc)(void *);
1109: void *arg;
1110: {
1111: int bit;
1112:
1113: if (next_sir >= NSIR)
1114: panic("allocate_sir: none left");
1115: bit = next_sir++;
1116: sir_routines[bit] = proc;
1117: sir_args[bit] = arg;
1118: return (1 << bit);
1119: }
1120:
1121: typedef SLIST_HEAD(,intrhand) intrhand_t;
1122: intrhand_t intrs[NVMEINTR];
1123:
1124: void
1125: init_intrs()
1126: {
1127: int i;
1128: extern void netintr(void *);
1129:
1130: /* hard interrupts... */
1131: for (i = 0; i < NVMEINTR; i++)
1132: SLIST_INIT(&intrs[i]);
1133:
1134: /* soft interrupts... */
1135: sir_routines[0] = netintr;
1136: sir_routines[1] = (void (*)(void *))softclock;
1137: next_sir = 2;
1138: }
1139:
1140: void
1141: hardintr(pc, evec, frame)
1142: int pc;
1143: int evec;
1144: void *frame;
1145: {
1146: extern void straytrap(int, u_short);
1147: int vec = (evec & 0xfff) >> 2; /* XXX should be m68k macro? */
1148: struct intrhand *ih;
1149: intrhand_t *list;
1150: int count = 0;
1151: int r;
1152:
1153: uvmexp.intrs++;
1154:
1155: list = &intrs[vec];
1156: if (SLIST_EMPTY(list)) {
1157: straytrap(pc, evec);
1158: } else {
1159: SLIST_FOREACH(ih, list, ih_link) {
1160: r = (*ih->ih_fn)(ih->ih_wantframe ? frame : ih->ih_arg);
1161: if (r != 0) {
1162: ih->ih_count.ec_count++;
1163: count++;
1164: }
1165: }
1166:
1167: if (count == 0) {
1168: printf("Unclaimed interrupt (vector %d) from %x\n",
1169: evec, pc);
1170: }
1171: }
1172: }
1173:
1174: /*
1175: * find a useable interrupt vector in the range start, end. It starts at
1176: * the end of the range, and searches backwards (to increase the chances
1177: * of not conflicting with more normal users)
1178: */
1179: int
1180: intr_findvec(start, end)
1181: int start, end;
1182: {
1183: extern u_long *vectab[], hardtrap, badtrap;
1184: int vec;
1185:
1186: if (start < 0 || end >= NVMEINTR || start > end)
1187: return (-1);
1188: for (vec = end; vec > start; --vec)
1189: if (vectab[vec] == &badtrap || vectab[vec] == &hardtrap)
1190: return (vec);
1191: return (-1);
1192: }
1193:
1194: /*
1195: * Chain the interrupt handler in. But first check if the vector
1196: * offset chosen is legal. It either must be a badtrap (not allocated
1197: * for a `system' purpose), or it must be a hardtrap (ie. already
1198: * allocated to deal with chained interrupt handlers).
1199: */
1200: int
1201: intr_establish(vec, ih, name)
1202: int vec;
1203: struct intrhand *ih;
1204: const char *name;
1205: {
1206: extern u_long *vectab[], hardtrap, badtrap;
1207: struct intrhand *intr;
1208: intrhand_t *list;
1209:
1210: #ifdef DIAGNOSTIC
1211: if (vec < 0 || vec >= NVMEINTR) {
1212: panic("intr_establish: vec (0x%x) out of bounds", vec);
1213: return (-1);
1214: }
1215: #endif
1216:
1217: if (vectab[vec] != &badtrap && vectab[vec] != &hardtrap) {
1218: #ifdef DIAGNOSTIC
1219: panic("intr_establish: vec (%x) unavailable for devices", vec);
1220: #endif
1221: return (-1);
1222: }
1223: vectab[vec] = &hardtrap;
1224:
1225: list = &intrs[vec];
1226: if (!SLIST_EMPTY(list)) {
1227: intr = SLIST_FIRST(list);
1228: if (intr->ih_ipl != ih->ih_ipl) {
1229: #ifdef DIAGNOSTIC
1230: panic("intr_establish: there are other handlers with "
1231: "vec (0x%x) at ipl %x, but you want it at %x",
1232: vec, intr->ih_ipl, ih->ih_ipl);
1233: #endif
1234: return (-1);
1235: }
1236: }
1237:
1238: evcount_attach(&ih->ih_count, name, &ih->ih_ipl, &evcount_intr);
1239: SLIST_INSERT_HEAD(list, ih, ih_link);
1240: return (0);
1241: }
1242:
1243: #ifdef DDB
1244: #include <sys/reboot.h>
1245: #include <machine/db_machdep.h>
1246: #include <ddb/db_command.h>
1247:
1248: void db_prom_cmd(db_expr_t, int, db_expr_t, char *);
1249: void db_machine_init(void);
1250:
1251: /* ARGSUSED */
1252: void
1253: db_prom_cmd(addr, have_addr, count, modif)
1254: db_expr_t addr;
1255: int have_addr;
1256: db_expr_t count;
1257: char *modif;
1258: {
1259: doboot();
1260: }
1261:
1262: struct db_command db_machine_cmds[] = {
1263: { "prom", db_prom_cmd, 0, 0},
1264: { (char *)0,}
1265: };
1266:
1267: void
1268: db_machine_init()
1269: {
1270: db_machine_commands_install(db_machine_cmds);
1271: }
1272: #endif /* DDB */
CVSweb