oea_machdep.c revision 1.52 1 1.52 joerg /* $NetBSD: oea_machdep.c,v 1.52 2010/02/08 19:02:31 joerg Exp $ */
2 1.1 matt
3 1.1 matt /*
4 1.1 matt * Copyright (C) 2002 Matt Thomas
5 1.1 matt * Copyright (C) 1995, 1996 Wolfgang Solfrank.
6 1.1 matt * Copyright (C) 1995, 1996 TooLs GmbH.
7 1.1 matt * All rights reserved.
8 1.1 matt *
9 1.1 matt * Redistribution and use in source and binary forms, with or without
10 1.1 matt * modification, are permitted provided that the following conditions
11 1.1 matt * are met:
12 1.1 matt * 1. Redistributions of source code must retain the above copyright
13 1.1 matt * notice, this list of conditions and the following disclaimer.
14 1.1 matt * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 matt * notice, this list of conditions and the following disclaimer in the
16 1.1 matt * documentation and/or other materials provided with the distribution.
17 1.1 matt * 3. All advertising materials mentioning features or use of this software
18 1.1 matt * must display the following acknowledgement:
19 1.1 matt * This product includes software developed by TooLs GmbH.
20 1.1 matt * 4. The name of TooLs GmbH may not be used to endorse or promote products
21 1.1 matt * derived from this software without specific prior written permission.
22 1.1 matt *
23 1.1 matt * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
24 1.1 matt * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
25 1.1 matt * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
26 1.1 matt * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
27 1.1 matt * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
28 1.1 matt * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
29 1.1 matt * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
30 1.1 matt * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
31 1.1 matt * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
32 1.1 matt * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 1.1 matt */
34 1.9 lukem
35 1.9 lukem #include <sys/cdefs.h>
36 1.52 joerg __KERNEL_RCSID(0, "$NetBSD: oea_machdep.c,v 1.52 2010/02/08 19:02:31 joerg Exp $");
37 1.1 matt
38 1.41 garbled #include "opt_ppcarch.h"
39 1.1 matt #include "opt_compat_netbsd.h"
40 1.1 matt #include "opt_ddb.h"
41 1.1 matt #include "opt_kgdb.h"
42 1.1 matt #include "opt_ipkdb.h"
43 1.1 matt #include "opt_multiprocessor.h"
44 1.1 matt #include "opt_altivec.h"
45 1.1 matt
46 1.1 matt #include <sys/param.h>
47 1.1 matt #include <sys/buf.h>
48 1.1 matt #include <sys/exec.h>
49 1.1 matt #include <sys/malloc.h>
50 1.1 matt #include <sys/mbuf.h>
51 1.1 matt #include <sys/mount.h>
52 1.1 matt #include <sys/msgbuf.h>
53 1.1 matt #include <sys/proc.h>
54 1.1 matt #include <sys/reboot.h>
55 1.1 matt #include <sys/syscallargs.h>
56 1.1 matt #include <sys/syslog.h>
57 1.1 matt #include <sys/systm.h>
58 1.1 matt #include <sys/kernel.h>
59 1.1 matt #include <sys/boot_flag.h>
60 1.1 matt
61 1.1 matt #include <uvm/uvm_extern.h>
62 1.1 matt
63 1.1 matt #include <net/netisr.h>
64 1.1 matt
65 1.1 matt #ifdef DDB
66 1.1 matt #include <machine/db_machdep.h>
67 1.1 matt #include <ddb/db_extern.h>
68 1.1 matt #endif
69 1.1 matt
70 1.1 matt #ifdef KGDB
71 1.1 matt #include <sys/kgdb.h>
72 1.1 matt #endif
73 1.1 matt
74 1.1 matt #ifdef IPKDB
75 1.1 matt #include <ipkdb/ipkdb.h>
76 1.1 matt #endif
77 1.1 matt
78 1.1 matt #include <powerpc/oea/bat.h>
79 1.1 matt #include <powerpc/oea/sr_601.h>
80 1.43 garbled #include <powerpc/oea/cpufeat.h>
81 1.1 matt #include <powerpc/trap.h>
82 1.1 matt #include <powerpc/stdarg.h>
83 1.1 matt #include <powerpc/spr.h>
84 1.1 matt #include <powerpc/pte.h>
85 1.1 matt #include <powerpc/altivec.h>
86 1.1 matt #include <machine/powerpc.h>
87 1.1 matt
88 1.1 matt char machine[] = MACHINE; /* from <machine/param.h> */
89 1.1 matt char machine_arch[] = MACHINE_ARCH; /* from <machine/param.h> */
90 1.1 matt
91 1.1 matt struct vm_map *phys_map = NULL;
92 1.1 matt
93 1.1 matt /*
94 1.1 matt * Global variables used here and there
95 1.1 matt */
96 1.34 yamt static void trap0(void *);
97 1.26 sanjayl
98 1.26 sanjayl /* XXXSL: The battable is not initialized to non-zero for PPC_OEA64 and PPC_OEA64_BRIDGE */
99 1.1 matt struct bat battable[512];
100 1.26 sanjayl
101 1.2 matt register_t iosrtable[16]; /* I/O segments, for kernel_pmap setup */
102 1.47 phx #ifndef MSGBUFADDR
103 1.1 matt paddr_t msgbuf_paddr;
104 1.47 phx #endif
105 1.1 matt
106 1.1 matt void
107 1.1 matt oea_init(void (*handler)(void))
108 1.1 matt {
109 1.6 matt extern int trapcode[], trapsize[];
110 1.6 matt extern int sctrap[], scsize[];
111 1.6 matt extern int alitrap[], alisize[];
112 1.6 matt extern int dsitrap[], dsisize[];
113 1.41 garbled extern int trapstart[], trapend[];
114 1.40 garbled #ifdef PPC_OEA601
115 1.6 matt extern int dsi601trap[], dsi601size[];
116 1.40 garbled #endif
117 1.6 matt extern int decrint[], decrsize[];
118 1.6 matt extern int tlbimiss[], tlbimsize[];
119 1.6 matt extern int tlbdlmiss[], tlbdlmsize[];
120 1.6 matt extern int tlbdsmiss[], tlbdsmsize[];
121 1.1 matt #if defined(DDB) || defined(KGDB)
122 1.6 matt extern int ddblow[], ddbsize[];
123 1.1 matt #endif
124 1.1 matt #ifdef IPKDB
125 1.6 matt extern int ipkdblow[], ipkdbsize[];
126 1.1 matt #endif
127 1.1 matt #ifdef ALTIVEC
128 1.1 matt register_t msr;
129 1.1 matt #endif
130 1.45 phx uintptr_t exc, exc_base;
131 1.38 garbled #if defined(ALTIVEC) || defined(PPC_OEA)
132 1.1 matt register_t scratch;
133 1.38 garbled #endif
134 1.1 matt unsigned int cpuvers;
135 1.1 matt size_t size;
136 1.1 matt struct cpu_info * const ci = &cpu_info[0];
137 1.1 matt
138 1.45 phx #ifdef PPC_HIGH_VEC
139 1.45 phx exc_base = EXC_HIGHVEC;
140 1.45 phx #else
141 1.45 phx exc_base = 0;
142 1.45 phx #endif
143 1.1 matt mtspr(SPR_SPRG0, ci);
144 1.1 matt cpuvers = mfpvr() >> 16;
145 1.1 matt
146 1.1 matt /*
147 1.1 matt * Initialize proc0 and current pcb and pmap pointers.
148 1.1 matt */
149 1.1 matt KASSERT(ci != NULL);
150 1.1 matt KASSERT(curcpu() == ci);
151 1.1 matt lwp0.l_cpu = ci;
152 1.51 rmind
153 1.50 matt curpcb = lwp_getpcb(&lwp0);
154 1.51 rmind memset(curpcb, 0, sizeof(struct pcb));
155 1.1 matt
156 1.5 matt #ifdef ALTIVEC
157 1.5 matt /*
158 1.5 matt * Initialize the vectors with NaNs
159 1.5 matt */
160 1.5 matt for (scratch = 0; scratch < 32; scratch++) {
161 1.5 matt curpcb->pcb_vr.vreg[scratch][0] = 0x7FFFDEAD;
162 1.5 matt curpcb->pcb_vr.vreg[scratch][1] = 0x7FFFDEAD;
163 1.5 matt curpcb->pcb_vr.vreg[scratch][2] = 0x7FFFDEAD;
164 1.5 matt curpcb->pcb_vr.vreg[scratch][3] = 0x7FFFDEAD;
165 1.5 matt }
166 1.5 matt curpcb->pcb_vr.vscr = 0;
167 1.5 matt curpcb->pcb_vr.vrsave = 0;
168 1.5 matt #endif
169 1.12 matt curpm = curpcb->pcb_pm = pmap_kernel();
170 1.1 matt
171 1.1 matt /*
172 1.1 matt * Cause a PGM trap if we branch to 0.
173 1.25 mrg *
174 1.25 mrg * XXX GCC4.1 complains about memset on address zero, so
175 1.25 mrg * don't use the builtin.
176 1.1 matt */
177 1.25 mrg #undef memset
178 1.1 matt memset(0, 0, 0x100);
179 1.1 matt
180 1.1 matt /*
181 1.1 matt * Set up trap vectors. Don't assume vectors are on 0x100.
182 1.1 matt */
183 1.45 phx for (exc = exc_base; exc <= exc_base + EXC_LAST; exc += 0x100) {
184 1.45 phx switch (exc - exc_base) {
185 1.1 matt default:
186 1.6 matt size = (size_t)trapsize;
187 1.6 matt memcpy((void *)exc, trapcode, size);
188 1.1 matt break;
189 1.1 matt #if 0
190 1.1 matt case EXC_EXI:
191 1.1 matt /*
192 1.1 matt * This one is (potentially) installed during autoconf
193 1.1 matt */
194 1.1 matt break;
195 1.1 matt #endif
196 1.1 matt case EXC_SC:
197 1.6 matt size = (size_t)scsize;
198 1.45 phx memcpy((void *)exc, sctrap, size);
199 1.1 matt break;
200 1.1 matt case EXC_ALI:
201 1.6 matt size = (size_t)alisize;
202 1.45 phx memcpy((void *)exc, alitrap, size);
203 1.1 matt break;
204 1.1 matt case EXC_DSI:
205 1.40 garbled #ifdef PPC_OEA601
206 1.1 matt if (cpuvers == MPC601) {
207 1.6 matt size = (size_t)dsi601size;
208 1.45 phx memcpy((void *)exc, dsi601trap, size);
209 1.42 matt break;
210 1.43 garbled } else
211 1.43 garbled #endif /* PPC_OEA601 */
212 1.43 garbled if (oeacpufeat & OEACPU_NOBAT) {
213 1.43 garbled size = (size_t)alisize;
214 1.45 phx memcpy((void *)exc, alitrap, size);
215 1.43 garbled } else {
216 1.43 garbled size = (size_t)dsisize;
217 1.45 phx memcpy((void *)exc, dsitrap, size);
218 1.1 matt }
219 1.1 matt break;
220 1.1 matt case EXC_DECR:
221 1.6 matt size = (size_t)decrsize;
222 1.45 phx memcpy((void *)exc, decrint, size);
223 1.1 matt break;
224 1.1 matt case EXC_IMISS:
225 1.6 matt size = (size_t)tlbimsize;
226 1.45 phx memcpy((void *)exc, tlbimiss, size);
227 1.1 matt break;
228 1.1 matt case EXC_DLMISS:
229 1.6 matt size = (size_t)tlbdlmsize;
230 1.45 phx memcpy((void *)exc, tlbdlmiss, size);
231 1.1 matt break;
232 1.1 matt case EXC_DSMISS:
233 1.6 matt size = (size_t)tlbdsmsize;
234 1.45 phx memcpy((void *)exc, tlbdsmiss, size);
235 1.1 matt break;
236 1.1 matt case EXC_PERF:
237 1.6 matt size = (size_t)trapsize;
238 1.45 phx memcpy((void *)exc, trapcode, size);
239 1.45 phx memcpy((void *)(exc_base + EXC_VEC), trapcode, size);
240 1.1 matt break;
241 1.1 matt #if defined(DDB) || defined(IPKDB) || defined(KGDB)
242 1.1 matt case EXC_RUNMODETRC:
243 1.42 matt #ifdef PPC_OEA601
244 1.1 matt if (cpuvers != MPC601) {
245 1.42 matt #endif
246 1.6 matt size = (size_t)trapsize;
247 1.45 phx memcpy((void *)exc, trapcode, size);
248 1.1 matt break;
249 1.42 matt #ifdef PPC_OEA601
250 1.1 matt }
251 1.1 matt /* FALLTHROUGH */
252 1.42 matt #endif
253 1.1 matt case EXC_PGM:
254 1.1 matt case EXC_TRC:
255 1.1 matt case EXC_BPT:
256 1.1 matt #if defined(DDB) || defined(KGDB)
257 1.6 matt size = (size_t)ddbsize;
258 1.6 matt memcpy((void *)exc, ddblow, size);
259 1.1 matt #if defined(IPKDB)
260 1.1 matt #error "cannot enable IPKDB with DDB or KGDB"
261 1.1 matt #endif
262 1.1 matt #else
263 1.6 matt size = (size_t)ipkdbsize;
264 1.6 matt memcpy((void *)exc, ipkdblow, size);
265 1.1 matt #endif
266 1.1 matt break;
267 1.1 matt #endif /* DDB || IPKDB || KGDB */
268 1.1 matt }
269 1.1 matt #if 0
270 1.1 matt exc += roundup(size, 32);
271 1.1 matt #endif
272 1.1 matt }
273 1.1 matt
274 1.1 matt /*
275 1.34 yamt * Install a branch absolute to trap0 to force a panic.
276 1.34 yamt */
277 1.45 phx if ((uintptr_t)trap0 < 0x2000000) {
278 1.45 phx *(uint32_t *) 0 = 0x7c6802a6;
279 1.45 phx *(uint32_t *) 4 = 0x48000002 | (uintptr_t) trap0;
280 1.45 phx }
281 1.34 yamt
282 1.34 yamt /*
283 1.1 matt * Get the cache sizes because install_extint calls __syncicache.
284 1.1 matt */
285 1.1 matt cpu_probe_cache();
286 1.1 matt
287 1.1 matt #define MxSPR_MASK 0x7c1fffff
288 1.1 matt #define MFSPR_MQ 0x7c0002a6
289 1.1 matt #define MTSPR_MQ 0x7c0003a6
290 1.17 kleink #define MTSPR_IBAT0L 0x7c1183a6
291 1.17 kleink #define MTSPR_IBAT1L 0x7c1383a6
292 1.1 matt #define NOP 0x60000000
293 1.17 kleink #define B 0x48000000
294 1.18 kleink #define TLBSYNC 0x7c00046c
295 1.18 kleink #define SYNC 0x7c0004ac
296 1.1 matt
297 1.1 matt #ifdef ALTIVEC
298 1.1 matt #define MFSPR_VRSAVE 0x7c0042a6
299 1.1 matt #define MTSPR_VRSAVE 0x7c0043a6
300 1.1 matt
301 1.1 matt /*
302 1.1 matt * Try to set the VEC bit in the MSR. If it doesn't get set, we are
303 1.1 matt * not on a AltiVec capable processor.
304 1.1 matt */
305 1.24 perry __asm volatile (
306 1.1 matt "mfmsr %0; oris %1,%0,%2@h; mtmsr %1; isync; "
307 1.1 matt "mfmsr %1; mtmsr %0; isync"
308 1.1 matt : "=r"(msr), "=r"(scratch)
309 1.1 matt : "J"(PSL_VEC));
310 1.1 matt
311 1.1 matt /*
312 1.17 kleink * If we aren't on an AltiVec capable processor, we need to zap any of
313 1.17 kleink * the sequences we save/restore the VRSAVE SPR into NOPs.
314 1.1 matt */
315 1.1 matt if (scratch & PSL_VEC) {
316 1.1 matt cpu_altivec = 1;
317 1.1 matt } else {
318 1.1 matt int *ip = trapstart;
319 1.1 matt
320 1.1 matt for (; ip < trapend; ip++) {
321 1.1 matt if ((ip[0] & MxSPR_MASK) == MFSPR_VRSAVE) {
322 1.1 matt ip[0] = NOP; /* mfspr */
323 1.1 matt ip[1] = NOP; /* stw */
324 1.1 matt } else if ((ip[0] & MxSPR_MASK) == MTSPR_VRSAVE) {
325 1.1 matt ip[-1] = NOP; /* lwz */
326 1.1 matt ip[0] = NOP; /* mtspr */
327 1.1 matt }
328 1.1 matt }
329 1.1 matt }
330 1.1 matt #endif
331 1.1 matt
332 1.41 garbled /* XXX It would seem like this code could be elided ifndef 601, but
333 1.41 garbled * doing so breaks my power3 machine.
334 1.41 garbled */
335 1.1 matt /*
336 1.17 kleink * If we aren't on a MPC601 processor, we need to zap any of the
337 1.17 kleink * sequences we save/restore the MQ SPR into NOPs, and skip over the
338 1.17 kleink * sequences where we zap/restore BAT registers on kernel exit/entry.
339 1.1 matt */
340 1.1 matt if (cpuvers != MPC601) {
341 1.1 matt int *ip = trapstart;
342 1.1 matt
343 1.1 matt for (; ip < trapend; ip++) {
344 1.1 matt if ((ip[0] & MxSPR_MASK) == MFSPR_MQ) {
345 1.1 matt ip[0] = NOP; /* mfspr */
346 1.1 matt ip[1] = NOP; /* stw */
347 1.1 matt } else if ((ip[0] & MxSPR_MASK) == MTSPR_MQ) {
348 1.1 matt ip[-1] = NOP; /* lwz */
349 1.1 matt ip[0] = NOP; /* mtspr */
350 1.17 kleink } else if ((ip[0] & MxSPR_MASK) == MTSPR_IBAT0L) {
351 1.17 kleink if ((ip[1] & MxSPR_MASK) == MTSPR_IBAT1L)
352 1.17 kleink ip[-1] = B | 0x14; /* li */
353 1.17 kleink else
354 1.17 kleink ip[-4] = B | 0x24; /* lis */
355 1.1 matt }
356 1.1 matt }
357 1.1 matt }
358 1.1 matt
359 1.17 kleink /*
360 1.17 kleink * Sync the changed instructions.
361 1.17 kleink */
362 1.17 kleink __syncicache((void *) trapstart,
363 1.17 kleink (uintptr_t) trapend - (uintptr_t) trapstart);
364 1.41 garbled #ifdef PPC_OEA601
365 1.1 matt
366 1.1 matt /*
367 1.18 kleink * If we are on a MPC601 processor, we need to zap any tlbsync
368 1.18 kleink * instructions into sync. This differs from the above in
369 1.18 kleink * examing all kernel text, as opposed to just the exception handling.
370 1.18 kleink * We sync the icache on every instruction found since there are
371 1.18 kleink * only very few of them.
372 1.18 kleink */
373 1.18 kleink if (cpuvers == MPC601) {
374 1.18 kleink extern int kernel_text[], etext[];
375 1.18 kleink int *ip;
376 1.18 kleink
377 1.18 kleink for (ip = kernel_text; ip < etext; ip++)
378 1.18 kleink if (*ip == TLBSYNC) {
379 1.18 kleink *ip = SYNC;
380 1.18 kleink __syncicache(ip, sizeof(*ip));
381 1.18 kleink }
382 1.18 kleink }
383 1.40 garbled #endif /* PPC_OEA601 */
384 1.18 kleink
385 1.19 kleink /*
386 1.19 kleink * Configure a PSL user mask matching this processor.
387 1.19 kleink */
388 1.19 kleink cpu_psluserset = PSL_EE | PSL_PR | PSL_ME | PSL_IR | PSL_DR | PSL_RI;
389 1.19 kleink cpu_pslusermod = PSL_FP | PSL_FE0 | PSL_FE1 | PSL_LE | PSL_SE | PSL_BE;
390 1.40 garbled #ifdef PPC_OEA601
391 1.19 kleink if (cpuvers == MPC601) {
392 1.19 kleink cpu_psluserset &= PSL_601_MASK;
393 1.19 kleink cpu_pslusermod &= PSL_601_MASK;
394 1.19 kleink }
395 1.40 garbled #endif
396 1.19 kleink #ifdef ALTIVEC
397 1.19 kleink if (cpu_altivec)
398 1.19 kleink cpu_pslusermod |= PSL_VEC;
399 1.19 kleink #endif
400 1.45 phx #ifdef PPC_HIGH_VEC
401 1.45 phx cpu_psluserset |= PSL_IP; /* XXX ok? */
402 1.45 phx #endif
403 1.19 kleink
404 1.18 kleink /*
405 1.1 matt * external interrupt handler install
406 1.1 matt */
407 1.1 matt if (handler)
408 1.1 matt oea_install_extint(handler);
409 1.1 matt
410 1.45 phx __syncicache((void *)exc_base, EXC_LAST + 0x100);
411 1.1 matt
412 1.1 matt /*
413 1.1 matt * Now enable translation (and machine checks/recoverable interrupts).
414 1.1 matt */
415 1.26 sanjayl #ifdef PPC_OEA
416 1.24 perry __asm volatile ("sync; mfmsr %0; ori %0,%0,%1; mtmsr %0; isync"
417 1.1 matt : "=r"(scratch)
418 1.1 matt : "K"(PSL_IR|PSL_DR|PSL_ME|PSL_RI));
419 1.26 sanjayl #endif
420 1.1 matt
421 1.1 matt KASSERT(curcpu() == ci);
422 1.1 matt }
423 1.1 matt
424 1.40 garbled #ifdef PPC_OEA601
425 1.1 matt void
426 1.1 matt mpc601_ioseg_add(paddr_t pa, register_t len)
427 1.1 matt {
428 1.1 matt const u_int i = pa >> ADDR_SR_SHFT;
429 1.1 matt
430 1.1 matt if (len != BAT_BL_256M)
431 1.1 matt panic("mpc601_ioseg_add: len != 256M");
432 1.1 matt
433 1.1 matt /*
434 1.1 matt * Translate into an I/O segment, load it, and stash away for use
435 1.1 matt * in pmap_bootstrap().
436 1.1 matt */
437 1.1 matt iosrtable[i] = SR601(SR601_Ks, SR601_BUID_MEMFORCED, 0, i);
438 1.24 perry __asm volatile ("mtsrin %0,%1"
439 1.1 matt :: "r"(iosrtable[i]),
440 1.1 matt "r"(pa));
441 1.1 matt }
442 1.40 garbled #endif /* PPC_OEA601 */
443 1.26 sanjayl
444 1.39 garbled #if defined (PPC_OEA) || defined (PPC_OEA64_BRIDGE)
445 1.1 matt void
446 1.1 matt oea_iobat_add(paddr_t pa, register_t len)
447 1.1 matt {
448 1.1 matt static int n = 1;
449 1.1 matt const u_int i = pa >> 28;
450 1.1 matt battable[i].batl = BATL(pa, BAT_I|BAT_G, BAT_PP_RW);
451 1.1 matt battable[i].batu = BATU(pa, len, BAT_Vs);
452 1.1 matt
453 1.1 matt /*
454 1.1 matt * Let's start loading the BAT registers.
455 1.1 matt */
456 1.1 matt switch (n) {
457 1.1 matt case 1:
458 1.24 perry __asm volatile ("mtdbatl 1,%0; mtdbatu 1,%1;"
459 1.1 matt :: "r"(battable[i].batl),
460 1.1 matt "r"(battable[i].batu));
461 1.1 matt n = 2;
462 1.1 matt break;
463 1.1 matt case 2:
464 1.24 perry __asm volatile ("mtdbatl 2,%0; mtdbatu 2,%1;"
465 1.1 matt :: "r"(battable[i].batl),
466 1.1 matt "r"(battable[i].batu));
467 1.1 matt n = 3;
468 1.1 matt break;
469 1.1 matt case 3:
470 1.24 perry __asm volatile ("mtdbatl 3,%0; mtdbatu 3,%1;"
471 1.1 matt :: "r"(battable[i].batl),
472 1.1 matt "r"(battable[i].batu));
473 1.1 matt n = 4;
474 1.1 matt break;
475 1.1 matt default:
476 1.1 matt break;
477 1.3 matt }
478 1.3 matt }
479 1.3 matt
480 1.3 matt void
481 1.3 matt oea_iobat_remove(paddr_t pa)
482 1.3 matt {
483 1.3 matt register_t batu;
484 1.3 matt int i, n;
485 1.3 matt
486 1.3 matt n = pa >> ADDR_SR_SHFT;
487 1.3 matt if (!BAT_VA_MATCH_P(battable[n].batu, pa) ||
488 1.3 matt !BAT_VALID_P(battable[n].batu, PSL_PR))
489 1.3 matt return;
490 1.3 matt battable[n].batl = 0;
491 1.3 matt battable[n].batu = 0;
492 1.3 matt #define BAT_RESET(n) \
493 1.24 perry __asm volatile("mtdbatu %0,%1; mtdbatl %0,%1" :: "n"(n), "r"(0))
494 1.24 perry #define BATU_GET(n, r) __asm volatile("mfdbatu %0,%1" : "=r"(r) : "n"(n))
495 1.3 matt
496 1.3 matt for (i=1 ; i<4 ; i++) {
497 1.3 matt switch (i) {
498 1.3 matt case 1:
499 1.3 matt BATU_GET(1, batu);
500 1.3 matt if (BAT_VA_MATCH_P(batu, pa) &&
501 1.3 matt BAT_VALID_P(batu, PSL_PR))
502 1.3 matt BAT_RESET(1);
503 1.3 matt break;
504 1.3 matt case 2:
505 1.3 matt BATU_GET(2, batu);
506 1.3 matt if (BAT_VA_MATCH_P(batu, pa) &&
507 1.3 matt BAT_VALID_P(batu, PSL_PR))
508 1.3 matt BAT_RESET(2);
509 1.3 matt break;
510 1.3 matt case 3:
511 1.3 matt BATU_GET(3, batu);
512 1.3 matt if (BAT_VA_MATCH_P(batu, pa) &&
513 1.3 matt BAT_VALID_P(batu, PSL_PR))
514 1.3 matt BAT_RESET(3);
515 1.3 matt break;
516 1.3 matt default:
517 1.3 matt break;
518 1.3 matt }
519 1.1 matt }
520 1.1 matt }
521 1.1 matt
522 1.1 matt void
523 1.1 matt oea_batinit(paddr_t pa, ...)
524 1.1 matt {
525 1.1 matt struct mem_region *allmem, *availmem, *mp;
526 1.1 matt unsigned int cpuvers;
527 1.7 matt register_t msr = mfmsr();
528 1.1 matt va_list ap;
529 1.1 matt
530 1.1 matt cpuvers = mfpvr() >> 16;
531 1.1 matt
532 1.1 matt /*
533 1.1 matt * Initialize BAT registers to unmapped to not generate
534 1.1 matt * overlapping mappings below.
535 1.1 matt *
536 1.1 matt * The 601's implementation differs in the Valid bit being situated
537 1.1 matt * in the lower BAT register, and in being a unified BAT only whose
538 1.1 matt * four entries are accessed through the IBAT[0-3] SPRs.
539 1.1 matt *
540 1.1 matt * Also, while the 601 does distinguish between supervisor/user
541 1.14 uebayasi * protection keys, it does _not_ distinguish between validity in
542 1.14 uebayasi * supervisor/user mode.
543 1.1 matt */
544 1.7 matt if ((msr & (PSL_IR|PSL_DR)) == 0) {
545 1.40 garbled #ifdef PPC_OEA601
546 1.7 matt if (cpuvers == MPC601) {
547 1.24 perry __asm volatile ("mtibatl 0,%0" :: "r"(0));
548 1.24 perry __asm volatile ("mtibatl 1,%0" :: "r"(0));
549 1.24 perry __asm volatile ("mtibatl 2,%0" :: "r"(0));
550 1.24 perry __asm volatile ("mtibatl 3,%0" :: "r"(0));
551 1.40 garbled } else
552 1.40 garbled #endif /* PPC_OEA601 */
553 1.40 garbled {
554 1.24 perry __asm volatile ("mtibatu 0,%0" :: "r"(0));
555 1.24 perry __asm volatile ("mtibatu 1,%0" :: "r"(0));
556 1.24 perry __asm volatile ("mtibatu 2,%0" :: "r"(0));
557 1.24 perry __asm volatile ("mtibatu 3,%0" :: "r"(0));
558 1.24 perry __asm volatile ("mtdbatu 0,%0" :: "r"(0));
559 1.24 perry __asm volatile ("mtdbatu 1,%0" :: "r"(0));
560 1.24 perry __asm volatile ("mtdbatu 2,%0" :: "r"(0));
561 1.24 perry __asm volatile ("mtdbatu 3,%0" :: "r"(0));
562 1.7 matt }
563 1.1 matt }
564 1.1 matt
565 1.1 matt /*
566 1.1 matt * Set up BAT to map physical memory
567 1.1 matt */
568 1.40 garbled #ifdef PPC_OEA601
569 1.1 matt if (cpuvers == MPC601) {
570 1.40 garbled int i;
571 1.40 garbled
572 1.1 matt /*
573 1.1 matt * Set up battable to map the lowest 256 MB area.
574 1.1 matt * Map the lowest 32 MB area via BAT[0-3];
575 1.1 matt * BAT[01] are fixed, BAT[23] are floating.
576 1.1 matt */
577 1.1 matt for (i = 0; i < 32; i++) {
578 1.1 matt battable[i].batl = BATL601(i << 23,
579 1.1 matt BAT601_BSM_8M, BAT601_V);
580 1.1 matt battable[i].batu = BATU601(i << 23,
581 1.1 matt BAT601_M, BAT601_Ku, BAT601_PP_NONE);
582 1.1 matt }
583 1.24 perry __asm volatile ("mtibatu 0,%1; mtibatl 0,%0"
584 1.1 matt :: "r"(battable[0x00000000 >> 23].batl),
585 1.1 matt "r"(battable[0x00000000 >> 23].batu));
586 1.24 perry __asm volatile ("mtibatu 1,%1; mtibatl 1,%0"
587 1.1 matt :: "r"(battable[0x00800000 >> 23].batl),
588 1.1 matt "r"(battable[0x00800000 >> 23].batu));
589 1.24 perry __asm volatile ("mtibatu 2,%1; mtibatl 2,%0"
590 1.1 matt :: "r"(battable[0x01000000 >> 23].batl),
591 1.1 matt "r"(battable[0x01000000 >> 23].batu));
592 1.24 perry __asm volatile ("mtibatu 3,%1; mtibatl 3,%0"
593 1.1 matt :: "r"(battable[0x01800000 >> 23].batl),
594 1.1 matt "r"(battable[0x01800000 >> 23].batu));
595 1.40 garbled } else
596 1.40 garbled #endif /* PPC_OEA601 */
597 1.40 garbled {
598 1.1 matt /*
599 1.1 matt * Set up BAT0 to only map the lowest 256 MB area
600 1.1 matt */
601 1.1 matt battable[0].batl = BATL(0x00000000, BAT_M, BAT_PP_RW);
602 1.1 matt battable[0].batu = BATU(0x00000000, BAT_BL_256M, BAT_Vs);
603 1.1 matt
604 1.24 perry __asm volatile ("mtibatl 0,%0; mtibatu 0,%1;"
605 1.1 matt "mtdbatl 0,%0; mtdbatu 0,%1;"
606 1.1 matt :: "r"(battable[0].batl), "r"(battable[0].batu));
607 1.1 matt }
608 1.1 matt
609 1.1 matt /*
610 1.1 matt * Now setup other fixed bat registers
611 1.1 matt *
612 1.1 matt * Note that we still run in real mode, and the BAT
613 1.1 matt * registers were cleared above.
614 1.1 matt */
615 1.1 matt
616 1.1 matt va_start(ap, pa);
617 1.1 matt
618 1.1 matt /*
619 1.1 matt * Add any I/O BATs specificed;
620 1.1 matt * use I/O segments on the BAT-starved 601.
621 1.1 matt */
622 1.40 garbled #ifdef PPC_OEA601
623 1.1 matt if (cpuvers == MPC601) {
624 1.1 matt while (pa != 0) {
625 1.1 matt register_t len = va_arg(ap, register_t);
626 1.1 matt mpc601_ioseg_add(pa, len);
627 1.1 matt pa = va_arg(ap, paddr_t);
628 1.1 matt }
629 1.40 garbled } else
630 1.40 garbled #endif
631 1.40 garbled {
632 1.1 matt while (pa != 0) {
633 1.1 matt register_t len = va_arg(ap, register_t);
634 1.1 matt oea_iobat_add(pa, len);
635 1.1 matt pa = va_arg(ap, paddr_t);
636 1.1 matt }
637 1.1 matt }
638 1.1 matt
639 1.1 matt va_end(ap);
640 1.1 matt
641 1.1 matt /*
642 1.1 matt * Set up battable to map all RAM regions.
643 1.1 matt * This is here because mem_regions() call needs bat0 set up.
644 1.1 matt */
645 1.1 matt mem_regions(&allmem, &availmem);
646 1.40 garbled #ifdef PPC_OEA601
647 1.1 matt if (cpuvers == MPC601) {
648 1.1 matt for (mp = allmem; mp->size; mp++) {
649 1.22 he paddr_t paddr = mp->start & 0xff800000;
650 1.1 matt paddr_t end = mp->start + mp->size;
651 1.1 matt
652 1.1 matt do {
653 1.22 he u_int ix = paddr >> 23;
654 1.1 matt
655 1.22 he battable[ix].batl =
656 1.22 he BATL601(paddr, BAT601_BSM_8M, BAT601_V);
657 1.22 he battable[ix].batu =
658 1.22 he BATU601(paddr, BAT601_M, BAT601_Ku, BAT601_PP_NONE);
659 1.22 he paddr += (1 << 23);
660 1.22 he } while (paddr < end);
661 1.1 matt }
662 1.40 garbled } else
663 1.40 garbled #endif
664 1.40 garbled {
665 1.1 matt for (mp = allmem; mp->size; mp++) {
666 1.22 he paddr_t paddr = mp->start & 0xf0000000;
667 1.1 matt paddr_t end = mp->start + mp->size;
668 1.1 matt
669 1.1 matt do {
670 1.22 he u_int ix = paddr >> 28;
671 1.1 matt
672 1.22 he battable[ix].batl =
673 1.22 he BATL(paddr, BAT_M, BAT_PP_RW);
674 1.22 he battable[ix].batu =
675 1.22 he BATU(paddr, BAT_BL_256M, BAT_Vs);
676 1.22 he paddr += SEGMENT_LENGTH;
677 1.22 he } while (paddr < end);
678 1.1 matt }
679 1.1 matt }
680 1.1 matt }
681 1.39 garbled #endif /* PPC_OEA || PPC_OEA64_BRIDGE */
682 1.1 matt
683 1.1 matt void
684 1.1 matt oea_install_extint(void (*handler)(void))
685 1.1 matt {
686 1.6 matt extern int extint[], extsize[];
687 1.6 matt extern int extint_call[];
688 1.6 matt uintptr_t offset = (uintptr_t)handler - (uintptr_t)extint_call;
689 1.1 matt int omsr, msr;
690 1.1 matt
691 1.1 matt #ifdef DIAGNOSTIC
692 1.1 matt if (offset > 0x1ffffff)
693 1.1 matt panic("install_extint: %p too far away (%#lx)", handler,
694 1.1 matt (unsigned long) offset);
695 1.1 matt #endif
696 1.24 perry __asm volatile ("mfmsr %0; andi. %1,%0,%2; mtmsr %1"
697 1.1 matt : "=r" (omsr), "=r" (msr)
698 1.1 matt : "K" ((u_short)~PSL_EE));
699 1.6 matt extint_call[0] = (extint_call[0] & 0xfc000003) | offset;
700 1.45 phx __syncicache((void *)extint_call, sizeof extint_call[0]);
701 1.45 phx #ifdef PPC_HIGH_VEC
702 1.45 phx memcpy((void *)(EXC_HIGHVEC + EXC_EXI), extint, (size_t)extsize);
703 1.45 phx __syncicache((void *)(EXC_HIGHVEC + EXC_EXI), (int)extsize);
704 1.45 phx #else
705 1.6 matt memcpy((void *)EXC_EXI, extint, (size_t)extsize);
706 1.6 matt __syncicache((void *)EXC_EXI, (int)extsize);
707 1.45 phx #endif
708 1.24 perry __asm volatile ("mtmsr %0" :: "r"(omsr));
709 1.1 matt }
710 1.1 matt
711 1.1 matt /*
712 1.1 matt * Machine dependent startup code.
713 1.1 matt */
714 1.1 matt void
715 1.1 matt oea_startup(const char *model)
716 1.1 matt {
717 1.1 matt uintptr_t sz;
718 1.32 christos void *v;
719 1.1 matt vaddr_t minaddr, maxaddr;
720 1.1 matt char pbuf[9];
721 1.1 matt
722 1.1 matt KASSERT(curcpu() != NULL);
723 1.1 matt KASSERT(lwp0.l_cpu != NULL);
724 1.4 matt KASSERT(curcpu()->ci_intstk != 0);
725 1.4 matt KASSERT(curcpu()->ci_intrdepth == -1);
726 1.1 matt
727 1.47 phx sz = round_page(MSGBUFSIZE);
728 1.47 phx #ifdef MSGBUFADDR
729 1.47 phx v = (void *) MSGBUFADDR;
730 1.47 phx #else
731 1.1 matt /*
732 1.1 matt * If the msgbuf is not in segment 0, allocate KVA for it and access
733 1.1 matt * it via mapped pages. [This prevents unneeded BAT switches.]
734 1.1 matt */
735 1.32 christos v = (void *) msgbuf_paddr;
736 1.1 matt if (msgbuf_paddr + sz > SEGMENT_LENGTH) {
737 1.47 phx u_int i;
738 1.47 phx
739 1.1 matt minaddr = 0;
740 1.1 matt if (uvm_map(kernel_map, &minaddr, sz,
741 1.1 matt NULL, UVM_UNKNOWN_OFFSET, 0,
742 1.1 matt UVM_MAPFLAG(UVM_PROT_NONE, UVM_PROT_NONE,
743 1.1 matt UVM_INH_NONE, UVM_ADV_NORMAL, 0)) != 0)
744 1.1 matt panic("startup: cannot allocate VM for msgbuf");
745 1.32 christos v = (void *)minaddr;
746 1.8 thorpej for (i = 0; i < sz; i += PAGE_SIZE) {
747 1.1 matt pmap_kenter_pa(minaddr + i, msgbuf_paddr + i,
748 1.48 cegger VM_PROT_READ|VM_PROT_WRITE, 0);
749 1.1 matt }
750 1.1 matt pmap_update(pmap_kernel());
751 1.1 matt }
752 1.47 phx #endif
753 1.1 matt initmsgbuf(v, sz);
754 1.1 matt
755 1.21 lukem printf("%s%s", copyright, version);
756 1.1 matt if (model != NULL)
757 1.1 matt printf("Model: %s\n", model);
758 1.1 matt cpu_identify(NULL, 0);
759 1.1 matt
760 1.1 matt format_bytes(pbuf, sizeof(pbuf), ctob((u_int)physmem));
761 1.1 matt printf("total memory = %s\n", pbuf);
762 1.1 matt
763 1.1 matt /*
764 1.1 matt * Allocate away the pages that map to 0xDEA[CDE]xxxx. Do this after
765 1.1 matt * the bufpages are allocated in case they overlap since it's not
766 1.1 matt * fatal if we can't allocate these.
767 1.1 matt */
768 1.4 matt if (KERNEL_SR == 13 || KERNEL2_SR == 14) {
769 1.4 matt int error;
770 1.4 matt minaddr = 0xDEAC0000;
771 1.4 matt error = uvm_map(kernel_map, &minaddr, 0x30000,
772 1.4 matt NULL, UVM_UNKNOWN_OFFSET, 0,
773 1.4 matt UVM_MAPFLAG(UVM_PROT_NONE, UVM_PROT_NONE, UVM_INH_NONE,
774 1.4 matt UVM_ADV_NORMAL, UVM_FLAG_FIXED));
775 1.4 matt if (error != 0 || minaddr != 0xDEAC0000)
776 1.4 matt printf("oea_startup: failed to allocate DEAD "
777 1.4 matt "ZONE: error=%d\n", error);
778 1.1 matt }
779 1.13 pk
780 1.4 matt minaddr = 0;
781 1.1 matt
782 1.1 matt /*
783 1.1 matt * Allocate a submap for physio
784 1.1 matt */
785 1.1 matt phys_map = uvm_km_suballoc(kernel_map, &minaddr, &maxaddr,
786 1.31 thorpej VM_PHYS_SIZE, 0, false, NULL);
787 1.1 matt
788 1.1 matt format_bytes(pbuf, sizeof(pbuf), ptoa(uvmexp.free));
789 1.1 matt printf("avail memory = %s\n", pbuf);
790 1.1 matt }
791 1.1 matt
792 1.1 matt /*
793 1.1 matt * Crash dump handling.
794 1.1 matt */
795 1.1 matt
796 1.1 matt void
797 1.1 matt oea_dumpsys(void)
798 1.1 matt {
799 1.1 matt printf("dumpsys: TBD\n");
800 1.1 matt }
801 1.1 matt
802 1.1 matt /*
803 1.1 matt * Convert kernel VA to physical address
804 1.1 matt */
805 1.1 matt paddr_t
806 1.32 christos kvtop(void *addr)
807 1.1 matt {
808 1.1 matt vaddr_t va;
809 1.1 matt paddr_t pa;
810 1.1 matt uintptr_t off;
811 1.1 matt extern char end[];
812 1.1 matt
813 1.33 macallan if (addr < (void *)end)
814 1.1 matt return (paddr_t)addr;
815 1.1 matt
816 1.1 matt va = trunc_page((vaddr_t)addr);
817 1.1 matt off = (uintptr_t)addr - va;
818 1.1 matt
819 1.31 thorpej if (pmap_extract(pmap_kernel(), va, &pa) == false) {
820 1.1 matt /*printf("kvtop: zero page frame (va=0x%x)\n", addr);*/
821 1.1 matt return (paddr_t)addr;
822 1.1 matt }
823 1.1 matt
824 1.1 matt return(pa + off);
825 1.1 matt }
826 1.1 matt
827 1.1 matt /*
828 1.1 matt * Allocate vm space and mapin the I/O address
829 1.1 matt */
830 1.1 matt void *
831 1.1 matt mapiodev(paddr_t pa, psize_t len)
832 1.1 matt {
833 1.1 matt paddr_t faddr;
834 1.1 matt vaddr_t taddr, va;
835 1.1 matt int off;
836 1.1 matt
837 1.1 matt faddr = trunc_page(pa);
838 1.1 matt off = pa - faddr;
839 1.1 matt len = round_page(off + len);
840 1.20 yamt va = taddr = uvm_km_alloc(kernel_map, len, 0, UVM_KMF_VAONLY);
841 1.1 matt
842 1.1 matt if (va == 0)
843 1.1 matt return NULL;
844 1.1 matt
845 1.8 thorpej for (; len > 0; len -= PAGE_SIZE) {
846 1.48 cegger pmap_kenter_pa(taddr, faddr, VM_PROT_READ | VM_PROT_WRITE, 0);
847 1.8 thorpej faddr += PAGE_SIZE;
848 1.8 thorpej taddr += PAGE_SIZE;
849 1.1 matt }
850 1.1 matt pmap_update(pmap_kernel());
851 1.1 matt return (void *)(va + off);
852 1.1 matt }
853 1.27 matt
854 1.27 matt void
855 1.27 matt unmapiodev(vaddr_t va, vsize_t len)
856 1.27 matt {
857 1.27 matt paddr_t faddr;
858 1.27 matt
859 1.28 freza if (! va)
860 1.28 freza return;
861 1.28 freza
862 1.27 matt faddr = trunc_page(va);
863 1.27 matt len = round_page(va - faddr + len);
864 1.27 matt
865 1.27 matt pmap_kremove(faddr, len);
866 1.27 matt pmap_update(pmap_kernel());
867 1.27 matt uvm_km_free(kernel_map, faddr, len, UVM_KMF_VAONLY);
868 1.27 matt }
869 1.34 yamt
870 1.34 yamt void
871 1.34 yamt trap0(void *lr)
872 1.34 yamt {
873 1.34 yamt panic("call to null-ptr from %p", lr);
874 1.34 yamt }
875