trap.c revision 1.37 1 1.37 chs /* $NetBSD: trap.c,v 1.37 2006/10/05 14:48:32 chs Exp $ */
2 1.1 simonb
3 1.1 simonb /*
4 1.1 simonb * Copyright 2001 Wasabi Systems, Inc.
5 1.1 simonb * All rights reserved.
6 1.1 simonb *
7 1.1 simonb * Written by Eduardo Horvath and Simon Burge for Wasabi Systems, Inc.
8 1.1 simonb *
9 1.1 simonb * Redistribution and use in source and binary forms, with or without
10 1.1 simonb * modification, are permitted provided that the following conditions
11 1.1 simonb * are met:
12 1.1 simonb * 1. Redistributions of source code must retain the above copyright
13 1.1 simonb * notice, this list of conditions and the following disclaimer.
14 1.1 simonb * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 simonb * notice, this list of conditions and the following disclaimer in the
16 1.1 simonb * documentation and/or other materials provided with the distribution.
17 1.1 simonb * 3. All advertising materials mentioning features or use of this software
18 1.1 simonb * must display the following acknowledgement:
19 1.1 simonb * This product includes software developed for the NetBSD Project by
20 1.1 simonb * Wasabi Systems, Inc.
21 1.1 simonb * 4. The name of Wasabi Systems, Inc. may not be used to endorse
22 1.1 simonb * or promote products derived from this software without specific prior
23 1.1 simonb * written permission.
24 1.1 simonb *
25 1.1 simonb * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
26 1.1 simonb * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
27 1.1 simonb * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
28 1.1 simonb * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC
29 1.1 simonb * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
30 1.1 simonb * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
31 1.1 simonb * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
32 1.1 simonb * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
33 1.1 simonb * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
34 1.1 simonb * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
35 1.1 simonb * POSSIBILITY OF SUCH DAMAGE.
36 1.1 simonb */
37 1.1 simonb
38 1.1 simonb /*
39 1.1 simonb * Copyright (C) 1995, 1996 Wolfgang Solfrank.
40 1.1 simonb * Copyright (C) 1995, 1996 TooLs GmbH.
41 1.1 simonb * All rights reserved.
42 1.1 simonb *
43 1.1 simonb * Redistribution and use in source and binary forms, with or without
44 1.1 simonb * modification, are permitted provided that the following conditions
45 1.1 simonb * are met:
46 1.1 simonb * 1. Redistributions of source code must retain the above copyright
47 1.1 simonb * notice, this list of conditions and the following disclaimer.
48 1.1 simonb * 2. Redistributions in binary form must reproduce the above copyright
49 1.1 simonb * notice, this list of conditions and the following disclaimer in the
50 1.1 simonb * documentation and/or other materials provided with the distribution.
51 1.1 simonb * 3. All advertising materials mentioning features or use of this software
52 1.1 simonb * must display the following acknowledgement:
53 1.1 simonb * This product includes software developed by TooLs GmbH.
54 1.1 simonb * 4. The name of TooLs GmbH may not be used to endorse or promote products
55 1.1 simonb * derived from this software without specific prior written permission.
56 1.1 simonb *
57 1.1 simonb * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
58 1.1 simonb * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
59 1.1 simonb * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
60 1.1 simonb * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
61 1.1 simonb * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
62 1.1 simonb * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
63 1.1 simonb * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
64 1.1 simonb * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
65 1.1 simonb * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
66 1.1 simonb * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
67 1.1 simonb */
68 1.14 lukem
69 1.14 lukem #include <sys/cdefs.h>
70 1.37 chs __KERNEL_RCSID(0, "$NetBSD: trap.c,v 1.37 2006/10/05 14:48:32 chs Exp $");
71 1.1 simonb
72 1.1 simonb #include "opt_altivec.h"
73 1.1 simonb #include "opt_ddb.h"
74 1.1 simonb
75 1.1 simonb #include <sys/param.h>
76 1.1 simonb #include <sys/proc.h>
77 1.1 simonb #include <sys/reboot.h>
78 1.1 simonb #include <sys/syscall.h>
79 1.1 simonb #include <sys/systm.h>
80 1.1 simonb #include <sys/user.h>
81 1.10 thorpej #include <sys/pool.h>
82 1.10 thorpej #include <sys/sa.h>
83 1.10 thorpej #include <sys/savar.h>
84 1.20 cl #include <sys/userret.h>
85 1.34 yamt #include <sys/kauth.h>
86 1.1 simonb
87 1.1 simonb #include <uvm/uvm_extern.h>
88 1.1 simonb
89 1.1 simonb #include <dev/cons.h>
90 1.1 simonb
91 1.1 simonb #include <machine/cpu.h>
92 1.1 simonb #include <machine/db_machdep.h>
93 1.1 simonb #include <machine/fpu.h>
94 1.1 simonb #include <machine/frame.h>
95 1.1 simonb #include <machine/pcb.h>
96 1.1 simonb #include <machine/psl.h>
97 1.1 simonb #include <machine/trap.h>
98 1.1 simonb
99 1.1 simonb #include <powerpc/spr.h>
100 1.1 simonb #include <powerpc/ibm4xx/pmap.h>
101 1.1 simonb #include <powerpc/ibm4xx/tlb.h>
102 1.1 simonb #include <powerpc/fpu/fpu_extern.h>
103 1.1 simonb
104 1.1 simonb /* These definitions should probably be somewhere else XXX */
105 1.1 simonb #define FIRSTARG 3 /* first argument is in reg 3 */
106 1.1 simonb #define NARGREG 8 /* 8 args are in registers */
107 1.1 simonb #define MOREARGS(sp) ((caddr_t)((int)(sp) + 8)) /* more args go here */
108 1.1 simonb
109 1.10 thorpej static int fix_unaligned __P((struct lwp *l, struct trapframe *frame));
110 1.1 simonb
111 1.1 simonb void trap __P((struct trapframe *)); /* Called from locore / trap_subr */
112 1.1 simonb /* Why are these not defined in a header? */
113 1.1 simonb int badaddr __P((void *, size_t));
114 1.1 simonb int badaddr_read __P((void *, size_t, int *));
115 1.1 simonb int ctx_setup __P((int, int));
116 1.1 simonb
117 1.1 simonb #ifdef DEBUG
118 1.1 simonb #define TDB_ALL 0x1
119 1.1 simonb int trapdebug = /* TDB_ALL */ 0;
120 1.1 simonb #define DBPRINTF(x, y) if (trapdebug & (x)) printf y
121 1.1 simonb #else
122 1.1 simonb #define DBPRINTF(x, y)
123 1.1 simonb #endif
124 1.1 simonb
125 1.1 simonb void
126 1.1 simonb trap(struct trapframe *frame)
127 1.1 simonb {
128 1.10 thorpej struct lwp *l = curlwp;
129 1.10 thorpej struct proc *p = l ? l->l_proc : NULL;
130 1.1 simonb int type = frame->exc;
131 1.1 simonb int ftype, rv;
132 1.18 eeh ksiginfo_t ksi;
133 1.1 simonb
134 1.10 thorpej KASSERT(l == 0 || (l->l_stat == LSONPROC));
135 1.1 simonb
136 1.35 ad if (frame->srr1 & PSL_PR) {
137 1.35 ad LWP_CACHE_CREDS(l, p);
138 1.1 simonb type |= EXC_USER;
139 1.35 ad }
140 1.1 simonb
141 1.1 simonb ftype = VM_PROT_READ;
142 1.1 simonb
143 1.13 simonb DBPRINTF(TDB_ALL, ("trap(%x) at %lx from frame %p &frame %p\n",
144 1.13 simonb type, frame->srr0, frame, &frame));
145 1.1 simonb
146 1.1 simonb switch (type) {
147 1.1 simonb case EXC_DEBUG|EXC_USER:
148 1.13 simonb {
149 1.13 simonb int srr2, srr3;
150 1.13 simonb
151 1.28 perry __asm volatile("mfspr %0,0x3f0" :
152 1.13 simonb "=r" (rv), "=r" (srr2), "=r" (srr3) :);
153 1.13 simonb printf("debug reg is %x srr2 %x srr3 %x\n", rv, srr2,
154 1.13 simonb srr3);
155 1.13 simonb /* XXX fall through or break here?! */
156 1.13 simonb }
157 1.1 simonb /*
158 1.1 simonb * DEBUG intr -- probably single-step.
159 1.1 simonb */
160 1.1 simonb case EXC_TRC|EXC_USER:
161 1.17 matt frame->srr1 &= ~PSL_SE;
162 1.19 thorpej KSI_INIT_TRAP(&ksi);
163 1.17 matt ksi.ksi_signo = SIGTRAP;
164 1.17 matt ksi.ksi_trap = EXC_TRC;
165 1.17 matt ksi.ksi_addr = (void *)frame->srr0;
166 1.10 thorpej KERNEL_PROC_LOCK(l);
167 1.17 matt trapsignal(l, &ksi);
168 1.10 thorpej KERNEL_PROC_UNLOCK(l);
169 1.1 simonb break;
170 1.7 simonb
171 1.13 simonb /*
172 1.13 simonb * If we could not find and install appropriate TLB entry, fall through.
173 1.13 simonb */
174 1.7 simonb
175 1.1 simonb case EXC_DSI:
176 1.1 simonb /* FALLTHROUGH */
177 1.1 simonb case EXC_DTMISS:
178 1.1 simonb {
179 1.1 simonb struct vm_map *map;
180 1.1 simonb vaddr_t va;
181 1.11 matt struct faultbuf *fb = NULL;
182 1.1 simonb
183 1.1 simonb KERNEL_LOCK(LK_CANRECURSE|LK_EXCLUSIVE);
184 1.11 matt va = frame->dar;
185 1.11 matt if (frame->tf_xtra[TF_PID] == KERNEL_PID) {
186 1.1 simonb map = kernel_map;
187 1.1 simonb } else {
188 1.1 simonb map = &p->p_vmspace->vm_map;
189 1.16 cl if (l->l_flag & L_SA) {
190 1.22 cl l->l_savp->savp_faultaddr = va;
191 1.16 cl l->l_flag |= L_SA_PAGEFAULT;
192 1.16 cl }
193 1.1 simonb }
194 1.1 simonb
195 1.11 matt if (frame->tf_xtra[TF_ESR] & (ESR_DST|ESR_DIZ))
196 1.3 chs ftype = VM_PROT_WRITE;
197 1.1 simonb
198 1.13 simonb DBPRINTF(TDB_ALL,
199 1.13 simonb ("trap(EXC_DSI) at %lx %s fault on %p esr %x\n",
200 1.13 simonb frame->srr0,
201 1.13 simonb (ftype & VM_PROT_WRITE) ? "write" : "read",
202 1.13 simonb (void *)va, frame->tf_xtra[TF_ESR]));
203 1.32 drochner rv = uvm_fault(map, trunc_page(va), ftype);
204 1.1 simonb KERNEL_UNLOCK();
205 1.16 cl if (map != kernel_map)
206 1.16 cl l->l_flag &= ~L_SA_PAGEFAULT;
207 1.1 simonb if (rv == 0)
208 1.1 simonb goto done;
209 1.10 thorpej if ((fb = l->l_addr->u_pcb.pcb_onfault) != NULL) {
210 1.11 matt frame->tf_xtra[TF_PID] = KERNEL_PID;
211 1.11 matt frame->srr0 = fb->fb_pc;
212 1.1 simonb frame->srr1 |= PSL_IR; /* Re-enable IMMU */
213 1.11 matt frame->fixreg[1] = fb->fb_sp;
214 1.11 matt frame->fixreg[2] = fb->fb_r2;
215 1.1 simonb frame->fixreg[3] = 1; /* Return TRUE */
216 1.11 matt frame->cr = fb->fb_cr;
217 1.11 matt memcpy(&frame->fixreg[13], fb->fb_fixreg,
218 1.11 matt sizeof(fb->fb_fixreg));
219 1.1 simonb goto done;
220 1.1 simonb }
221 1.1 simonb }
222 1.1 simonb goto brain_damage;
223 1.7 simonb
224 1.1 simonb case EXC_DSI|EXC_USER:
225 1.1 simonb /* FALLTHROUGH */
226 1.1 simonb case EXC_DTMISS|EXC_USER:
227 1.10 thorpej KERNEL_PROC_LOCK(l);
228 1.7 simonb
229 1.11 matt if (frame->tf_xtra[TF_ESR] & (ESR_DST|ESR_DIZ))
230 1.3 chs ftype = VM_PROT_WRITE;
231 1.1 simonb
232 1.13 simonb DBPRINTF(TDB_ALL,
233 1.13 simonb ("trap(EXC_DSI|EXC_USER) at %lx %s fault on %lx %x\n",
234 1.13 simonb frame->srr0, (ftype & VM_PROT_WRITE) ? "write" : "read",
235 1.13 simonb frame->dar, frame->tf_xtra[TF_ESR]));
236 1.13 simonb KASSERT(l == curlwp && (l->l_stat == LSONPROC));
237 1.16 cl if (l->l_flag & L_SA) {
238 1.22 cl l->l_savp->savp_faultaddr = (vaddr_t)frame->dar;
239 1.16 cl l->l_flag |= L_SA_PAGEFAULT;
240 1.16 cl }
241 1.13 simonb rv = uvm_fault(&p->p_vmspace->vm_map, trunc_page(frame->dar),
242 1.32 drochner ftype);
243 1.1 simonb if (rv == 0) {
244 1.16 cl l->l_flag &= ~L_SA_PAGEFAULT;
245 1.13 simonb KERNEL_PROC_UNLOCK(l);
246 1.13 simonb break;
247 1.1 simonb }
248 1.19 thorpej KSI_INIT_TRAP(&ksi);
249 1.17 matt ksi.ksi_signo = SIGSEGV;
250 1.17 matt ksi.ksi_trap = EXC_DSI;
251 1.17 matt ksi.ksi_addr = (void *)frame->dar;
252 1.1 simonb if (rv == ENOMEM) {
253 1.10 thorpej printf("UVM: pid %d (%s) lid %d, uid %d killed: "
254 1.13 simonb "out of swap\n",
255 1.13 simonb p->p_pid, p->p_comm, l->l_lid,
256 1.36 ad l->l_cred ?
257 1.36 ad kauth_cred_geteuid(l->l_cred) : -1);
258 1.17 matt ksi.ksi_signo = SIGKILL;
259 1.1 simonb }
260 1.17 matt trapsignal(l, &ksi);
261 1.16 cl l->l_flag &= ~L_SA_PAGEFAULT;
262 1.10 thorpej KERNEL_PROC_UNLOCK(l);
263 1.1 simonb break;
264 1.15 chs
265 1.1 simonb case EXC_ITMISS|EXC_USER:
266 1.1 simonb case EXC_ISI|EXC_USER:
267 1.10 thorpej KERNEL_PROC_LOCK(l);
268 1.16 cl if (l->l_flag & L_SA) {
269 1.22 cl l->l_savp->savp_faultaddr = (vaddr_t)frame->srr0;
270 1.16 cl l->l_flag |= L_SA_PAGEFAULT;
271 1.16 cl }
272 1.15 chs ftype = VM_PROT_EXECUTE;
273 1.13 simonb DBPRINTF(TDB_ALL,
274 1.15 chs ("trap(EXC_ISI|EXC_USER) at %lx execute fault tf %p\n",
275 1.13 simonb frame->srr0, frame));
276 1.13 simonb rv = uvm_fault(&p->p_vmspace->vm_map, trunc_page(frame->srr0),
277 1.32 drochner ftype);
278 1.1 simonb if (rv == 0) {
279 1.16 cl l->l_flag &= ~L_SA_PAGEFAULT;
280 1.13 simonb KERNEL_PROC_UNLOCK(l);
281 1.13 simonb break;
282 1.1 simonb }
283 1.19 thorpej KSI_INIT_TRAP(&ksi);
284 1.17 matt ksi.ksi_signo = SIGSEGV;
285 1.17 matt ksi.ksi_trap = EXC_ISI;
286 1.17 matt ksi.ksi_addr = (void *)frame->srr0;
287 1.21 drochner ksi.ksi_code = (rv == EACCES ? SEGV_ACCERR : SEGV_MAPERR);
288 1.17 matt trapsignal(l, &ksi);
289 1.16 cl l->l_flag &= ~L_SA_PAGEFAULT;
290 1.10 thorpej KERNEL_PROC_UNLOCK(l);
291 1.1 simonb break;
292 1.1 simonb
293 1.1 simonb case EXC_AST|EXC_USER:
294 1.11 matt curcpu()->ci_astpending = 0; /* we are about to do it */
295 1.10 thorpej KERNEL_PROC_LOCK(l);
296 1.1 simonb uvmexp.softs++;
297 1.1 simonb if (p->p_flag & P_OWEUPC) {
298 1.1 simonb p->p_flag &= ~P_OWEUPC;
299 1.1 simonb ADDUPROF(p);
300 1.1 simonb }
301 1.1 simonb /* Check whether we are being preempted. */
302 1.11 matt if (curcpu()->ci_want_resched)
303 1.10 thorpej preempt(0);
304 1.10 thorpej KERNEL_PROC_UNLOCK(l);
305 1.1 simonb break;
306 1.1 simonb
307 1.1 simonb
308 1.1 simonb case EXC_ALI|EXC_USER:
309 1.10 thorpej KERNEL_PROC_LOCK(l);
310 1.17 matt if (fix_unaligned(l, frame) != 0) {
311 1.19 thorpej KSI_INIT_TRAP(&ksi);
312 1.17 matt ksi.ksi_signo = SIGBUS;
313 1.17 matt ksi.ksi_trap = EXC_ALI;
314 1.17 matt ksi.ksi_addr = (void *)frame->dar;
315 1.17 matt trapsignal(l, &ksi);
316 1.17 matt } else
317 1.1 simonb frame->srr0 += 4;
318 1.10 thorpej KERNEL_PROC_UNLOCK(l);
319 1.1 simonb break;
320 1.1 simonb
321 1.1 simonb case EXC_PGM|EXC_USER:
322 1.7 simonb /*
323 1.7 simonb * Illegal insn:
324 1.1 simonb *
325 1.7 simonb * let's try to see if it's FPU and can be emulated.
326 1.1 simonb */
327 1.24 simonb uvmexp.traps++;
328 1.10 thorpej if (!(l->l_addr->u_pcb.pcb_flags & PCB_FPU)) {
329 1.10 thorpej memset(&l->l_addr->u_pcb.pcb_fpu, 0,
330 1.10 thorpej sizeof l->l_addr->u_pcb.pcb_fpu);
331 1.10 thorpej l->l_addr->u_pcb.pcb_flags |= PCB_FPU;
332 1.1 simonb }
333 1.1 simonb
334 1.7 simonb if ((rv = fpu_emulate(frame,
335 1.10 thorpej (struct fpreg *)&l->l_addr->u_pcb.pcb_fpu))) {
336 1.19 thorpej KSI_INIT_TRAP(&ksi);
337 1.17 matt ksi.ksi_signo = rv;
338 1.17 matt ksi.ksi_trap = EXC_PGM;
339 1.17 matt ksi.ksi_addr = (void *)frame->srr0;
340 1.10 thorpej KERNEL_PROC_LOCK(l);
341 1.17 matt trapsignal(l, &ksi);
342 1.10 thorpej KERNEL_PROC_UNLOCK(l);
343 1.1 simonb }
344 1.1 simonb break;
345 1.1 simonb
346 1.1 simonb case EXC_MCHK:
347 1.1 simonb {
348 1.11 matt struct faultbuf *fb;
349 1.1 simonb
350 1.10 thorpej if ((fb = l->l_addr->u_pcb.pcb_onfault) != NULL) {
351 1.11 matt frame->tf_xtra[TF_PID] = KERNEL_PID;
352 1.11 matt frame->srr0 = fb->fb_pc;
353 1.1 simonb frame->srr1 |= PSL_IR; /* Re-enable IMMU */
354 1.11 matt frame->fixreg[1] = fb->fb_sp;
355 1.11 matt frame->fixreg[2] = fb->fb_r2;
356 1.1 simonb frame->fixreg[3] = 1; /* Return TRUE */
357 1.11 matt frame->cr = fb->fb_cr;
358 1.11 matt memcpy(&frame->fixreg[13], fb->fb_fixreg,
359 1.11 matt sizeof(fb->fb_fixreg));
360 1.1 simonb goto done;
361 1.1 simonb }
362 1.1 simonb }
363 1.1 simonb goto brain_damage;
364 1.1 simonb default:
365 1.13 simonb brain_damage:
366 1.11 matt printf("trap type 0x%x at 0x%lx\n", type, frame->srr0);
367 1.1 simonb #ifdef DDB
368 1.1 simonb if (kdb_trap(type, frame))
369 1.1 simonb goto done;
370 1.1 simonb #endif
371 1.1 simonb #ifdef TRAP_PANICWAIT
372 1.1 simonb printf("Press a key to panic.\n");
373 1.1 simonb cngetc();
374 1.1 simonb #endif
375 1.1 simonb panic("trap");
376 1.1 simonb }
377 1.1 simonb
378 1.20 cl /* Invoke MI userret code */
379 1.20 cl mi_userret(l);
380 1.10 thorpej
381 1.10 thorpej curcpu()->ci_schedstate.spc_curpriority = l->l_priority = l->l_usrpri;
382 1.13 simonb done:
383 1.9 thorpej return;
384 1.1 simonb }
385 1.1 simonb
386 1.1 simonb int
387 1.1 simonb ctx_setup(int ctx, int srr1)
388 1.1 simonb {
389 1.1 simonb volatile struct pmap *pm;
390 1.1 simonb
391 1.1 simonb /* Update PID if we're returning to user mode. */
392 1.1 simonb if (srr1 & PSL_PR) {
393 1.1 simonb pm = curproc->p_vmspace->vm_map.pmap;
394 1.1 simonb if (!pm->pm_ctx) {
395 1.26 scw ctx_alloc(__UNVOLATILE(pm));
396 1.1 simonb }
397 1.1 simonb ctx = pm->pm_ctx;
398 1.1 simonb if (srr1 & PSL_SE) {
399 1.1 simonb int dbreg, mask = 0x48000000;
400 1.1 simonb /*
401 1.1 simonb * Set the Internal Debug and
402 1.1 simonb * Instruction Completion bits of
403 1.1 simonb * the DBCR0 register.
404 1.1 simonb *
405 1.1 simonb * XXX this is also used by jtag debuggers...
406 1.1 simonb */
407 1.28 perry __asm volatile("mfspr %0,0x3f2;"
408 1.13 simonb "or %0,%0,%1;"
409 1.13 simonb "mtspr 0x3f2,%0;" :
410 1.13 simonb "=&r" (dbreg) : "r" (mask));
411 1.1 simonb }
412 1.1 simonb }
413 1.1 simonb else if (!ctx) {
414 1.1 simonb ctx = KERNEL_PID;
415 1.1 simonb }
416 1.1 simonb return (ctx);
417 1.1 simonb }
418 1.1 simonb
419 1.1 simonb /*
420 1.1 simonb * Used by copyin()/copyout()
421 1.1 simonb */
422 1.1 simonb extern vaddr_t vmaprange __P((struct proc *, vaddr_t, vsize_t, int));
423 1.1 simonb extern void vunmaprange __P((vaddr_t, vsize_t));
424 1.13 simonb static int bigcopyin __P((const void *, void *, size_t ));
425 1.1 simonb static int bigcopyout __P((const void *, void *, size_t ));
426 1.1 simonb
427 1.1 simonb int
428 1.1 simonb copyin(const void *udaddr, void *kaddr, size_t len)
429 1.1 simonb {
430 1.1 simonb struct pmap *pm = curproc->p_vmspace->vm_map.pmap;
431 1.1 simonb int msr, pid, tmp, ctx;
432 1.11 matt struct faultbuf env;
433 1.1 simonb
434 1.1 simonb /* For bigger buffers use the faster copy */
435 1.25 simonb if (len > 256)
436 1.25 simonb return (bigcopyin(udaddr, kaddr, len));
437 1.1 simonb
438 1.11 matt if (setfault(&env)) {
439 1.1 simonb curpcb->pcb_onfault = 0;
440 1.1 simonb return EFAULT;
441 1.1 simonb }
442 1.1 simonb
443 1.1 simonb if (!(ctx = pm->pm_ctx)) {
444 1.1 simonb /* No context -- assign it one */
445 1.1 simonb ctx_alloc(pm);
446 1.1 simonb ctx = pm->pm_ctx;
447 1.1 simonb }
448 1.1 simonb
449 1.29 perry __asm volatile("addi %6,%6,1; mtctr %6;" /* Set up counter */
450 1.1 simonb "mfmsr %0;" /* Save MSR */
451 1.1 simonb "li %1,0x20; "
452 1.1 simonb "andc %1,%0,%1; mtmsr %1;" /* Disable IMMU */
453 1.1 simonb "mfpid %1;" /* Save old PID */
454 1.1 simonb "sync; isync;"
455 1.1 simonb
456 1.1 simonb "1: bdz 2f;" /* while len */
457 1.1 simonb "mtpid %3; sync;" /* Load user ctx */
458 1.1 simonb "lbz %2,0(%4); addi %4,%4,1;" /* Load byte */
459 1.1 simonb "sync; isync;"
460 1.1 simonb "mtpid %1;sync;"
461 1.13 simonb "stb %2,0(%5); dcbf 0,%5; addi %5,%5,1;" /* Store kernel byte */
462 1.1 simonb "sync; isync;"
463 1.1 simonb "b 1b;" /* repeat */
464 1.1 simonb
465 1.1 simonb "2: mtpid %1; mtmsr %0;" /* Restore PID and MSR */
466 1.1 simonb "sync; isync;"
467 1.1 simonb : "=&r" (msr), "=&r" (pid), "=&r" (tmp)
468 1.23 scw : "r" (ctx), "b" (udaddr), "b" (kaddr), "b" (len));
469 1.1 simonb
470 1.1 simonb curpcb->pcb_onfault = 0;
471 1.1 simonb return 0;
472 1.1 simonb }
473 1.1 simonb
474 1.1 simonb static int
475 1.1 simonb bigcopyin(const void *udaddr, void *kaddr, size_t len)
476 1.1 simonb {
477 1.1 simonb const char *up;
478 1.1 simonb char *kp = kaddr;
479 1.10 thorpej struct lwp *l = curlwp;
480 1.10 thorpej struct proc *p;
481 1.1 simonb int error;
482 1.1 simonb
483 1.10 thorpej if (!l) {
484 1.1 simonb return EFAULT;
485 1.1 simonb }
486 1.1 simonb
487 1.10 thorpej p = l->l_proc;
488 1.10 thorpej
489 1.1 simonb /*
490 1.7 simonb * Stolen from physio():
491 1.1 simonb */
492 1.10 thorpej PHOLD(l);
493 1.37 chs error = uvm_vslock(p->p_vmspace, __UNCONST(udaddr), len, VM_PROT_READ);
494 1.1 simonb if (error) {
495 1.10 thorpej PRELE(l);
496 1.1 simonb return EFAULT;
497 1.1 simonb }
498 1.1 simonb up = (char *)vmaprange(p, (vaddr_t)udaddr, len, VM_PROT_READ);
499 1.1 simonb
500 1.2 wiz memcpy(kp, up, len);
501 1.1 simonb vunmaprange((vaddr_t)up, len);
502 1.37 chs uvm_vsunlock(p->p_vmspace, __UNCONST(udaddr), len);
503 1.10 thorpej PRELE(l);
504 1.1 simonb
505 1.7 simonb return 0;
506 1.1 simonb }
507 1.1 simonb
508 1.1 simonb int
509 1.1 simonb copyout(const void *kaddr, void *udaddr, size_t len)
510 1.1 simonb {
511 1.1 simonb struct pmap *pm = curproc->p_vmspace->vm_map.pmap;
512 1.1 simonb int msr, pid, tmp, ctx;
513 1.11 matt struct faultbuf env;
514 1.1 simonb
515 1.1 simonb /* For big copies use more efficient routine */
516 1.25 simonb if (len > 256)
517 1.25 simonb return (bigcopyout(kaddr, udaddr, len));
518 1.1 simonb
519 1.11 matt if (setfault(&env)) {
520 1.1 simonb curpcb->pcb_onfault = 0;
521 1.1 simonb return EFAULT;
522 1.1 simonb }
523 1.1 simonb
524 1.1 simonb if (!(ctx = pm->pm_ctx)) {
525 1.1 simonb /* No context -- assign it one */
526 1.1 simonb ctx_alloc(pm);
527 1.1 simonb ctx = pm->pm_ctx;
528 1.1 simonb }
529 1.1 simonb
530 1.29 perry __asm volatile("addi %6,%6,1; mtctr %6;" /* Set up counter */
531 1.1 simonb "mfmsr %0;" /* Save MSR */
532 1.1 simonb "li %1,0x20; "
533 1.1 simonb "andc %1,%0,%1; mtmsr %1;" /* Disable IMMU */
534 1.1 simonb "mfpid %1;" /* Save old PID */
535 1.1 simonb "sync; isync;"
536 1.1 simonb
537 1.1 simonb "1: bdz 2f;" /* while len */
538 1.1 simonb "mtpid %1;sync;"
539 1.1 simonb "lbz %2,0(%5); addi %5,%5,1;" /* Load kernel byte */
540 1.1 simonb "sync; isync;"
541 1.1 simonb "mtpid %3; sync;" /* Load user ctx */
542 1.13 simonb "stb %2,0(%4); dcbf 0,%4; addi %4,%4,1;" /* Store user byte */
543 1.1 simonb "sync; isync;"
544 1.1 simonb "b 1b;" /* repeat */
545 1.1 simonb
546 1.1 simonb "2: mtpid %1; mtmsr %0;" /* Restore PID and MSR */
547 1.1 simonb "sync; isync;"
548 1.1 simonb : "=&r" (msr), "=&r" (pid), "=&r" (tmp)
549 1.23 scw : "r" (ctx), "b" (udaddr), "b" (kaddr), "b" (len));
550 1.1 simonb
551 1.1 simonb curpcb->pcb_onfault = 0;
552 1.1 simonb return 0;
553 1.1 simonb }
554 1.1 simonb
555 1.1 simonb static int
556 1.1 simonb bigcopyout(const void *kaddr, void *udaddr, size_t len)
557 1.1 simonb {
558 1.1 simonb char *up;
559 1.26 scw const char *kp = (const char *)kaddr;
560 1.10 thorpej struct lwp *l = curlwp;
561 1.10 thorpej struct proc *p;
562 1.1 simonb int error;
563 1.1 simonb
564 1.10 thorpej if (!l) {
565 1.1 simonb return EFAULT;
566 1.1 simonb }
567 1.1 simonb
568 1.10 thorpej p = l->l_proc;
569 1.10 thorpej
570 1.1 simonb /*
571 1.7 simonb * Stolen from physio():
572 1.1 simonb */
573 1.10 thorpej PHOLD(l);
574 1.37 chs error = uvm_vslock(p->p_vmspace, udaddr, len, VM_PROT_WRITE);
575 1.1 simonb if (error) {
576 1.10 thorpej PRELE(l);
577 1.1 simonb return EFAULT;
578 1.1 simonb }
579 1.7 simonb up = (char *)vmaprange(p, (vaddr_t)udaddr, len,
580 1.13 simonb VM_PROT_READ | VM_PROT_WRITE);
581 1.1 simonb
582 1.2 wiz memcpy(up, kp, len);
583 1.1 simonb vunmaprange((vaddr_t)up, len);
584 1.37 chs uvm_vsunlock(p->p_vmspace, udaddr, len);
585 1.10 thorpej PRELE(l);
586 1.1 simonb
587 1.7 simonb return 0;
588 1.1 simonb }
589 1.1 simonb
590 1.1 simonb /*
591 1.1 simonb * kcopy(const void *src, void *dst, size_t len);
592 1.1 simonb *
593 1.1 simonb * Copy len bytes from src to dst, aborting if we encounter a fatal
594 1.1 simonb * page fault.
595 1.1 simonb *
596 1.1 simonb * kcopy() _must_ save and restore the old fault handler since it is
597 1.1 simonb * called by uiomove(), which may be in the path of servicing a non-fatal
598 1.1 simonb * page fault.
599 1.1 simonb */
600 1.1 simonb int
601 1.1 simonb kcopy(const void *src, void *dst, size_t len)
602 1.1 simonb {
603 1.11 matt struct faultbuf env, *oldfault;
604 1.1 simonb
605 1.1 simonb oldfault = curpcb->pcb_onfault;
606 1.11 matt if (setfault(&env)) {
607 1.1 simonb curpcb->pcb_onfault = oldfault;
608 1.1 simonb return EFAULT;
609 1.1 simonb }
610 1.1 simonb
611 1.2 wiz memcpy(dst, src, len);
612 1.1 simonb
613 1.1 simonb curpcb->pcb_onfault = oldfault;
614 1.1 simonb return 0;
615 1.1 simonb }
616 1.1 simonb
617 1.1 simonb int
618 1.1 simonb badaddr(void *addr, size_t size)
619 1.1 simonb {
620 1.1 simonb
621 1.1 simonb return badaddr_read(addr, size, NULL);
622 1.1 simonb }
623 1.1 simonb
624 1.1 simonb int
625 1.1 simonb badaddr_read(void *addr, size_t size, int *rptr)
626 1.1 simonb {
627 1.11 matt struct faultbuf env;
628 1.1 simonb int x;
629 1.1 simonb
630 1.1 simonb /* Get rid of any stale machine checks that have been waiting. */
631 1.28 perry __asm volatile ("sync; isync");
632 1.1 simonb
633 1.11 matt if (setfault(&env)) {
634 1.1 simonb curpcb->pcb_onfault = 0;
635 1.28 perry __asm volatile ("sync");
636 1.1 simonb return 1;
637 1.1 simonb }
638 1.1 simonb
639 1.28 perry __asm volatile ("sync");
640 1.1 simonb
641 1.1 simonb switch (size) {
642 1.1 simonb case 1:
643 1.1 simonb x = *(volatile int8_t *)addr;
644 1.1 simonb break;
645 1.1 simonb case 2:
646 1.1 simonb x = *(volatile int16_t *)addr;
647 1.1 simonb break;
648 1.1 simonb case 4:
649 1.1 simonb x = *(volatile int32_t *)addr;
650 1.1 simonb break;
651 1.1 simonb default:
652 1.1 simonb panic("badaddr: invalid size (%d)", size);
653 1.1 simonb }
654 1.1 simonb
655 1.1 simonb /* Make sure we took the machine check, if we caused one. */
656 1.28 perry __asm volatile ("sync; isync");
657 1.1 simonb
658 1.1 simonb curpcb->pcb_onfault = 0;
659 1.28 perry __asm volatile ("sync"); /* To be sure. */
660 1.1 simonb
661 1.1 simonb /* Use the value to avoid reorder. */
662 1.1 simonb if (rptr)
663 1.1 simonb *rptr = x;
664 1.1 simonb
665 1.1 simonb return 0;
666 1.1 simonb }
667 1.1 simonb
668 1.1 simonb /*
669 1.1 simonb * For now, this only deals with the particular unaligned access case
670 1.1 simonb * that gcc tends to generate. Eventually it should handle all of the
671 1.1 simonb * possibilities that can happen on a 32-bit PowerPC in big-endian mode.
672 1.1 simonb */
673 1.1 simonb
674 1.1 simonb static int
675 1.10 thorpej fix_unaligned(struct lwp *l, struct trapframe *frame)
676 1.1 simonb {
677 1.1 simonb
678 1.1 simonb return -1;
679 1.10 thorpej }
680 1.10 thorpej
681 1.10 thorpej /*
682 1.10 thorpej * Start a new LWP
683 1.10 thorpej */
684 1.10 thorpej void
685 1.10 thorpej startlwp(arg)
686 1.10 thorpej void *arg;
687 1.10 thorpej {
688 1.10 thorpej int err;
689 1.10 thorpej ucontext_t *uc = arg;
690 1.10 thorpej struct lwp *l = curlwp;
691 1.10 thorpej
692 1.10 thorpej err = cpu_setmcontext(l, &uc->uc_mcontext, uc->uc_flags);
693 1.10 thorpej #if DIAGNOSTIC
694 1.10 thorpej if (err) {
695 1.10 thorpej printf("Error %d from cpu_setmcontext.", err);
696 1.10 thorpej }
697 1.10 thorpej #endif
698 1.10 thorpej pool_put(&lwp_uc_pool, uc);
699 1.10 thorpej
700 1.10 thorpej upcallret(l);
701 1.10 thorpej }
702 1.10 thorpej
703 1.10 thorpej /*
704 1.10 thorpej * XXX This is a terrible name.
705 1.10 thorpej */
706 1.10 thorpej void
707 1.10 thorpej upcallret(l)
708 1.10 thorpej struct lwp *l;
709 1.10 thorpej {
710 1.10 thorpej
711 1.20 cl /* Invoke MI userret code */
712 1.20 cl mi_userret(l);
713 1.10 thorpej
714 1.10 thorpej curcpu()->ci_schedstate.spc_curpriority = l->l_priority = l->l_usrpri;
715 1.1 simonb }
716