trap.c revision 1.126 1 /* $NetBSD: trap.c,v 1.126 2025/09/19 16:54:20 skrll Exp $ */
2
3 /*-
4 * Copyright (c) 2001, 2002 The NetBSD Foundation, Inc.
5 * All rights reserved.
6 *
7 * This code is derived from software contributed to The NetBSD Foundation
8 * by Matthew Fredette.
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 *
19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 * POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 /* $OpenBSD: trap.c,v 1.30 2001/09/19 20:50:56 mickey Exp $ */
33
34 /*
35 * Copyright (c) 1998-2004 Michael Shalayeff
36 * All rights reserved.
37 *
38 * Redistribution and use in source and binary forms, with or without
39 * modification, are permitted provided that the following conditions
40 * are met:
41 * 1. Redistributions of source code must retain the above copyright
42 * notice, this list of conditions and the following disclaimer.
43 * 2. Redistributions in binary form must reproduce the above copyright
44 * notice, this list of conditions and the following disclaimer in the
45 * documentation and/or other materials provided with the distribution.
46 *
47 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
48 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
49 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
50 * IN NO EVENT SHALL THE AUTHOR OR HIS RELATIVES BE LIABLE FOR ANY DIRECT,
51 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
52 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
53 * SERVICES; LOSS OF MIND, USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
54 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
55 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
56 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
57 * THE POSSIBILITY OF SUCH DAMAGE.
58 */
59
60 #include <sys/cdefs.h>
61 __KERNEL_RCSID(0, "$NetBSD: trap.c,v 1.126 2025/09/19 16:54:20 skrll Exp $");
62
63 /* #define INTRDEBUG */
64 /* #define TRAPDEBUG */
65 /* #define USERTRACE */
66
67 #include "opt_kgdb.h"
68 #include "opt_ptrace.h"
69
70 #include <sys/param.h>
71 #include <sys/systm.h>
72 #include <sys/kernel.h>
73 #include <sys/syscall.h>
74 #include <sys/syscallvar.h>
75 #include <sys/mutex.h>
76 #include <sys/ktrace.h>
77 #include <sys/proc.h>
78 #include <sys/signalvar.h>
79 #include <sys/acct.h>
80 #include <sys/signal.h>
81 #include <sys/device.h>
82 #include <sys/kauth.h>
83 #include <sys/kmem.h>
84 #include <sys/userret.h>
85
86 #ifdef KGDB
87 #include <sys/kgdb.h>
88 #endif
89
90 #include <uvm/uvm.h>
91
92 #include <machine/iomod.h>
93 #include <machine/cpufunc.h>
94 #include <machine/reg.h>
95 #include <machine/autoconf.h>
96
97 #include <machine/db_machdep.h>
98
99 #include <hppa/hppa/machdep.h>
100
101 #include <ddb/db_output.h>
102 #include <ddb/db_interface.h>
103
104 #ifdef PTRACE
105 void ss_clear_breakpoints(struct lwp *l);
106 int ss_put_value(struct lwp *, vaddr_t, u_int);
107 int ss_get_value(struct lwp *, vaddr_t, u_int *);
108
109 /* single-step breakpoint */
110 #define SSBREAKPOINT (HPPA_BREAK_KERNEL | (HPPA_BREAK_SS << 13))
111
112 #endif
113
114 #if defined(DEBUG) || defined(DIAGNOSTIC)
115 /*
116 * 0x6fc1000 is a stwm r1, d(sr0, sp), which is the last
117 * instruction in the function prologue that gcc -O0 uses.
118 * When we have this instruction we know the relationship
119 * between the stack pointer and the gcc -O0 frame pointer
120 * (in r3, loaded with the initial sp) for the body of a
121 * function.
122 *
123 * If the given instruction is a stwm r1, d(sr0, sp) where
124 * d > 0, we evaluate to d, else we evaluate to zero.
125 */
126 #define STWM_R1_D_SR0_SP(inst) \
127 (((inst) & 0xffffc001) == 0x6fc10000 ? (((inst) & 0x00003ff) >> 1) : 0)
128 #endif /* DEBUG || DIAGNOSTIC */
129
130 const char *trap_type[] = {
131 "invalid",
132 "HPMC",
133 "power failure",
134 "recovery counter",
135 "external interrupt",
136 "LPMC",
137 "ITLB miss fault",
138 "instruction protection",
139 "Illegal instruction",
140 "break instruction",
141 "privileged operation",
142 "privileged register",
143 "overflow",
144 "conditional",
145 "assist exception",
146 "DTLB miss",
147 "ITLB non-access miss",
148 "DTLB non-access miss",
149 "data protection/rights/alignment",
150 "data break",
151 "TLB dirty",
152 "page reference",
153 "assist emulation",
154 "higher-priv transfer",
155 "lower-priv transfer",
156 "taken branch",
157 "data access rights",
158 "data protection",
159 "unaligned data ref",
160 };
161 int trap_types = __arraycount(trap_type);
162
163 uint8_t fpopmap[] = {
164 0x00, 0x00, 0x00, 0x06, 0x00, 0x00, 0x00, 0x00,
165 0x00, 0x0c, 0x00, 0x0e, 0x00, 0x00, 0x00, 0x00,
166 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
167 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
168 0x00, 0x00, 0x00, 0x26, 0x00, 0x00, 0x00, 0x00,
169 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
170 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
171 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
172 };
173
174 void pmap_hptdump(void);
175 void syscall(struct trapframe *, int *);
176
177 #if defined(DEBUG)
178 struct trapframe *sanity_frame;
179 struct lwp *sanity_lwp;
180 const char *sanity_string;
181 void frame_sanity_check(const char *, int, int, struct trapframe *,
182 struct lwp *);
183 #endif
184
185
186 #ifdef USERTRACE
187 /*
188 * USERTRACE is a crude facility that traces the PC of a single user process.
189 * This tracing is normally activated by the dispatching of a certain syscall
190 * with certain arguments - see the activation code in syscall().
191 */
192 static void user_backtrace(struct trapframe *, struct lwp *, int);
193 static void user_backtrace_raw(u_int, u_int);
194
195 u_int rctr_next_iioq;
196 #endif
197
198 static inline void
199 userret(struct lwp *l, struct trapframe *tf)
200 {
201 struct proc *p = l->l_proc;
202 int oticks = 0; /* XXX why zero? */
203
204 do {
205 l->l_md.md_astpending = 0;
206 //curcpu()->ci_data.cpu_nast++;
207 mi_userret(l);
208 } while (l->l_md.md_astpending);
209
210 /*
211 * If profiling, charge recent system time to the trapped pc.
212 */
213 if (p->p_stflag & PST_PROFIL) {
214 extern int psratio;
215
216 addupc_task(l, tf->tf_iioq_head,
217 (int)(p->p_sticks - oticks) * psratio);
218 }
219 }
220
221 /*
222 * This handles some messy kernel debugger details.
223 * It dispatches into either kgdb or DDB, and knows
224 * about some special things to do, like skipping over
225 * break instructions and how to really set up for
226 * a single-step.
227 */
228 #if defined(KGDB) || defined(DDB)
229 static int
230 trap_kdebug(int type, int code, struct trapframe *frame)
231 {
232 int handled;
233 u_int tf_iioq_head_old;
234 u_int tf_iioq_tail_old;
235
236 for (;;) {
237
238 /* This trap has not been handled. */
239 handled = 0;
240
241 /* Remember the instruction offset queue. */
242 tf_iioq_head_old = frame->tf_iioq_head;
243 tf_iioq_tail_old = frame->tf_iioq_tail;
244
245 #ifdef KGDB
246 /* Let KGDB handle it (if connected) */
247 if (!handled)
248 handled = kgdb_trap(type, frame);
249 #endif
250 #ifdef DDB
251 /* Let DDB handle it. */
252 if (!handled)
253 handled = kdb_trap(type, code, frame);
254 #endif
255
256 /* If this trap wasn't handled, return now. */
257 if (!handled)
258 return(0);
259
260 /*
261 * If the instruction offset queue head changed, but the offset
262 * queue tail didn't, assume that the user wants to jump to the
263 * head offset, and adjust the tail accordingly. This should
264 * fix the kgdb `jump' command, and can help DDB users who `set'
265 * the offset head but forget the tail.
266 */
267 if (frame->tf_iioq_head != tf_iioq_head_old &&
268 frame->tf_iioq_tail == tf_iioq_tail_old)
269 frame->tf_iioq_tail = frame->tf_iioq_head + 4;
270
271 /*
272 * This is some single-stepping support. If we're trying to
273 * step through a nullified instruction, just advance by hand
274 * and trap again. Otherwise, load the recovery counter with
275 * zero.
276 */
277 if (frame->tf_ipsw & PSW_R) {
278 #ifdef TRAPDEBUG
279 printf("(single stepping at head 0x%x tail 0x%x)\n",
280 frame->tf_iioq_head, frame->tf_iioq_tail);
281 #endif
282 if (frame->tf_ipsw & PSW_N) {
283 #ifdef TRAPDEBUG
284 printf("(single stepping past nullified)\n");
285 #endif
286
287 /* Advance the program counter. */
288 frame->tf_iioq_head = frame->tf_iioq_tail;
289 frame->tf_iioq_tail = frame->tf_iioq_head + 4;
290
291 /* Clear flags. */
292 frame->tf_ipsw &= ~(PSW_N|PSW_X|PSW_Y|PSW_Z|PSW_B|PSW_T|PSW_H|PSW_L);
293
294 /* Simulate another trap. */
295 type = T_RECOVERY;
296 continue;
297 }
298 frame->tf_rctr = 0;
299 }
300
301 /* We handled this trap. */
302 return (1);
303 }
304 /* NOTREACHED */
305 }
306 #else /* !KGDB && !DDB */
307 #define trap_kdebug(t, c, f) (0)
308 #endif /* !KGDB && !DDB */
309
310 #if defined(DEBUG) || defined(USERTRACE)
311 /*
312 * These functions give a crude usermode backtrace. They really only work when
313 * code has been compiled without optimization, as they assume a certain func-
314 * tion prologue sets up a frame pointer and stores the return pointer and arg-
315 * uments in it.
316 */
317 static void
318 user_backtrace_raw(u_int pc, u_int fp)
319 {
320 int frame_number;
321 int arg_number;
322 uint32_t val;
323
324 for (frame_number = 0;
325 frame_number < 100 && pc > HPPA_PC_PRIV_MASK && fp;
326 frame_number++) {
327
328 printf("%3d: pc=%08x%s fp=0x%08x", frame_number,
329 pc & ~HPPA_PC_PRIV_MASK, USERMODE(pc) ? " " : "**", fp);
330 for (arg_number = 0; arg_number < 4; arg_number++) {
331 if (ufetch_32(HPPA_FRAME_CARG(arg_number, fp),
332 &val) == 0) {
333 printf(" arg%d=0x%08x", arg_number, val);
334 } else {
335 printf(" arg%d=<bad address>", arg_number);
336 }
337 }
338 printf("\n");
339 if (ufetch_int((((uint32_t *) fp) - 5), &pc) != 0) {
340 printf(" ufetch for pc failed\n");
341 break;
342 }
343 if (ufetch_int((((uint32_t *) fp) + 0), &fp) != 0) {
344 printf(" ufetch for fp failed\n");
345 break;
346 }
347 }
348 printf(" backtrace stopped with pc %08x fp 0x%08x\n", pc, fp);
349 }
350
351 static void
352 user_backtrace(struct trapframe *tf, struct lwp *l, int type)
353 {
354 struct proc *p = l->l_proc;
355 u_int pc, fp, inst;
356
357 /*
358 * Display any trap type that we have.
359 */
360 if (type >= 0)
361 printf("pid %d (%s) trap #%d\n",
362 p->p_pid, p->p_comm, type & ~T_USER);
363
364 /*
365 * Assuming that the frame pointer in r3 is valid,
366 * dump out a stack trace.
367 */
368 fp = tf->tf_r3;
369 printf("pid %d (%s) backtrace, starting with fp 0x%08x\n",
370 p->p_pid, p->p_comm, fp);
371 user_backtrace_raw(tf->tf_iioq_head, fp);
372
373 /*
374 * In case the frame pointer in r3 is not valid, assuming the stack
375 * pointer is valid and the faulting function is a non-leaf, if we can
376 * find its prologue we can recover its frame pointer.
377 */
378 pc = tf->tf_iioq_head;
379 fp = tf->tf_sp - HPPA_FRAME_SIZE;
380 printf("pid %d (%s) backtrace, starting with sp 0x%08x pc 0x%08x\n",
381 p->p_pid, p->p_comm, tf->tf_sp, pc);
382 for (pc &= ~HPPA_PC_PRIV_MASK; pc > 0; pc -= sizeof(inst)) {
383 if (ufetch_int((u_int *) pc, &inst) != 0) {
384 printf(" ufetch for inst at pc %08x failed\n", pc);
385 break;
386 }
387 /* Check for the prologue instruction that sets sp. */
388 if (STWM_R1_D_SR0_SP(inst)) {
389 fp = tf->tf_sp - STWM_R1_D_SR0_SP(inst);
390 printf(" sp from fp at pc %08x: %08x\n", pc, inst);
391 break;
392 }
393 }
394 user_backtrace_raw(tf->tf_iioq_head, fp);
395 }
396 #endif /* DEBUG || USERTRACE */
397
398 #ifdef DEBUG
399 /*
400 * This sanity-checks a trapframe. It is full of various assumptions about
401 * what a healthy CPU state should be, with some documented elsewhere, some not.
402 */
403 void
404 frame_sanity_check(const char *func, int line, int type, struct trapframe *tf,
405 struct lwp *l)
406 {
407 #if 0
408 extern int kernel_text;
409 extern int etext;
410 #endif
411 struct cpu_info *ci = curcpu();
412
413 #define SANITY(e) \
414 do { \
415 if (sanity_frame == NULL && !(e)) { \
416 sanity_frame = tf; \
417 sanity_lwp = l; \
418 sanity_string = #e; \
419 } \
420 } while (/* CONSTCOND */ 0)
421
422 KASSERT(l != NULL);
423 SANITY((tf->tf_ipsw & ci->ci_psw) == ci->ci_psw);
424 SANITY((ci->ci_psw & PSW_I) == 0 || tf->tf_eiem != 0);
425 if (tf->tf_iisq_head == HPPA_SID_KERNEL) {
426 vaddr_t minsp, maxsp, uv;
427
428 uv = uvm_lwp_getuarea(l);
429
430 /*
431 * If the trap happened in the gateway page, we take the easy
432 * way out and assume that the trapframe is okay.
433 */
434 if ((tf->tf_iioq_head & ~PAGE_MASK) == SYSCALLGATE)
435 goto out;
436
437 SANITY(!USERMODE(tf->tf_iioq_head));
438 SANITY(!USERMODE(tf->tf_iioq_tail));
439
440 /*
441 * Don't check the instruction queues or stack on interrupts
442 * as we could be in the sti code (outside normal kernel
443 * text) or switching LWPs (curlwp and sp are not in sync)
444 */
445 if ((type & ~T_USER) == T_INTERRUPT)
446 goto out;
447 #if 0
448 SANITY(tf->tf_iioq_head >= (u_int) &kernel_text);
449 SANITY(tf->tf_iioq_head < (u_int) &etext);
450 SANITY(tf->tf_iioq_tail >= (u_int) &kernel_text);
451 SANITY(tf->tf_iioq_tail < (u_int) &etext);
452 #endif
453
454 maxsp = uv + USPACE + PAGE_SIZE;
455 minsp = uv + PAGE_SIZE;
456
457 SANITY(tf->tf_sp >= minsp && tf->tf_sp < maxsp);
458 } else {
459 struct pcb *pcb = lwp_getpcb(l);
460
461 SANITY(USERMODE(tf->tf_iioq_head));
462 SANITY(USERMODE(tf->tf_iioq_tail));
463 SANITY(tf->tf_cr30 == (u_int)pcb->pcb_fpregs);
464 }
465 #undef SANITY
466 out:
467 if (sanity_frame == tf) {
468 printf("insanity: '%s' at %s:%d type 0x%x tf %p lwp %p "
469 "sp 0x%x pc 0x%x\n",
470 sanity_string, func, line, type, sanity_frame, sanity_lwp,
471 tf->tf_sp, tf->tf_iioq_head);
472 (void) trap_kdebug(T_IBREAK, 0, tf);
473 sanity_frame = NULL;
474 sanity_lwp = NULL;
475 }
476 }
477 #endif /* DEBUG */
478
479
480 #define __PABITS(x, y) __BITS(31 - (x), 31 - (y))
481 #define __PABIT(x) __BIT(31 - (x))
482
483 #define LPA_MASK \
484 ( __PABITS(0, 5) | \
485 __PABITS(18, 25))
486 #define LPA \
487 (__SHIFTIN(1, __PABITS(0, 5)) | \
488 __SHIFTIN(0x4d, __PABITS(18, 25)))
489
490
491 #define PROBE_ENCS (0x46 | 0xc6 | 0x47 | 0xc7)
492 #define PROBE_PL __PABITS(11, 15)
493 #define PROBE_IMMED __PABIT(18)
494 #define PROBE_RW __PABIT(25)
495
496 #define PROBE_MASK \
497 (( __PABITS(0, 5) | \
498 __PABITS(18, 25) | \
499 __PABIT(26)) ^ \
500 (PROBE_IMMED | PROBE_RW))
501
502 #define PROBE \
503 ((__SHIFTIN(1, __PABITS(0, 5)) | \
504 __SHIFTIN(PROBE_ENCS, __PABITS(18, 25)) | \
505 __SHIFTIN(0, __PABIT(26))) ^ \
506 (PROBE_IMMED | PROBE_RW))
507
508 #define PLMASK __BITS(1, 0)
509
510
511 /* for hppa64 */
512 CTASSERT(sizeof(register_t) == sizeof(u_int));
513 size_t hppa_regmap[] = {
514 0, /* r0 is special case */
515 offsetof(struct trapframe, tf_r1 ) / sizeof(register_t),
516 offsetof(struct trapframe, tf_rp ) / sizeof(register_t),
517 offsetof(struct trapframe, tf_r3 ) / sizeof(register_t),
518 offsetof(struct trapframe, tf_r4 ) / sizeof(register_t),
519 offsetof(struct trapframe, tf_r5 ) / sizeof(register_t),
520 offsetof(struct trapframe, tf_r6 ) / sizeof(register_t),
521 offsetof(struct trapframe, tf_r7 ) / sizeof(register_t),
522 offsetof(struct trapframe, tf_r8 ) / sizeof(register_t),
523 offsetof(struct trapframe, tf_r9 ) / sizeof(register_t),
524 offsetof(struct trapframe, tf_r10 ) / sizeof(register_t),
525 offsetof(struct trapframe, tf_r11 ) / sizeof(register_t),
526 offsetof(struct trapframe, tf_r12 ) / sizeof(register_t),
527 offsetof(struct trapframe, tf_r13 ) / sizeof(register_t),
528 offsetof(struct trapframe, tf_r14 ) / sizeof(register_t),
529 offsetof(struct trapframe, tf_r15 ) / sizeof(register_t),
530 offsetof(struct trapframe, tf_r16 ) / sizeof(register_t),
531 offsetof(struct trapframe, tf_r17 ) / sizeof(register_t),
532 offsetof(struct trapframe, tf_r18 ) / sizeof(register_t),
533 offsetof(struct trapframe, tf_t4 ) / sizeof(register_t),
534 offsetof(struct trapframe, tf_t3 ) / sizeof(register_t),
535 offsetof(struct trapframe, tf_t2 ) / sizeof(register_t),
536 offsetof(struct trapframe, tf_t1 ) / sizeof(register_t),
537 offsetof(struct trapframe, tf_arg3) / sizeof(register_t),
538 offsetof(struct trapframe, tf_arg2) / sizeof(register_t),
539 offsetof(struct trapframe, tf_arg1) / sizeof(register_t),
540 offsetof(struct trapframe, tf_arg0) / sizeof(register_t),
541 offsetof(struct trapframe, tf_dp ) / sizeof(register_t),
542 offsetof(struct trapframe, tf_ret0) / sizeof(register_t),
543 offsetof(struct trapframe, tf_ret1) / sizeof(register_t),
544 offsetof(struct trapframe, tf_sp ) / sizeof(register_t),
545 offsetof(struct trapframe, tf_r31 ) / sizeof(register_t),
546 };
547
548
549 static inline register_t
550 tf_getregno(struct trapframe *tf, u_int regno)
551 {
552 register_t *tf_reg = (register_t *)tf;
553 if (regno == 0)
554 return 0;
555 else
556 return tf_reg[hppa_regmap[regno]];
557 }
558
559 static inline void
560 tf_setregno(struct trapframe *tf, u_int regno, register_t val)
561 {
562 register_t *tf_reg = (register_t *)tf;
563 if (regno == 0)
564 return;
565 else
566 tf_reg[hppa_regmap[regno]] = val;
567 }
568
569 void
570 trap(int type, struct trapframe *frame)
571 {
572 struct lwp *l;
573 struct proc *p;
574 struct pcb *pcb;
575 vaddr_t va;
576 struct vm_map *map;
577 struct vmspace *vm;
578 vm_prot_t vftype;
579 pa_space_t space;
580 ksiginfo_t ksi;
581 u_int opcode, onfault;
582 int ret;
583 const char *tts = "reserved";
584 int trapnum;
585 #ifdef DIAGNOSTIC
586 extern int emergency_stack_start, emergency_stack_end;
587 struct cpu_info *ci = curcpu();
588 int oldcpl = ci->ci_cpl;
589 #endif
590
591 trapnum = type & ~T_USER;
592 opcode = frame->tf_iir;
593
594 if (trapnum <= T_EXCEPTION || trapnum == T_HIGHERPL ||
595 trapnum == T_LOWERPL || trapnum == T_TAKENBR ||
596 trapnum == T_IDEBUG || trapnum == T_PERFMON) {
597 va = frame->tf_iioq_head;
598 space = frame->tf_iisq_head;
599 vftype = VM_PROT_EXECUTE;
600 } else {
601 va = frame->tf_ior;
602 space = frame->tf_isr;
603 vftype = inst_store(opcode) ? VM_PROT_WRITE : VM_PROT_READ;
604 }
605
606 KASSERT(curlwp != NULL);
607 l = curlwp;
608 p = l->l_proc;
609
610 #ifdef DIAGNOSTIC
611 /*
612 * If we are on the emergency stack, then we either got
613 * a fault on the kernel stack, or we're just handling
614 * a trap for the machine check handler (which also
615 * runs on the emergency stack).
616 *
617 * We *very crudely* differentiate between the two cases
618 * by checking the faulting instruction: if it is the
619 * function prologue instruction that stores the old
620 * frame pointer and updates the stack pointer, we assume
621 * that we faulted on the kernel stack.
622 *
623 * In this case, not completing that instruction will
624 * probably confuse backtraces in kgdb/ddb. Completing
625 * it would be difficult, because we already faulted on
626 * that part of the stack, so instead we fix up the
627 * frame as if the function called has just returned.
628 * This has peculiar knowledge about what values are in
629 * what registers during the "normal gcc -g" prologue.
630 */
631 if (&type >= &emergency_stack_start &&
632 &type < &emergency_stack_end &&
633 type != T_IBREAK && STWM_R1_D_SR0_SP(opcode)) {
634 /* Restore the caller's frame pointer. */
635 frame->tf_r3 = frame->tf_r1;
636 /* Restore the caller's instruction offsets. */
637 frame->tf_iioq_head = frame->tf_rp;
638 frame->tf_iioq_tail = frame->tf_iioq_head + 4;
639 goto dead_end;
640 }
641 #endif /* DIAGNOSTIC */
642
643 #ifdef DEBUG
644 frame_sanity_check(__func__, __LINE__, type, frame, l);
645 #endif /* DEBUG */
646
647 if (frame->tf_flags & TFF_LAST)
648 l->l_md.md_regs = frame;
649
650 if (trapnum <= trap_types)
651 tts = trap_type[trapnum];
652
653 #ifdef TRAPDEBUG
654 if (trapnum != T_INTERRUPT && trapnum != T_IBREAK)
655 printf("trap: %d, %s for %x:%lx at %x:%x, fp=%p, rp=%x\n",
656 type, tts, space, va, frame->tf_iisq_head,
657 frame->tf_iioq_head, frame, frame->tf_rp);
658 else if (trapnum == T_IBREAK)
659 printf("trap: break instruction %x:%x at %x:%x, fp=%p\n",
660 break5(opcode), break13(opcode),
661 frame->tf_iisq_head, frame->tf_iioq_head, frame);
662
663 {
664 extern int etext;
665 if (frame < (struct trapframe *)&etext) {
666 printf("trap: bogus frame ptr %p\n", frame);
667 goto dead_end;
668 }
669 }
670 #endif
671
672 pcb = lwp_getpcb(l);
673
674 /* If this is a trap, not an interrupt, reenable interrupts. */
675 if (trapnum != T_INTERRUPT) {
676 curcpu()->ci_data.cpu_ntrap++;
677 mtctl(frame->tf_eiem, CR_EIEM);
678 }
679
680 const bool user = (type & T_USER) != 0;
681 switch (type) {
682 case T_NONEXIST:
683 case T_NONEXIST | T_USER:
684 #if !defined(DDB) && !defined(KGDB)
685 /* we've got screwed up by the central scrutinizer */
686 panic ("trap: elvis has just left the building!");
687 break;
688 #else
689 goto dead_end;
690 #endif
691 case T_RECOVERY | T_USER:
692 #ifdef USERTRACE
693 for (;;) {
694 if (frame->tf_iioq_head != rctr_next_iioq)
695 printf("-%08x\nr %08x",
696 rctr_next_iioq - 4,
697 frame->tf_iioq_head);
698 rctr_next_iioq = frame->tf_iioq_head + 4;
699 if (frame->tf_ipsw & PSW_N) {
700 /* Advance the program counter. */
701 frame->tf_iioq_head = frame->tf_iioq_tail;
702 frame->tf_iioq_tail = frame->tf_iioq_head + 4;
703 /* Clear flags. */
704 frame->tf_ipsw &= ~(PSW_N|PSW_X|PSW_Y|PSW_Z|PSW_B|PSW_T|PSW_H|PSW_L);
705 /* Simulate another trap. */
706 continue;
707 }
708 break;
709 }
710 frame->tf_rctr = 0;
711 break;
712 #endif /* USERTRACE */
713 case T_RECOVERY:
714 #if !defined(DDB) && !defined(KGDB)
715 /* XXX will implement later */
716 printf ("trap: handicapped");
717 break;
718 #else
719 goto dead_end;
720 #endif
721
722 case T_EMULATION | T_USER:
723 hppa_fpu_emulate(frame, l, opcode);
724 break;
725
726 case T_DATALIGN:
727 onfault = pcb->pcb_onfault;
728 if (onfault) {
729 ret = EFAULT;
730 do_onfault:
731 frame->tf_iioq_head = onfault;
732 frame->tf_iioq_tail = frame->tf_iioq_head + 4;
733 frame->tf_ret0 = ret;
734 break;
735 }
736 /*FALLTHROUGH*/
737
738 #ifdef DIAGNOSTIC
739 /* these just can't happen ever */
740 case T_PRIV_OP:
741 case T_PRIV_REG:
742 /* these just can't make it to the trap() ever */
743 case T_HPMC:
744 case T_HPMC | T_USER:
745 case T_EMULATION:
746 case T_EXCEPTION:
747 #endif
748 case T_IBREAK:
749 case T_DBREAK:
750 dead_end:
751 if (type & T_USER) {
752 #ifdef DEBUG
753 user_backtrace(frame, l, type);
754 #endif
755 KSI_INIT_TRAP(&ksi);
756 ksi.ksi_signo = SIGILL;
757 ksi.ksi_code = ILL_ILLTRP;
758 ksi.ksi_trap = type;
759 ksi.ksi_addr = (void *)frame->tf_iioq_head;
760 trapsignal(l, &ksi);
761 break;
762 }
763 if (trap_kdebug(type, va, frame))
764 return;
765 else if (type == T_DATALIGN)
766 panic ("trap: %s at 0x%x", tts, (u_int) va);
767 else
768 panic ("trap: no debugger for \"%s\" (%d)", tts, type);
769 break;
770
771 case T_IBREAK | T_USER:
772 case T_DBREAK | T_USER:
773 KSI_INIT_TRAP(&ksi);
774 ksi.ksi_signo = SIGTRAP;
775 ksi.ksi_code = TRAP_BRKPT;
776 ksi.ksi_trap = trapnum;
777 ksi.ksi_addr = (void *)(frame->tf_iioq_head & ~HPPA_PC_PRIV_MASK);
778 #ifdef PTRACE
779 ss_clear_breakpoints(l);
780 if (opcode == SSBREAKPOINT)
781 ksi.ksi_code = TRAP_TRACE;
782 #endif
783 /* pass to user debugger */
784 trapsignal(l, &ksi);
785 break;
786
787 #ifdef PTRACE
788 case T_TAKENBR | T_USER:
789 ss_clear_breakpoints(l);
790
791 KSI_INIT_TRAP(&ksi);
792 ksi.ksi_signo = SIGTRAP;
793 ksi.ksi_code = TRAP_TRACE;
794 ksi.ksi_trap = trapnum;
795 ksi.ksi_addr = (void *)(frame->tf_iioq_head & ~HPPA_PC_PRIV_MASK);
796
797 /* pass to user debugger */
798 trapsignal(l, &ksi);
799 break;
800 #endif
801
802 case T_EXCEPTION | T_USER: { /* co-proc assist trap */
803 uint64_t *fpp;
804 uint32_t *pex, ex, inst;
805 int i;
806
807 hppa_fpu_flush(l);
808 fpp = (uint64_t *)pcb->pcb_fpregs;
809
810 /* skip the status register */
811 pex = (uint32_t *)&fpp[0];
812 pex++;
813
814 /* loop through the exception registers */
815 for (i = 1; i < 8 && !*pex; i++, pex++)
816 ;
817 KASSERT(i < 8);
818 ex = *pex;
819 *pex = 0;
820
821 /* reset the trap flag, as if there was none */
822 fpp[0] &= ~(((uint64_t)HPPA_FPU_T) << 32);
823
824 /* emulate the instruction */
825 inst = ((uint32_t)fpopmap[ex >> 26] << 26) | (ex & 0x03ffffff);
826 hppa_fpu_emulate(frame, l, inst);
827 }
828 break;
829
830 case T_OVERFLOW | T_USER:
831 KSI_INIT_TRAP(&ksi);
832 ksi.ksi_signo = SIGFPE;
833 ksi.ksi_code = SI_NOINFO;
834 ksi.ksi_trap = type;
835 ksi.ksi_addr = (void *)va;
836 trapsignal(l, &ksi);
837 break;
838
839 case T_CONDITION | T_USER:
840 KSI_INIT_TRAP(&ksi);
841 ksi.ksi_signo = SIGFPE;
842 ksi.ksi_code = FPE_INTDIV;
843 ksi.ksi_trap = type;
844 ksi.ksi_addr = (void *)va;
845 trapsignal(l, &ksi);
846 break;
847
848 case T_ILLEGAL | T_USER:
849 #ifdef DEBUG
850 user_backtrace(frame, l, type);
851 #endif
852 KSI_INIT_TRAP(&ksi);
853 ksi.ksi_signo = SIGILL;
854 ksi.ksi_code = ILL_ILLOPC;
855 ksi.ksi_trap = type;
856 ksi.ksi_addr = (void *)va;
857 trapsignal(l, &ksi);
858 break;
859
860 case T_PRIV_OP | T_USER:
861 #ifdef DEBUG
862 user_backtrace(frame, l, type);
863 #endif
864 KSI_INIT_TRAP(&ksi);
865 ksi.ksi_signo = SIGILL;
866 ksi.ksi_code = ILL_PRVOPC;
867 ksi.ksi_trap = type;
868 ksi.ksi_addr = (void *)va;
869 trapsignal(l, &ksi);
870 break;
871
872 case T_PRIV_REG | T_USER:
873 #ifdef DEBUG
874 user_backtrace(frame, l, type);
875 #endif
876 KSI_INIT_TRAP(&ksi);
877 ksi.ksi_signo = SIGILL;
878 ksi.ksi_code = ILL_PRVREG;
879 ksi.ksi_trap = type;
880 ksi.ksi_addr = (void *)va;
881 trapsignal(l, &ksi);
882 break;
883
884 /* these should never got here */
885 case T_HIGHERPL | T_USER:
886 case T_LOWERPL | T_USER:
887 KSI_INIT_TRAP(&ksi);
888 ksi.ksi_signo = SIGSEGV;
889 ksi.ksi_code = SEGV_ACCERR;
890 ksi.ksi_trap = type;
891 ksi.ksi_addr = (void *)va;
892 trapsignal(l, &ksi);
893 break;
894
895 case T_IPROT | T_USER:
896 case T_DPROT | T_USER:
897 KSI_INIT_TRAP(&ksi);
898 ksi.ksi_signo = SIGSEGV;
899 ksi.ksi_code = SEGV_ACCERR;
900 ksi.ksi_trap = type;
901 ksi.ksi_addr = (void *)va;
902 trapsignal(l, &ksi);
903 break;
904
905 case T_ITLBMISSNA: case T_USER | T_ITLBMISSNA:
906 case T_DTLBMISSNA: case T_USER | T_DTLBMISSNA:
907 vm = p->p_vmspace;
908
909 if (!vm) {
910 #ifdef TRAPDEBUG
911 printf("trap: no vm, p=%p\n", p);
912 #endif
913 goto dead_end;
914 }
915
916 /*
917 * it could be a kernel map for exec_map faults
918 */
919 if (!user && space == HPPA_SID_KERNEL)
920 map = kernel_map;
921 else {
922 map = &vm->vm_map;
923 }
924
925 va = trunc_page(va);
926
927 if ((opcode & LPA_MASK) == LPA) {
928 /* lpa failure case */
929 const u_int regno =
930 __SHIFTOUT(opcode, __PABITS(27, 31));
931 tf_setregno(frame, regno, 0);
932 frame->tf_ipsw |= PSW_N;
933 } else if ((opcode & PROBE_MASK) == PROBE) {
934 u_int pl;
935 if ((opcode & PROBE_IMMED) != 0) {
936 pl = __SHIFTOUT(opcode, PROBE_PL) & PLMASK;
937 } else {
938 const u_int plreg =
939 __SHIFTOUT(opcode, PROBE_PL);
940 pl = tf_getregno(frame, plreg) & PLMASK;
941 }
942 bool ok = true;
943 if ((user && space == HPPA_SID_KERNEL) ||
944 (frame->tf_iioq_head & 3) != pl ||
945 (user && va >= VM_MAXUSER_ADDRESS)) {
946 ok = false;
947 } else {
948 /* Never call uvm_fault in interrupt context. */
949 KASSERT(curcpu()->ci_intr_depth == 0);
950
951 const bool read =
952 __SHIFTOUT(opcode, PROBE_RW) == 0;
953 onfault = pcb->pcb_onfault;
954 pcb->pcb_onfault = 0;
955 ret = uvm_fault(map, va, read ?
956 VM_PROT_READ : VM_PROT_WRITE);
957 pcb->pcb_onfault = onfault;
958
959 if (ret)
960 ok = false;
961 }
962 if (!ok) {
963 const u_int regno =
964 __SHIFTOUT(opcode, __PABITS(27, 31));
965 tf_setregno(frame, regno, 0);
966 frame->tf_ipsw |= PSW_N;
967 }
968 }
969 break;
970
971 case T_DATACC: case T_USER | T_DATACC:
972 case T_ITLBMISS: case T_USER | T_ITLBMISS:
973 case T_DTLBMISS: case T_USER | T_DTLBMISS:
974 case T_TLB_DIRTY: case T_USER | T_TLB_DIRTY:
975 vm = p->p_vmspace;
976
977 if (!vm) {
978 #ifdef TRAPDEBUG
979 printf("trap: no vm, p=%p\n", p);
980 #endif
981 goto dead_end;
982 }
983
984 /*
985 * it could be a kernel map for exec_map faults
986 */
987 if (!(type & T_USER) && space == HPPA_SID_KERNEL)
988 map = kernel_map;
989 else {
990 map = &vm->vm_map;
991 }
992
993 va = trunc_page(va);
994
995 if (map->pmap->pm_space != space) {
996 #ifdef TRAPDEBUG
997 printf("trap: space mismatch %d != %d\n",
998 space, map->pmap->pm_space);
999 #endif
1000 /* actually dump the user, crap the kernel */
1001 goto dead_end;
1002 }
1003
1004 /* Never call uvm_fault in interrupt context. */
1005 KASSERT(curcpu()->ci_intr_depth == 0);
1006
1007 onfault = pcb->pcb_onfault;
1008 pcb->pcb_onfault = 0;
1009 ret = uvm_fault(map, va, vftype);
1010 pcb->pcb_onfault = onfault;
1011
1012 #ifdef TRAPDEBUG
1013 printf("uvm_fault(%p, %x, %d)=%d\n",
1014 map, (u_int)va, vftype, ret);
1015 #endif
1016
1017 /*
1018 * If this was a stack access we keep track of the maximum
1019 * accessed stack size. Also, if uvm_fault gets a protection
1020 * failure it is due to accessing the stack region outside
1021 * the current limit and we need to reflect that as an access
1022 * error.
1023 */
1024 if (map != kernel_map && va >= (vaddr_t)vm->vm_minsaddr) {
1025 if (ret == 0)
1026 uvm_grow(l->l_proc, va);
1027 else if (ret == EACCES)
1028 ret = EFAULT;
1029 }
1030
1031 if (ret != 0) {
1032 if (type & T_USER) {
1033 #ifdef DEBUG
1034 user_backtrace(frame, l, type);
1035 #endif
1036 KSI_INIT_TRAP(&ksi);
1037 switch (ret) {
1038 case EACCES:
1039 ksi.ksi_signo = SIGSEGV;
1040 ksi.ksi_code = SEGV_ACCERR;
1041 break;
1042 case ENOMEM:
1043 ksi.ksi_signo = SIGKILL;
1044 printf("UVM: pid %d (%s), uid %d "
1045 "killed: out of swap\n",
1046 p->p_pid, p->p_comm,
1047 l->l_cred ?
1048 kauth_cred_geteuid(l->l_cred)
1049 : -1);
1050 break;
1051 case EINVAL:
1052 ksi.ksi_signo = SIGBUS;
1053 ksi.ksi_code = BUS_ADRERR;
1054 break;
1055 default:
1056 ksi.ksi_signo = SIGSEGV;
1057 ksi.ksi_code = SEGV_MAPERR;
1058 break;
1059 }
1060 ksi.ksi_trap = type;
1061 ksi.ksi_addr = (void *)va;
1062 trapsignal(l, &ksi);
1063 } else {
1064 if (onfault) {
1065 goto do_onfault;
1066 }
1067 panic("trap: uvm_fault(%p, %lx, %d): %d",
1068 map, va, vftype, ret);
1069 }
1070 }
1071 break;
1072
1073 case T_DATALIGN | T_USER:
1074 #ifdef DEBUG
1075 user_backtrace(frame, l, type);
1076 #endif
1077 KSI_INIT_TRAP(&ksi);
1078 ksi.ksi_signo = SIGBUS;
1079 ksi.ksi_code = BUS_ADRALN;
1080 ksi.ksi_trap = type;
1081 ksi.ksi_addr = (void *)va;
1082 trapsignal(l, &ksi);
1083 break;
1084
1085 case T_INTERRUPT:
1086 case T_INTERRUPT | T_USER:
1087 hppa_intr(frame);
1088 mtctl(frame->tf_eiem, CR_EIEM);
1089 break;
1090
1091 case T_LOWERPL:
1092 case T_DPROT:
1093 case T_IPROT:
1094 case T_OVERFLOW:
1095 case T_CONDITION:
1096 case T_ILLEGAL:
1097 case T_HIGHERPL:
1098 case T_TAKENBR:
1099 case T_POWERFAIL:
1100 case T_LPMC:
1101 case T_PAGEREF:
1102 case T_DATAPID: case T_DATAPID | T_USER:
1103 if (0 /* T-chip */) {
1104 break;
1105 }
1106 /* FALLTHROUGH to unimplemented */
1107 default:
1108 panic ("trap: unimplemented \'%s\' (%d)", tts, type);
1109 }
1110
1111 #ifdef DIAGNOSTIC
1112 if (ci->ci_cpl != oldcpl)
1113 printf("WARNING: SPL (%d) NOT LOWERED ON TRAP (%d) EXIT\n",
1114 ci->ci_cpl, trapnum);
1115 #endif
1116
1117 if (type & T_USER)
1118 userret(l, l->l_md.md_regs);
1119
1120 #ifdef DEBUG
1121 frame_sanity_check(__func__, __LINE__, type, frame, l);
1122 if (frame->tf_flags & TFF_LAST && (curlwp->l_flag & LW_IDLE) == 0)
1123 frame_sanity_check(__func__, __LINE__, type,
1124 curlwp->l_md.md_regs, curlwp);
1125 #endif /* DEBUG */
1126 }
1127
1128 void
1129 md_child_return(struct lwp *l)
1130 {
1131 /*
1132 * Return values in the frame set by cpu_lwp_fork().
1133 */
1134
1135 userret(l, l->l_md.md_regs);
1136 #ifdef DEBUG
1137 frame_sanity_check(__func__, __LINE__, 0, l->l_md.md_regs, l);
1138 #endif /* DEBUG */
1139 }
1140
1141 /*
1142 * Process the tail end of a posix_spawn() for the child.
1143 */
1144 void
1145 cpu_spawn_return(struct lwp *l)
1146 {
1147
1148 userret(l, l->l_md.md_regs);
1149 #ifdef DEBUG
1150 frame_sanity_check(__func__, __LINE__, 0, l->l_md.md_regs, l);
1151 #endif /* DEBUG */
1152 }
1153
1154 #ifdef PTRACE
1155
1156 #include <sys/ptrace.h>
1157
1158 int
1159 ss_get_value(struct lwp *l, vaddr_t addr, u_int *value)
1160 {
1161 struct uio uio;
1162 struct iovec iov;
1163
1164 iov.iov_base = (void *)value;
1165 iov.iov_len = sizeof(u_int);
1166 uio.uio_iov = &iov;
1167 uio.uio_iovcnt = 1;
1168 uio.uio_offset = (off_t)addr;
1169 uio.uio_resid = sizeof(u_int);
1170 uio.uio_rw = UIO_READ;
1171 UIO_SETUP_SYSSPACE(&uio);
1172
1173 return (process_domem(curlwp, l, &uio));
1174 }
1175
1176 int
1177 ss_put_value(struct lwp *l, vaddr_t addr, u_int value)
1178 {
1179 struct uio uio;
1180 struct iovec iov;
1181
1182 iov.iov_base = (void *)&value;
1183 iov.iov_len = sizeof(u_int);
1184 uio.uio_iov = &iov;
1185 uio.uio_iovcnt = 1;
1186 uio.uio_offset = (off_t)addr;
1187 uio.uio_resid = sizeof(u_int);
1188 uio.uio_rw = UIO_WRITE;
1189 UIO_SETUP_SYSSPACE(&uio);
1190
1191 return (process_domem(curlwp, l, &uio));
1192 }
1193
1194 void
1195 ss_clear_breakpoints(struct lwp *l)
1196 {
1197 /* Restore original instructions. */
1198 if (l->l_md.md_bpva != 0) {
1199 ss_put_value(l, l->l_md.md_bpva, l->l_md.md_bpsave[0]);
1200 ss_put_value(l, l->l_md.md_bpva + 4, l->l_md.md_bpsave[1]);
1201 l->l_md.md_bpva = 0;
1202 }
1203 }
1204
1205
1206 int
1207 process_sstep(struct lwp *l, int sstep)
1208 {
1209 struct trapframe *tf = l->l_md.md_regs;
1210 int error;
1211
1212 ss_clear_breakpoints(l);
1213
1214 /* We're continuing... */
1215 if (sstep == 0) {
1216 tf->tf_ipsw &= ~PSW_T;
1217 return 0;
1218 }
1219
1220 /*
1221 * Don't touch the syscall gateway page. Instead, insert a
1222 * breakpoint where we're supposed to return.
1223 */
1224 if ((tf->tf_iioq_tail & ~PAGE_MASK) == SYSCALLGATE)
1225 l->l_md.md_bpva = tf->tf_r31 & ~HPPA_PC_PRIV_MASK;
1226 else
1227 l->l_md.md_bpva = tf->tf_iioq_tail & ~HPPA_PC_PRIV_MASK;
1228
1229 error = ss_get_value(l, l->l_md.md_bpva, &l->l_md.md_bpsave[0]);
1230 if (error)
1231 return error;
1232 error = ss_get_value(l, l->l_md.md_bpva + 4, &l->l_md.md_bpsave[1]);
1233 if (error)
1234 return error;
1235
1236 error = ss_put_value(l, l->l_md.md_bpva, SSBREAKPOINT);
1237 if (error)
1238 return error;
1239 error = ss_put_value(l, l->l_md.md_bpva + 4, SSBREAKPOINT);
1240 if (error)
1241 return error;
1242
1243 if ((tf->tf_iioq_tail & ~PAGE_MASK) == SYSCALLGATE)
1244 tf->tf_ipsw &= ~PSW_T;
1245 else
1246 tf->tf_ipsw |= PSW_T;
1247
1248 return 0;
1249 }
1250 #endif
1251
1252
1253 void
1254 syscall_intern(struct proc *p)
1255 {
1256 p->p_md.md_syscall = syscall;
1257 }
1258
1259 /*
1260 * call actual syscall routine
1261 * from the low-level syscall handler:
1262 * - all HPPA_FRAME_NARGS syscall's arguments supposed to be copied onto
1263 * our stack, this wins compared to copyin just needed amount anyway
1264 * - register args are copied onto stack too
1265 */
1266 void
1267 syscall(struct trapframe *frame, int *args)
1268 {
1269 struct lwp *l;
1270 struct proc *p;
1271 const struct sysent *callp;
1272 size_t nargs64;
1273 int nsys, code, error;
1274 int tmp;
1275 int rval[2];
1276 #ifdef DIAGNOSTIC
1277 struct cpu_info *ci = curcpu();
1278 int oldcpl = ci->ci_cpl;
1279 #endif
1280
1281 curcpu()->ci_data.cpu_nsyscall++;
1282
1283 #ifdef DEBUG
1284 frame_sanity_check(__func__, __LINE__, 0, frame, curlwp);
1285 #endif /* DEBUG */
1286
1287 if (!USERMODE(frame->tf_iioq_head))
1288 panic("syscall");
1289
1290 KASSERT(curlwp != NULL);
1291 l = curlwp;
1292 p = l->l_proc;
1293 l->l_md.md_regs = frame;
1294 nsys = p->p_emul->e_nsysent;
1295 callp = p->p_emul->e_sysent;
1296 code = frame->tf_t1;
1297
1298 /*
1299 * Restarting a system call is touchy on the HPPA, because syscall
1300 * arguments are passed in registers and the program counter of the
1301 * syscall "point" isn't easily divined.
1302 *
1303 * We handle the first problem by assuming that we will have to restart
1304 * this system call, so we stuff the first four words of the original
1305 * arguments back into the frame as arg0...arg3, which is where we
1306 * found them in the first place. Any further arguments are (still) on
1307 * the user's stack and the syscall code will fetch them from there
1308 * (again).
1309 *
1310 * The program counter problem is addressed below.
1311 */
1312 frame->tf_arg0 = args[0];
1313 frame->tf_arg1 = args[1];
1314 frame->tf_arg2 = args[2];
1315 frame->tf_arg3 = args[3];
1316
1317 /*
1318 * Some special handling for the syscall(2) and
1319 * __syscall(2) system calls.
1320 */
1321 switch (code) {
1322 case SYS_syscall:
1323 code = *args;
1324 args += 1;
1325 break;
1326 case SYS___syscall:
1327 if (callp != sysent)
1328 break;
1329 /*
1330 * NB: even though __syscall(2) takes a quad_t containing the
1331 * system call number, because our argument copying word-swaps
1332 * 64-bit arguments, the least significant word of that quad_t
1333 * is the first word in the argument array.
1334 */
1335 code = *args;
1336 args += 2;
1337 }
1338
1339 /*
1340 * Stacks growing from lower addresses to higher addresses are not
1341 * really such a good idea, because it makes it impossible to overlay a
1342 * struct on top of C stack arguments (the arguments appear in
1343 * reversed order).
1344 *
1345 * You can do the obvious thing (as locore.S does) and copy argument
1346 * words one by one, laying them out in the "right" order in the dest-
1347 * ination buffer, but this ends up word-swapping multi-word arguments
1348 * (like off_t).
1349 *
1350 * FIXME - this works only on native binaries and
1351 * will probably screw up any and all emulation.
1352 *
1353 */
1354
1355 if (code < 0 || code >= nsys)
1356 callp += p->p_emul->e_nosys; /* bad syscall # */
1357 else
1358 callp += code;
1359
1360 nargs64 = SYCALL_NARGS64(callp);
1361 if (nargs64 != 0) {
1362 size_t nargs = callp->sy_narg;
1363
1364 for (size_t i = 0; i < nargs + nargs64;) {
1365 if (SYCALL_ARG_64_P(callp, i)) {
1366 tmp = args[i];
1367 args[i] = args[i + 1];
1368 args[i + 1] = tmp;
1369 i += 2;
1370 } else
1371 i++;
1372 }
1373 }
1374
1375 #ifdef USERTRACE
1376 if (0) {
1377 user_backtrace(frame, l, -1);
1378 frame->tf_ipsw |= PSW_R;
1379 frame->tf_rctr = 0;
1380 printf("r %08x", frame->tf_iioq_head);
1381 rctr_next_iioq = frame->tf_iioq_head + 4;
1382 }
1383 #endif
1384
1385 error = sy_invoke(callp, l, args, rval, code);
1386
1387 switch (error) {
1388 case 0:
1389 l = curlwp; /* changes on exec() */
1390 frame = l->l_md.md_regs;
1391 frame->tf_ret0 = rval[0];
1392 frame->tf_ret1 = rval[1];
1393 frame->tf_t1 = 0;
1394 break;
1395 case ERESTART:
1396 /*
1397 * Now we have to wind back the instruction offset queue to the
1398 * point where the system call will be made again. This is
1399 * inherently tied to the SYSCALL macro.
1400 *
1401 * Currently, the part of the SYSCALL macro that we want to re-
1402 * run reads as:
1403 *
1404 * ldil L%SYSCALLGATE, r1
1405 * ble 4(srX, r1)
1406 * ldi __CONCAT(SYS_,x), t1
1407 * comb,<> %r0, %t1, __cerror
1408 *
1409 * And our offset queue head points to the comb instruction.
1410 * So we need to subtract twelve to reach the ldil.
1411 */
1412 frame->tf_iioq_head -= 12;
1413 frame->tf_iioq_tail = frame->tf_iioq_head + 4;
1414 break;
1415 case EJUSTRETURN:
1416 p = curproc;
1417 break;
1418 default:
1419 if (p->p_emul->e_errno)
1420 error = p->p_emul->e_errno[error];
1421 frame->tf_t1 = error;
1422 break;
1423 }
1424
1425 userret(l, frame);
1426
1427 #ifdef DIAGNOSTIC
1428 if (ci->ci_cpl != oldcpl) {
1429 printf("WARNING: SPL (0x%x) NOT LOWERED ON "
1430 "syscall(0x%x, 0x%x, 0x%x, 0x%x...) EXIT, PID %d\n",
1431 ci->ci_cpl, code, args[0], args[1], args[2], p->p_pid);
1432 ci->ci_cpl = oldcpl;
1433 }
1434 #endif
1435
1436 #ifdef DEBUG
1437 frame_sanity_check(__func__, __LINE__, 0, frame, l);
1438 #endif /* DEBUG */
1439 }
1440
1441 /*
1442 * Start a new LWP
1443 */
1444 void
1445 startlwp(void *arg)
1446 {
1447 ucontext_t *uc = arg;
1448 lwp_t *l = curlwp;
1449 int error __diagused;
1450
1451 error = cpu_setmcontext(l, &uc->uc_mcontext, uc->uc_flags);
1452 KASSERT(error == 0);
1453
1454 kmem_free(uc, sizeof(ucontext_t));
1455 userret(l, l->l_md.md_regs);
1456 }
1457