2 * Copyright (c) 2014 Andrew Turner
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28 #include <sys/cdefs.h>
29 __FBSDID("$FreeBSD$");
31 #include <sys/param.h>
32 #include <sys/systm.h>
33 #include <sys/kernel.h>
35 #include <sys/mutex.h>
36 #include <sys/pioctl.h>
38 #include <sys/ptrace.h>
39 #include <sys/syscall.h>
40 #include <sys/sysent.h>
47 #include <vm/vm_kern.h>
48 #include <vm/vm_map.h>
49 #include <vm/vm_param.h>
50 #include <vm/vm_extern.h>
52 #include <machine/frame.h>
53 #include <machine/pcb.h>
54 #include <machine/pcpu.h>
55 #include <machine/undefined.h>
58 #include <sys/dtrace_bsd.h>
62 #include <machine/vfp.h>
66 #include <machine/db_machdep.h>
70 #include <ddb/db_output.h>
73 extern register_t fsu_intr_fault;
75 /* Called from exception.S */
76 void do_el1h_sync(struct thread *, struct trapframe *);
77 void do_el0_sync(struct thread *, struct trapframe *);
78 void do_el0_error(struct trapframe *);
79 static void print_registers(struct trapframe *frame);
81 int (*dtrace_invop_jump_addr)(struct trapframe *);
84 call_trapsignal(struct thread *td, int sig, int code, void *addr)
88 ksiginfo_init_trap(&ksi);
96 cpu_fetch_syscall_args(struct thread *td)
100 struct syscall_args *sa;
105 ap = td->td_frame->tf_x;
108 sa->code = td->td_frame->tf_x[8];
110 if (sa->code == SYS_syscall || sa->code == SYS___syscall) {
115 if (p->p_sysent->sv_mask)
116 sa->code &= p->p_sysent->sv_mask;
117 if (sa->code >= p->p_sysent->sv_size)
118 sa->callp = &p->p_sysent->sv_table[0];
120 sa->callp = &p->p_sysent->sv_table[sa->code];
122 sa->narg = sa->callp->sy_narg;
123 memcpy(sa->args, ap, nap * sizeof(register_t));
125 panic("ARM64TODO: Could we have more than 8 args?");
127 td->td_retval[0] = 0;
128 td->td_retval[1] = 0;
133 #include "../../kern/subr_syscall.c"
136 svc_handler(struct thread *td, struct trapframe *frame)
140 if ((frame->tf_esr & ESR_ELx_ISS_MASK) == 0) {
141 error = syscallenter(td);
142 syscallret(td, error);
144 call_trapsignal(td, SIGILL, ILL_ILLOPN, (void *)frame->tf_elr);
150 data_abort(struct thread *td, struct trapframe *frame, uint64_t esr,
151 uint64_t far, int lower)
158 int error, sig, ucode;
164 * According to the ARMv8-A rev. A.g, B2.10.5 "Load-Exclusive
165 * and Store-Exclusive instruction usage restrictions", state
166 * of the exclusive monitors after data abort exception is unknown.
180 map = &p->p_vmspace->vm_map;
182 /* The top bit tells us which range to use */
183 if (far >= VM_MAXUSER_ADDRESS) {
186 map = &p->p_vmspace->vm_map;
193 * We may fault from userspace or when in a DMAP region due to
194 * a superpage being unmapped when the access took place. In these
195 * cases we need to wait for the pmap to be unlocked and check
196 * if the translation is still invalid.
198 if (map != kernel_map || VIRT_IN_DMAP(far)) {
199 if (pmap_fault(map->pmap, esr, far) == KERN_SUCCESS)
203 KASSERT(td->td_md.md_spinlock_count == 0,
204 ("data abort with spinlock held"));
205 if (td->td_critnest != 0 || WITNESS_CHECK(WARN_SLEEPOK |
206 WARN_GIANTOK, NULL, "Kernel page fault") != 0) {
207 print_registers(frame);
208 printf(" far: %16lx\n", far);
209 printf(" esr: %.8lx\n", esr);
210 panic("data abort in critical section or under mutex");
213 va = trunc_page(far);
214 ftype = ((esr >> 6) & 1) ? VM_PROT_READ | VM_PROT_WRITE : VM_PROT_READ;
216 /* Fault in the page. */
217 error = vm_fault(map, va, ftype, VM_FAULT_NORMAL);
218 if (error != KERN_SUCCESS) {
221 if (error == KERN_PROTECTION_FAILURE)
225 call_trapsignal(td, sig, ucode, (void *)far);
227 if (td->td_intr_nesting_level == 0 &&
228 pcb->pcb_onfault != 0) {
229 frame->tf_x[0] = error;
230 frame->tf_elr = pcb->pcb_onfault;
234 printf("Fatal data abort:\n");
235 print_registers(frame);
236 printf(" far: %16lx\n", far);
237 printf(" esr: %.8lx\n", esr);
240 if (debugger_on_panic) {
241 kdb_why = KDB_WHY_TRAP;
242 handled = kdb_trap(ESR_ELx_EXCEPTION(esr), 0,
244 kdb_why = KDB_WHY_UNSET;
249 panic("vm_fault failed: %lx", frame->tf_elr);
258 print_registers(struct trapframe *frame)
262 for (reg = 0; reg < nitems(frame->tf_x); reg++) {
263 printf(" %sx%d: %16lx\n", (reg < 10) ? " " : "", reg,
266 printf(" sp: %16lx\n", frame->tf_sp);
267 printf(" lr: %16lx\n", frame->tf_lr);
268 printf(" elr: %16lx\n", frame->tf_elr);
269 printf("spsr: %8x\n", frame->tf_spsr);
273 do_el1h_sync(struct thread *td, struct trapframe *frame)
275 struct trapframe *oframe;
279 /* Read the esr register to get the exception details */
281 exception = ESR_ELx_EXCEPTION(esr);
284 if (dtrace_trap_func != NULL && (*dtrace_trap_func)(frame, exception))
289 "do_el1_sync: curthread: %p, esr %lx, elr: %lx, frame: %p", td,
290 esr, frame->tf_elr, frame);
292 oframe = td->td_frame;
296 case EXCP_WATCHPT_EL1:
297 case EXCP_SOFTSTP_EL1:
300 td->td_frame = frame;
308 if ((td->td_pcb->pcb_fpflags & PCB_FP_KERN) != 0) {
313 print_registers(frame);
314 printf(" esr: %.8lx\n", esr);
315 panic("VFP exception in the kernel");
318 case EXCP_INSN_ABORT:
319 case EXCP_DATA_ABORT:
320 far = READ_SPECIALREG(far_el1);
322 data_abort(td, frame, esr, far, 0);
326 if ((esr & ESR_ELx_ISS_MASK) == 0x40d && \
327 dtrace_invop_jump_addr != 0) {
328 dtrace_invop_jump_addr(frame);
333 kdb_trap(exception, 0,
334 (td->td_frame != NULL) ? td->td_frame : frame);
336 panic("No debugger in kernel.\n");
340 case EXCP_WATCHPT_EL1:
341 case EXCP_SOFTSTP_EL1:
343 kdb_trap(exception, 0,
344 (td->td_frame != NULL) ? td->td_frame : frame);
346 panic("No debugger in kernel.\n");
350 if (undef_insn(1, frame))
354 print_registers(frame);
355 panic("Unknown kernel exception %x esr_el1 %lx\n", exception,
359 td->td_frame = oframe;
363 do_el0_sync(struct thread *td, struct trapframe *frame)
365 pcpu_bp_harden bp_harden;
369 /* Check we have a sane environment when entering from userland */
370 KASSERT((uintptr_t)get_pcpu() >= VM_MIN_KERNEL_ADDRESS,
371 ("Invalid pcpu address from userland: %p (tpidr %lx)",
372 get_pcpu(), READ_SPECIALREG(tpidr_el1)));
375 exception = ESR_ELx_EXCEPTION(esr);
377 case EXCP_INSN_ABORT_L:
378 far = READ_SPECIALREG(far_el1);
381 * Userspace may be trying to train the branch predictor to
382 * attack the kernel. If we are on a CPU affected by this
383 * call the handler to clear the branch predictor state.
385 if (far > VM_MAXUSER_ADDRESS) {
386 bp_harden = PCPU_GET(bp_harden);
387 if (bp_harden != NULL)
392 case EXCP_DATA_ABORT_L:
393 case EXCP_DATA_ABORT:
394 far = READ_SPECIALREG(far_el1);
400 "do_el0_sync: curthread: %p, esr %lx, elr: %lx, frame: %p", td, esr,
401 frame->tf_elr, frame);
409 panic("VFP exception in userland");
414 svc_handler(td, frame);
416 case EXCP_INSN_ABORT_L:
417 case EXCP_DATA_ABORT_L:
418 case EXCP_DATA_ABORT:
419 data_abort(td, frame, esr, far, 1);
422 if (!undef_insn(0, frame))
423 call_trapsignal(td, SIGILL, ILL_ILLTRP, (void *)far);
427 call_trapsignal(td, SIGBUS, BUS_ADRALN, (void *)frame->tf_sp);
431 call_trapsignal(td, SIGBUS, BUS_ADRALN, (void *)frame->tf_elr);
435 call_trapsignal(td, SIGTRAP, TRAP_BRKPT, (void *)frame->tf_elr);
439 call_trapsignal(td, SIGILL, ILL_PRVOPC, (void *)frame->tf_elr);
442 case EXCP_SOFTSTP_EL0:
443 td->td_frame->tf_spsr &= ~PSR_SS;
444 td->td_pcb->pcb_flags &= ~PCB_SINGLE_STEP;
445 WRITE_SPECIALREG(MDSCR_EL1,
446 READ_SPECIALREG(MDSCR_EL1) & ~DBG_MDSCR_SS);
447 call_trapsignal(td, SIGTRAP, TRAP_TRACE,
448 (void *)frame->tf_elr);
452 call_trapsignal(td, SIGBUS, BUS_OBJERR, (void *)frame->tf_elr);
457 KASSERT((td->td_pcb->pcb_fpflags & ~PCB_FP_USERMASK) == 0,
458 ("Kernel VFP flags set while entering userspace"));
460 td->td_pcb->pcb_fpusaved == &td->td_pcb->pcb_fpustate,
461 ("Kernel VFP state in use when entering userspace"));
465 do_el0_error(struct trapframe *frame)
468 panic("ARM64TODO: do_el0_error");