1 /* $NetBSD: fault.c,v 1.45 2003/11/20 14:44:36 scw Exp $ */ 2 3 /*- 4 * Copyright 2004 Olivier Houchard 5 * Copyright 2003 Wasabi Systems, Inc. 6 * All rights reserved. 7 * 8 * Written by Steve C. Woodford for Wasabi Systems, Inc. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 3. All advertising materials mentioning features or use of this software 19 * must display the following acknowledgement: 20 * This product includes software developed for the NetBSD Project by 21 * Wasabi Systems, Inc. 22 * 4. The name of Wasabi Systems, Inc. may not be used to endorse 23 * or promote products derived from this software without specific prior 24 * written permission. 25 * 26 * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND 27 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 28 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 29 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC 30 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 31 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 32 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 33 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 34 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 35 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 36 * POSSIBILITY OF SUCH DAMAGE. 37 */ 38 /*- 39 * Copyright (c) 1994-1997 Mark Brinicombe. 40 * Copyright (c) 1994 Brini. 41 * All rights reserved. 42 * 43 * This code is derived from software written for Brini by Mark Brinicombe 44 * 45 * Redistribution and use in source and binary forms, with or without 46 * modification, are permitted provided that the following conditions 47 * are met: 48 * 1. Redistributions of source code must retain the above copyright 49 * notice, this list of conditions and the following disclaimer. 50 * 2. Redistributions in binary form must reproduce the above copyright 51 * notice, this list of conditions and the following disclaimer in the 52 * documentation and/or other materials provided with the distribution. 53 * 3. All advertising materials mentioning features or use of this software 54 * must display the following acknowledgement: 55 * This product includes software developed by Brini. 56 * 4. The name of the company nor the name of the author may be used to 57 * endorse or promote products derived from this software without specific 58 * prior written permission. 59 * 60 * THIS SOFTWARE IS PROVIDED BY BRINI ``AS IS'' AND ANY EXPRESS OR IMPLIED 61 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 62 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 63 * IN NO EVENT SHALL BRINI OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, 64 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 65 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 66 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 67 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 68 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 69 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 70 * SUCH DAMAGE. 71 * 72 * RiscBSD kernel project 73 * 74 * fault.c 75 * 76 * Fault handlers 77 * 78 * Created : 28/11/94 79 */ 80 81 82 #include <sys/cdefs.h> 83 __FBSDID("$FreeBSD$"); 84 85 #include <sys/param.h> 86 #include <sys/systm.h> 87 #include <sys/kernel.h> 88 #include <sys/proc.h> 89 #include <sys/lock.h> 90 #include <sys/mutex.h> 91 #include <sys/syscall.h> 92 #include <sys/sysent.h> 93 #include <sys/signalvar.h> 94 #include <sys/ptrace.h> 95 #include <sys/pioctl.h> 96 97 #include <machine/frame.h> 98 99 void swi_handler(struct trapframe *); 100 101 static __inline void 102 call_trapsignal(struct thread *td, int sig, u_long code) 103 { 104 ksiginfo_t ksi; 105 106 ksiginfo_init_trap(&ksi); 107 ksi.ksi_signo = sig; 108 ksi.ksi_code = (int)code; 109 trapsignal(td, &ksi); 110 } 111 112 int 113 cpu_fetch_syscall_args(struct thread *td, struct syscall_args *sa) 114 { 115 struct proc *p; 116 register_t *ap; 117 int error; 118 119 sa->code = td->td_frame->tf_r7; 120 ap = &td->td_frame->tf_r0; 121 if (sa->code == SYS_syscall) { 122 sa->code = *ap++; 123 sa->nap--; 124 } else if (sa->code == SYS___syscall) { 125 sa->code = ap[_QUAD_LOWWORD]; 126 sa->nap -= 2; 127 ap += 2; 128 } 129 p = td->td_proc; 130 if (p->p_sysent->sv_mask) 131 sa->code &= p->p_sysent->sv_mask; 132 if (sa->code >= p->p_sysent->sv_size) 133 sa->callp = &p->p_sysent->sv_table[0]; 134 else 135 sa->callp = &p->p_sysent->sv_table[sa->code]; 136 sa->narg = sa->callp->sy_narg; 137 error = 0; 138 memcpy(sa->args, ap, sa->nap * sizeof(register_t)); 139 if (sa->narg > sa->nap) { 140 error = copyin((void *)td->td_frame->tf_usr_sp, sa->args + 141 sa->nap, (sa->narg - sa->nap) * sizeof(register_t)); 142 } 143 if (error == 0) { 144 td->td_retval[0] = 0; 145 td->td_retval[1] = 0; 146 } 147 return (error); 148 } 149 150 #include "../../kern/subr_syscall.c" 151 152 static void 153 syscall(struct thread *td, struct trapframe *frame) 154 { 155 struct syscall_args sa; 156 int error; 157 158 sa.nap = 4; 159 160 error = syscallenter(td, &sa); 161 KASSERT(error != 0 || td->td_ar == NULL, 162 ("returning from syscall with td_ar set!")); 163 syscallret(td, error, &sa); 164 } 165 166 void 167 swi_handler(struct trapframe *frame) 168 { 169 struct thread *td = curthread; 170 171 td->td_frame = frame; 172 173 td->td_pticks = 0; 174 /* 175 * Make sure the program counter is correctly aligned so we 176 * don't take an alignment fault trying to read the opcode. 177 * XXX: Fix for Thumb mode 178 */ 179 if (__predict_false(((frame->tf_pc - INSN_SIZE) & 3) != 0)) { 180 call_trapsignal(td, SIGILL, 0); 181 userret(td, frame); 182 return; 183 } 184 /* 185 * Enable interrupts if they were enabled before the exception. 186 * Since all syscalls *should* come from user mode it will always 187 * be safe to enable them, but check anyway. 188 */ 189 if (td->td_md.md_spinlock_count == 0) { 190 if (__predict_true(frame->tf_spsr & PSR_I) == 0) 191 enable_interrupts(PSR_I); 192 if (__predict_true(frame->tf_spsr & PSR_F) == 0) 193 enable_interrupts(PSR_F); 194 } 195 196 syscall(td, frame); 197 } 198