2 * Copyright (c) 2015-2018 Ruslan Bukin <br@bsdpad.com>
5 * Portions of this software were developed by SRI International and the
6 * University of Cambridge Computer Laboratory under DARPA/AFRL contract
7 * FA8750-10-C-0237 ("CTSRD"), as part of the DARPA CRASH research programme.
9 * Portions of this software were developed by the University of Cambridge
10 * Computer Laboratory as part of the CTSRD Project, with support from the
11 * UK Higher Education Innovation Fund (HEIF).
13 * Redistribution and use in source and binary forms, with or without
14 * modification, are permitted provided that the following conditions
16 * 1. Redistributions of source code must retain the above copyright
17 * notice, this list of conditions and the following disclaimer.
18 * 2. Redistributions in binary form must reproduce the above copyright
19 * notice, this list of conditions and the following disclaimer in the
20 * documentation and/or other materials provided with the distribution.
22 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
23 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
26 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
28 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
35 #include <sys/cdefs.h>
36 __FBSDID("$FreeBSD$");
38 #include <sys/param.h>
39 #include <sys/systm.h>
40 #include <sys/kernel.h>
43 #include <sys/mutex.h>
46 #include <sys/ptrace.h>
47 #include <sys/syscall.h>
48 #include <sys/sysent.h>
55 #include <vm/vm_kern.h>
56 #include <vm/vm_map.h>
57 #include <vm/vm_param.h>
58 #include <vm/vm_extern.h>
61 #include <machine/fpe.h>
63 #include <machine/frame.h>
64 #include <machine/pcb.h>
65 #include <machine/pcpu.h>
67 #include <machine/resource.h>
68 #include <machine/intr.h>
71 #include <sys/dtrace_bsd.h>
74 int (*dtrace_invop_jump_addr)(struct trapframe *);
76 extern register_t fsu_intr_fault;
78 /* Called from exception.S */
79 void do_trap_supervisor(struct trapframe *);
80 void do_trap_user(struct trapframe *);
83 call_trapsignal(struct thread *td, int sig, int code, void *addr, int trapno)
87 ksiginfo_init_trap(&ksi);
91 ksi.ksi_trapno = trapno;
96 cpu_fetch_syscall_args(struct thread *td)
100 struct syscall_args *sa;
106 ap = &td->td_frame->tf_a[0];
108 sa->code = td->td_frame->tf_t[0];
110 if (sa->code == SYS_syscall || sa->code == SYS___syscall) {
115 if (sa->code >= p->p_sysent->sv_size)
116 sa->callp = &p->p_sysent->sv_table[0];
118 sa->callp = &p->p_sysent->sv_table[sa->code];
120 memcpy(sa->args, ap, nap * sizeof(register_t));
121 if (sa->callp->sy_narg > nap)
122 panic("TODO: Could we have more then %d args?", NARGREG);
124 td->td_retval[0] = 0;
125 td->td_retval[1] = 0;
130 #include "../../kern/subr_syscall.c"
133 dump_regs(struct trapframe *frame)
138 n = nitems(frame->tf_t);
139 for (i = 0; i < n; i++)
140 printf("t[%d] == 0x%016lx\n", i, frame->tf_t[i]);
142 n = nitems(frame->tf_s);
143 for (i = 0; i < n; i++)
144 printf("s[%d] == 0x%016lx\n", i, frame->tf_s[i]);
146 n = nitems(frame->tf_a);
147 for (i = 0; i < n; i++)
148 printf("a[%d] == 0x%016lx\n", i, frame->tf_a[i]);
150 printf("ra == 0x%016lx\n", frame->tf_ra);
151 printf("sp == 0x%016lx\n", frame->tf_sp);
152 printf("gp == 0x%016lx\n", frame->tf_gp);
153 printf("tp == 0x%016lx\n", frame->tf_tp);
155 printf("sepc == 0x%016lx\n", frame->tf_sepc);
156 printf("sstatus == 0x%016lx\n", frame->tf_sstatus);
160 svc_handler(struct trapframe *frame)
165 td->td_frame = frame;
172 data_abort(struct trapframe *frame, int usermode)
181 int error, sig, ucode;
193 stval = frame->tf_stval;
195 if (td->td_critnest != 0 || td->td_intr_nesting_level != 0 ||
196 WITNESS_CHECK(WARN_SLEEPOK | WARN_GIANTOK, NULL,
197 "Kernel page fault") != 0)
201 map = &td->td_proc->p_vmspace->vm_map;
204 * Enable interrupts for the duration of the page fault. For
205 * user faults this was done already in do_trap_user().
209 if (stval >= VM_MAX_USER_ADDRESS) {
212 if (pcb->pcb_onfault == 0)
214 map = &td->td_proc->p_vmspace->vm_map;
218 va = trunc_page(stval);
220 if ((frame->tf_scause == EXCP_FAULT_STORE) ||
221 (frame->tf_scause == EXCP_STORE_PAGE_FAULT)) {
222 ftype = VM_PROT_WRITE;
223 } else if (frame->tf_scause == EXCP_INST_PAGE_FAULT) {
224 ftype = VM_PROT_EXECUTE;
226 ftype = VM_PROT_READ;
229 if (pmap_fault_fixup(map->pmap, va, ftype))
232 error = vm_fault_trap(map, va, ftype, VM_FAULT_NORMAL, &sig, &ucode);
233 if (error != KERN_SUCCESS) {
235 call_trapsignal(td, sig, ucode, (void *)stval,
236 frame->tf_scause & EXCP_MASK);
238 if (pcb->pcb_onfault != 0) {
239 frame->tf_a[0] = error;
240 frame->tf_sepc = pcb->pcb_onfault;
254 panic("Fatal page fault at %#lx: %#016lx", frame->tf_sepc, stval);
258 do_trap_supervisor(struct trapframe *frame)
262 /* Ensure we came from supervisor mode, interrupts disabled */
263 KASSERT((csr_read(sstatus) & (SSTATUS_SPP | SSTATUS_SIE)) ==
264 SSTATUS_SPP, ("Came from S mode with interrupts enabled"));
266 exception = frame->tf_scause & EXCP_MASK;
267 if (frame->tf_scause & EXCP_INTR) {
269 riscv_cpu_intr(frame);
274 if (dtrace_trap_func != NULL && (*dtrace_trap_func)(frame, exception))
278 CTR3(KTR_TRAP, "do_trap_supervisor: curthread: %p, sepc: %lx, frame: %p",
279 curthread, frame->tf_sepc, frame);
282 case EXCP_FAULT_LOAD:
283 case EXCP_FAULT_STORE:
284 case EXCP_FAULT_FETCH:
285 case EXCP_STORE_PAGE_FAULT:
286 case EXCP_LOAD_PAGE_FAULT:
287 data_abort(frame, 0);
289 case EXCP_BREAKPOINT:
291 if (dtrace_invop_jump_addr != NULL &&
292 dtrace_invop_jump_addr(frame) == 0)
296 kdb_trap(exception, 0, frame);
299 panic("No debugger in kernel.\n");
302 case EXCP_ILLEGAL_INSTRUCTION:
304 panic("Illegal instruction at 0x%016lx\n", frame->tf_sepc);
308 panic("Unknown kernel exception %lx trap value %lx\n",
309 exception, frame->tf_stval);
314 do_trap_user(struct trapframe *frame)
321 td->td_frame = frame;
324 /* Ensure we came from usermode, interrupts disabled */
325 KASSERT((csr_read(sstatus) & (SSTATUS_SPP | SSTATUS_SIE)) == 0,
326 ("Came from U mode with interrupts enabled"));
328 exception = frame->tf_scause & EXCP_MASK;
329 if (frame->tf_scause & EXCP_INTR) {
331 riscv_cpu_intr(frame);
336 CTR3(KTR_TRAP, "do_trap_user: curthread: %p, sepc: %lx, frame: %p",
337 curthread, frame->tf_sepc, frame);
340 case EXCP_FAULT_LOAD:
341 case EXCP_FAULT_STORE:
342 case EXCP_FAULT_FETCH:
343 case EXCP_STORE_PAGE_FAULT:
344 case EXCP_LOAD_PAGE_FAULT:
345 case EXCP_INST_PAGE_FAULT:
346 data_abort(frame, 1);
348 case EXCP_USER_ECALL:
349 frame->tf_sepc += 4; /* Next instruction */
352 case EXCP_ILLEGAL_INSTRUCTION:
354 if ((pcb->pcb_fpflags & PCB_FP_STARTED) == 0) {
356 * May be a FPE trap. Enable FPE usage
357 * for this thread and try again.
360 frame->tf_sstatus &= ~SSTATUS_FS_MASK;
361 frame->tf_sstatus |= SSTATUS_FS_CLEAN;
362 pcb->pcb_fpflags |= PCB_FP_STARTED;
366 call_trapsignal(td, SIGILL, ILL_ILLTRP, (void *)frame->tf_sepc,
370 case EXCP_BREAKPOINT:
371 call_trapsignal(td, SIGTRAP, TRAP_BRKPT, (void *)frame->tf_sepc,
377 panic("Unknown userland exception %lx, trap value %lx\n",
378 exception, frame->tf_stval);