ofw.c revision 1.2 1 1.2 thorpej /* $NetBSD: ofw.c,v 1.2 2002/02/20 00:10:20 thorpej Exp $ */
2 1.1 thorpej
3 1.1 thorpej /*
4 1.1 thorpej * Copyright 1997
5 1.1 thorpej * Digital Equipment Corporation. All rights reserved.
6 1.1 thorpej *
7 1.1 thorpej * This software is furnished under license and may be used and
8 1.1 thorpej * copied only in accordance with the following terms and conditions.
9 1.1 thorpej * Subject to these conditions, you may download, copy, install,
10 1.1 thorpej * use, modify and distribute this software in source and/or binary
11 1.1 thorpej * form. No title or ownership is transferred hereby.
12 1.1 thorpej *
13 1.1 thorpej * 1) Any source code used, modified or distributed must reproduce
14 1.1 thorpej * and retain this copyright notice and list of conditions as
15 1.1 thorpej * they appear in the source file.
16 1.1 thorpej *
17 1.1 thorpej * 2) No right is granted to use any trade name, trademark, or logo of
18 1.1 thorpej * Digital Equipment Corporation. Neither the "Digital Equipment
19 1.1 thorpej * Corporation" name nor any trademark or logo of Digital Equipment
20 1.1 thorpej * Corporation may be used to endorse or promote products derived
21 1.1 thorpej * from this software without the prior written permission of
22 1.1 thorpej * Digital Equipment Corporation.
23 1.1 thorpej *
24 1.1 thorpej * 3) This software is provided "AS-IS" and any express or implied
25 1.1 thorpej * warranties, including but not limited to, any implied warranties
26 1.1 thorpej * of merchantability, fitness for a particular purpose, or
27 1.1 thorpej * non-infringement are disclaimed. In no event shall DIGITAL be
28 1.1 thorpej * liable for any damages whatsoever, and in particular, DIGITAL
29 1.1 thorpej * shall not be liable for special, indirect, consequential, or
30 1.1 thorpej * incidental damages or damages for lost profits, loss of
31 1.1 thorpej * revenue or loss of use, whether such damages arise in contract,
32 1.1 thorpej * negligence, tort, under statute, in equity, at law or otherwise,
33 1.1 thorpej * even if advised of the possibility of such damage.
34 1.1 thorpej */
35 1.1 thorpej
36 1.1 thorpej /*
37 1.1 thorpej * Routines for interfacing between NetBSD and OFW.
38 1.1 thorpej *
39 1.1 thorpej * Parts of this could be moved to an MI file in time. -JJK
40 1.1 thorpej *
41 1.1 thorpej */
42 1.1 thorpej
43 1.1 thorpej #include <sys/param.h>
44 1.1 thorpej #include <sys/systm.h>
45 1.1 thorpej #include <sys/kernel.h>
46 1.1 thorpej #include <sys/reboot.h>
47 1.1 thorpej #include <sys/mbuf.h>
48 1.1 thorpej
49 1.1 thorpej #include <uvm/uvm_extern.h>
50 1.1 thorpej
51 1.1 thorpej #include <dev/cons.h>
52 1.1 thorpej
53 1.1 thorpej #include <machine/bus.h>
54 1.1 thorpej #include <machine/frame.h>
55 1.1 thorpej #include <machine/bootconfig.h>
56 1.1 thorpej #include <machine/cpu.h>
57 1.1 thorpej #include <machine/intr.h>
58 1.1 thorpej
59 1.1 thorpej #include <dev/ofw/openfirm.h>
60 1.1 thorpej #include <machine/ofw.h>
61 1.1 thorpej
62 1.1 thorpej #include <netinet/in.h>
63 1.1 thorpej
64 1.1 thorpej #if BOOT_FW_DHCP
65 1.1 thorpej #include <nfs/bootdata.h>
66 1.1 thorpej #endif
67 1.1 thorpej
68 1.1 thorpej #ifdef SHARK
69 1.1 thorpej #include "machine/pio.h"
70 1.1 thorpej #include "machine/isa_machdep.h"
71 1.1 thorpej #endif
72 1.1 thorpej
73 1.1 thorpej #include "pc.h"
74 1.1 thorpej #include "isadma.h"
75 1.1 thorpej
76 1.1 thorpej #define IO_VIRT_BASE (OFW_VIRT_BASE + OFW_VIRT_SIZE)
77 1.1 thorpej #define IO_VIRT_SIZE 0x01000000
78 1.1 thorpej
79 1.1 thorpej /*
80 1.1 thorpej * Imported variables
81 1.1 thorpej */
82 1.1 thorpej extern BootConfig bootconfig; /* temporary, I hope */
83 1.1 thorpej
84 1.1 thorpej #ifdef DIAGNOSTIC
85 1.1 thorpej /* NOTE: These variables will be removed, well some of them */
86 1.1 thorpej extern u_int spl_mask;
87 1.1 thorpej extern u_int current_mask;
88 1.1 thorpej #endif
89 1.1 thorpej
90 1.1 thorpej extern int ofw_handleticks;
91 1.1 thorpej
92 1.1 thorpej
93 1.1 thorpej /*
94 1.1 thorpej * Imported routines
95 1.1 thorpej */
96 1.1 thorpej extern void map_pagetable __P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa));
97 1.1 thorpej extern void map_entry __P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa));
98 1.1 thorpej extern void map_entry_nc __P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa));
99 1.1 thorpej extern void map_entry_ro __P((vm_offset_t pt, vm_offset_t va, vm_offset_t pa));
100 1.1 thorpej extern void dump_spl_masks __P((void));
101 1.1 thorpej extern void dumpsys __P((void));
102 1.1 thorpej extern void dotickgrovelling __P((vm_offset_t));
103 1.1 thorpej #if defined(SHARK) && (NPC > 0)
104 1.1 thorpej extern void shark_screen_cleanup __P((int));
105 1.1 thorpej #endif
106 1.1 thorpej
107 1.1 thorpej #define WriteWord(a, b) \
108 1.1 thorpej *((volatile unsigned int *)(a)) = (b)
109 1.1 thorpej
110 1.1 thorpej #define ReadWord(a) \
111 1.1 thorpej (*((volatile unsigned int *)(a)))
112 1.1 thorpej
113 1.1 thorpej
114 1.1 thorpej /*
115 1.1 thorpej * Exported variables
116 1.1 thorpej */
117 1.1 thorpej /* These should all be in a meminfo structure. */
118 1.1 thorpej vm_offset_t physical_start;
119 1.1 thorpej vm_offset_t physical_freestart;
120 1.1 thorpej vm_offset_t physical_freeend;
121 1.1 thorpej vm_offset_t physical_end;
122 1.1 thorpej u_int free_pages;
123 1.1 thorpej int physmem;
124 1.1 thorpej pv_addr_t systempage;
125 1.1 thorpej #ifndef OFWGENCFG
126 1.1 thorpej pv_addr_t irqstack;
127 1.1 thorpej #endif
128 1.1 thorpej pv_addr_t undstack;
129 1.1 thorpej pv_addr_t abtstack;
130 1.1 thorpej pv_addr_t kernelstack;
131 1.1 thorpej
132 1.1 thorpej vm_offset_t msgbufphys;
133 1.1 thorpej
134 1.1 thorpej /* for storage allocation, used to be local to ofw_construct_proc0_addrspace */
135 1.1 thorpej static vm_offset_t virt_freeptr;
136 1.1 thorpej
137 1.1 thorpej int ofw_callbacks = 0; /* debugging counter */
138 1.1 thorpej
139 1.1 thorpej /**************************************************************/
140 1.1 thorpej
141 1.1 thorpej
142 1.1 thorpej /*
143 1.1 thorpej * Declarations and definitions private to this module
144 1.1 thorpej *
145 1.1 thorpej */
146 1.1 thorpej
147 1.1 thorpej struct mem_region {
148 1.1 thorpej vm_offset_t start;
149 1.1 thorpej vm_size_t size;
150 1.1 thorpej };
151 1.1 thorpej
152 1.1 thorpej struct mem_translation {
153 1.1 thorpej vm_offset_t virt;
154 1.1 thorpej vm_size_t size;
155 1.1 thorpej vm_offset_t phys;
156 1.1 thorpej unsigned int mode;
157 1.1 thorpej };
158 1.1 thorpej
159 1.1 thorpej struct isa_range {
160 1.1 thorpej vm_offset_t isa_phys_hi;
161 1.1 thorpej vm_offset_t isa_phys_lo;
162 1.1 thorpej vm_offset_t parent_phys_start;
163 1.1 thorpej vm_size_t isa_size;
164 1.1 thorpej };
165 1.1 thorpej
166 1.1 thorpej struct vl_range {
167 1.1 thorpej vm_offset_t vl_phys_hi;
168 1.1 thorpej vm_offset_t vl_phys_lo;
169 1.1 thorpej vm_offset_t parent_phys_start;
170 1.1 thorpej vm_size_t vl_size;
171 1.1 thorpej };
172 1.1 thorpej
173 1.1 thorpej struct vl_isa_range {
174 1.1 thorpej vm_offset_t isa_phys_hi;
175 1.1 thorpej vm_offset_t isa_phys_lo;
176 1.1 thorpej vm_offset_t parent_phys_hi;
177 1.1 thorpej vm_offset_t parent_phys_lo;
178 1.1 thorpej vm_size_t isa_size;
179 1.1 thorpej };
180 1.1 thorpej
181 1.1 thorpej struct dma_range {
182 1.1 thorpej vm_offset_t start;
183 1.1 thorpej vm_size_t size;
184 1.1 thorpej };
185 1.1 thorpej
186 1.1 thorpej struct ofw_cbargs {
187 1.1 thorpej char *name;
188 1.1 thorpej int nargs;
189 1.1 thorpej int nreturns;
190 1.1 thorpej int args_n_results[12];
191 1.1 thorpej };
192 1.1 thorpej
193 1.1 thorpej
194 1.1 thorpej /* Memory info */
195 1.1 thorpej static int nOFphysmem;
196 1.1 thorpej static struct mem_region *OFphysmem;
197 1.1 thorpej static int nOFphysavail;
198 1.1 thorpej static struct mem_region *OFphysavail;
199 1.1 thorpej static int nOFtranslations;
200 1.1 thorpej static struct mem_translation *OFtranslations;
201 1.1 thorpej static int nOFdmaranges;
202 1.1 thorpej static struct dma_range *OFdmaranges;
203 1.1 thorpej
204 1.1 thorpej /* The OFW client services handle. */
205 1.1 thorpej /* Initialized by ofw_init(). */
206 1.1 thorpej static ofw_handle_t ofw_client_services_handle;
207 1.1 thorpej
208 1.1 thorpej
209 1.1 thorpej static void ofw_callbackhandler __P((struct ofw_cbargs *));
210 1.1 thorpej static void ofw_construct_proc0_addrspace __P((pv_addr_t *, pv_addr_t *));
211 1.1 thorpej static void ofw_getphysmeminfo __P((void));
212 1.1 thorpej static void ofw_getvirttranslations __P((void));
213 1.1 thorpej static void *ofw_malloc(vm_size_t size);
214 1.1 thorpej static void ofw_claimpages __P((vm_offset_t *, pv_addr_t *, vm_size_t));
215 1.1 thorpej static void ofw_discardmappings __P ((vm_offset_t, vm_offset_t, vm_size_t));
216 1.1 thorpej static int ofw_mem_ihandle __P((void));
217 1.1 thorpej static int ofw_mmu_ihandle __P((void));
218 1.1 thorpej static vm_offset_t ofw_claimphys __P((vm_offset_t, vm_size_t, vm_offset_t));
219 1.1 thorpej #if 0
220 1.1 thorpej static vm_offset_t ofw_releasephys __P((vm_offset_t, vm_size_t));
221 1.1 thorpej #endif
222 1.1 thorpej static vm_offset_t ofw_claimvirt __P((vm_offset_t, vm_size_t, vm_offset_t));
223 1.1 thorpej static void ofw_settranslation __P ((vm_offset_t, vm_offset_t, vm_size_t, int));
224 1.1 thorpej static void ofw_initallocator __P((void));
225 1.1 thorpej static void ofw_configisaonly __P((vm_offset_t *, vm_offset_t *));
226 1.1 thorpej static void ofw_configvl __P((int, vm_offset_t *, vm_offset_t *));
227 1.1 thorpej static vm_offset_t ofw_valloc __P((vm_offset_t, vm_offset_t));
228 1.1 thorpej
229 1.1 thorpej
230 1.1 thorpej /*
231 1.1 thorpej * DHCP hooks. For a first cut, we look to see if there is a DHCP
232 1.1 thorpej * packet that was saved by the firmware. If not, we proceed as before,
233 1.1 thorpej * getting hand-configured data from NVRAM. If there is one, we get the
234 1.1 thorpej * packet, and extract the data from it. For now, we hand that data up
235 1.1 thorpej * in the boot_args string as before.
236 1.1 thorpej */
237 1.1 thorpej
238 1.1 thorpej
239 1.1 thorpej /**************************************************************/
240 1.1 thorpej
241 1.1 thorpej
242 1.1 thorpej /*
243 1.1 thorpej *
244 1.1 thorpej * Support routines for xxx_machdep.c
245 1.1 thorpej *
246 1.1 thorpej * The intent is that all OFW-based configurations use the
247 1.1 thorpej * exported routines in this file to do their business. If
248 1.1 thorpej * they need to override some function they are free to do so.
249 1.1 thorpej *
250 1.1 thorpej * The exported routines are:
251 1.1 thorpej *
252 1.1 thorpej * openfirmware
253 1.1 thorpej * ofw_init
254 1.1 thorpej * ofw_boot
255 1.1 thorpej * ofw_getbootinfo
256 1.1 thorpej * ofw_configmem
257 1.1 thorpej * ofw_configisa
258 1.1 thorpej * ofw_configisadma
259 1.1 thorpej * ofw_gettranslation
260 1.1 thorpej * ofw_map
261 1.1 thorpej * ofw_getcleaninfo
262 1.1 thorpej */
263 1.1 thorpej
264 1.1 thorpej
265 1.1 thorpej int
266 1.1 thorpej openfirmware(args)
267 1.1 thorpej void *args;
268 1.1 thorpej {
269 1.1 thorpej int ofw_result;
270 1.1 thorpej u_int saved_irq_state;
271 1.1 thorpej
272 1.1 thorpej /* OFW is not re-entrant, so we wrap a mutex around the call. */
273 1.1 thorpej saved_irq_state = disable_interrupts(I32_bit);
274 1.1 thorpej ofw_result = ofw_client_services_handle(args);
275 1.1 thorpej (void)restore_interrupts(saved_irq_state);
276 1.1 thorpej
277 1.1 thorpej return(ofw_result);
278 1.1 thorpej }
279 1.1 thorpej
280 1.1 thorpej
281 1.1 thorpej void
282 1.1 thorpej ofw_init(ofw_handle)
283 1.1 thorpej ofw_handle_t ofw_handle;
284 1.1 thorpej {
285 1.1 thorpej ofw_client_services_handle = ofw_handle;
286 1.1 thorpej
287 1.1 thorpej /* Everything we allocate in the remainder of this block is
288 1.1 thorpej * constrained to be in the "kernel-static" portion of the
289 1.1 thorpej * virtual address space (i.e., 0xF0000000 - 0xF1000000).
290 1.1 thorpej * This is because all such objects are expected to be in
291 1.1 thorpej * that range by NetBSD, or the objects will be re-mapped
292 1.1 thorpej * after the page-table-switch to other specific locations.
293 1.1 thorpej * In the latter case, it's simplest if our pre-switch handles
294 1.1 thorpej * on those objects are in regions that are already "well-
295 1.1 thorpej * known." (Otherwise, the cloning of the OFW-managed address-
296 1.1 thorpej * space becomes more awkward.) To minimize the number of L2
297 1.1 thorpej * page tables that we use, we are further restricting the
298 1.1 thorpej * remaining allocations in this block to the bottom quarter of
299 1.1 thorpej * the legal range. OFW will have loaded the kernel text+data+bss
300 1.1 thorpej * starting at the bottom of the range, and we will allocate
301 1.1 thorpej * objects from the top, moving downwards. The two sub-regions
302 1.1 thorpej * will collide if their total sizes hit 4MB. The current total
303 1.1 thorpej * is <1.5MB, so we aren't in any real danger yet. The variable
304 1.1 thorpej * virt-freeptr represents the next free va (moving downwards).
305 1.1 thorpej */
306 1.1 thorpej virt_freeptr = KERNEL_BASE + 0x00400000;
307 1.1 thorpej }
308 1.1 thorpej
309 1.1 thorpej
310 1.1 thorpej void
311 1.1 thorpej ofw_boot(howto, bootstr)
312 1.1 thorpej int howto;
313 1.1 thorpej char *bootstr;
314 1.1 thorpej {
315 1.1 thorpej
316 1.1 thorpej #ifdef DIAGNOSTIC
317 1.1 thorpej printf("boot: howto=%08x curproc=%p\n", howto, curproc);
318 1.1 thorpej printf("current_mask=%08x spl_mask=%08x\n", current_mask, spl_mask);
319 1.1 thorpej
320 1.1 thorpej printf("ipl_bio=%08x ipl_net=%08x ipl_tty=%08x ipl_imp=%08x\n",
321 1.1 thorpej irqmasks[IPL_BIO], irqmasks[IPL_NET], irqmasks[IPL_TTY],
322 1.1 thorpej irqmasks[IPL_IMP]);
323 1.1 thorpej printf("ipl_audio=%08x ipl_clock=%08x ipl_none=%08x\n",
324 1.1 thorpej irqmasks[IPL_AUDIO], irqmasks[IPL_CLOCK], irqmasks[IPL_NONE]);
325 1.1 thorpej
326 1.1 thorpej dump_spl_masks();
327 1.1 thorpej #endif
328 1.1 thorpej
329 1.1 thorpej /*
330 1.1 thorpej * If we are still cold then hit the air brakes
331 1.1 thorpej * and crash to earth fast
332 1.1 thorpej */
333 1.1 thorpej if (cold) {
334 1.1 thorpej doshutdownhooks();
335 1.1 thorpej printf("Halted while still in the ICE age.\n");
336 1.1 thorpej printf("The operating system has halted.\n");
337 1.1 thorpej goto ofw_exit;
338 1.1 thorpej /*NOTREACHED*/
339 1.1 thorpej }
340 1.1 thorpej
341 1.1 thorpej /*
342 1.1 thorpej * If RB_NOSYNC was not specified sync the discs.
343 1.1 thorpej * Note: Unless cold is set to 1 here, syslogd will die during the unmount.
344 1.1 thorpej * It looks like syslogd is getting woken up only to find that it cannot
345 1.1 thorpej * page part of the binary in as the filesystem has been unmounted.
346 1.1 thorpej */
347 1.1 thorpej if (!(howto & RB_NOSYNC))
348 1.1 thorpej bootsync();
349 1.1 thorpej
350 1.1 thorpej /* Say NO to interrupts */
351 1.1 thorpej splhigh();
352 1.1 thorpej
353 1.1 thorpej /* Do a dump if requested. */
354 1.1 thorpej if ((howto & (RB_DUMP | RB_HALT)) == RB_DUMP)
355 1.1 thorpej dumpsys();
356 1.1 thorpej
357 1.1 thorpej /* Run any shutdown hooks */
358 1.1 thorpej doshutdownhooks();
359 1.1 thorpej
360 1.1 thorpej /* Make sure IRQ's are disabled */
361 1.1 thorpej IRQdisable;
362 1.1 thorpej
363 1.1 thorpej if (howto & RB_HALT) {
364 1.1 thorpej printf("The operating system has halted.\n");
365 1.1 thorpej goto ofw_exit;
366 1.1 thorpej }
367 1.1 thorpej
368 1.1 thorpej /* Tell the user we are booting */
369 1.1 thorpej printf("rebooting...\n");
370 1.1 thorpej
371 1.1 thorpej /* Jump into the OFW boot routine. */
372 1.1 thorpej {
373 1.1 thorpej static char str[256];
374 1.1 thorpej char *ap = str, *ap1 = ap;
375 1.1 thorpej
376 1.1 thorpej if (bootstr && *bootstr) {
377 1.1 thorpej if (strlen(bootstr) > sizeof str - 5)
378 1.1 thorpej printf("boot string too large, ignored\n");
379 1.1 thorpej else {
380 1.1 thorpej strcpy(str, bootstr);
381 1.1 thorpej ap1 = ap = str + strlen(str);
382 1.1 thorpej *ap++ = ' ';
383 1.1 thorpej }
384 1.1 thorpej }
385 1.1 thorpej *ap++ = '-';
386 1.1 thorpej if (howto & RB_SINGLE)
387 1.1 thorpej *ap++ = 's';
388 1.1 thorpej if (howto & RB_KDB)
389 1.1 thorpej *ap++ = 'd';
390 1.1 thorpej *ap++ = 0;
391 1.1 thorpej if (ap[-2] == '-')
392 1.1 thorpej *ap1 = 0;
393 1.1 thorpej #if defined(SHARK) && (NPC > 0)
394 1.1 thorpej shark_screen_cleanup(0);
395 1.1 thorpej #endif
396 1.1 thorpej OF_boot(str);
397 1.1 thorpej /*NOTREACHED*/
398 1.1 thorpej }
399 1.1 thorpej
400 1.1 thorpej ofw_exit:
401 1.1 thorpej printf("Calling OF_exit...\n");
402 1.1 thorpej #if defined(SHARK) && (NPC > 0)
403 1.1 thorpej shark_screen_cleanup(1);
404 1.1 thorpej #endif
405 1.1 thorpej OF_exit();
406 1.1 thorpej /*NOTREACHED*/
407 1.1 thorpej }
408 1.1 thorpej
409 1.1 thorpej
410 1.1 thorpej #if BOOT_FW_DHCP
411 1.1 thorpej
412 1.1 thorpej extern char *ip2dotted __P((struct in_addr));
413 1.1 thorpej
414 1.1 thorpej /*
415 1.1 thorpej * Get DHCP data from OFW
416 1.1 thorpej */
417 1.1 thorpej
418 1.1 thorpej void
419 1.1 thorpej get_fw_dhcp_data(bdp)
420 1.1 thorpej struct bootdata *bdp;
421 1.1 thorpej {
422 1.1 thorpej int chosen;
423 1.1 thorpej int dhcplen;
424 1.1 thorpej
425 1.1 thorpej bzero((char *)bdp, sizeof(*bdp));
426 1.1 thorpej if ((chosen = OF_finddevice("/chosen")) == -1)
427 1.1 thorpej panic("no /chosen from OFW");
428 1.1 thorpej if ((dhcplen = OF_getproplen(chosen, "bootp-response")) > 0) {
429 1.1 thorpej u_char *cp;
430 1.1 thorpej int dhcp_type = 0;
431 1.1 thorpej char *ip;
432 1.1 thorpej
433 1.1 thorpej /*
434 1.1 thorpej * OFW saved a DHCP (or BOOTP) packet for us.
435 1.1 thorpej */
436 1.1 thorpej if (dhcplen > sizeof(bdp->dhcp_packet))
437 1.1 thorpej panic("DHCP packet too large");
438 1.1 thorpej OF_getprop(chosen, "bootp-response", &bdp->dhcp_packet,
439 1.1 thorpej sizeof(bdp->dhcp_packet));
440 1.1 thorpej SANITY(bdp->dhcp_packet.op == BOOTREPLY, "bogus DHCP packet");
441 1.1 thorpej /*
442 1.1 thorpej * Collect the interesting data from DHCP into
443 1.1 thorpej * the bootdata structure.
444 1.1 thorpej */
445 1.1 thorpej bdp->ip_address = bdp->dhcp_packet.yiaddr;
446 1.1 thorpej ip = ip2dotted(bdp->ip_address);
447 1.1 thorpej if (bcmp(bdp->dhcp_packet.options, DHCP_OPTIONS_COOKIE, 4) == 0)
448 1.1 thorpej parse_dhcp_options(&bdp->dhcp_packet,
449 1.1 thorpej bdp->dhcp_packet.options + 4,
450 1.1 thorpej &bdp->dhcp_packet.options[dhcplen
451 1.1 thorpej - DHCP_FIXED_NON_UDP], bdp, ip);
452 1.1 thorpej if (bdp->root_ip.s_addr == 0)
453 1.1 thorpej bdp->root_ip = bdp->dhcp_packet.siaddr;
454 1.1 thorpej if (bdp->swap_ip.s_addr == 0)
455 1.1 thorpej bdp->swap_ip = bdp->dhcp_packet.siaddr;
456 1.1 thorpej }
457 1.1 thorpej /*
458 1.1 thorpej * If the DHCP packet did not contain all the necessary data,
459 1.1 thorpej * look in NVRAM for the missing parts.
460 1.1 thorpej */
461 1.1 thorpej {
462 1.1 thorpej int options;
463 1.1 thorpej int proplen;
464 1.1 thorpej #define BOOTJUNKV_SIZE 256
465 1.1 thorpej char bootjunkv[BOOTJUNKV_SIZE]; /* minimize stack usage */
466 1.1 thorpej
467 1.1 thorpej
468 1.1 thorpej if ((options = OF_finddevice("/options")) == -1)
469 1.1 thorpej panic("can't find /options");
470 1.1 thorpej if (bdp->ip_address.s_addr == 0 &&
471 1.1 thorpej (proplen = OF_getprop(options, "ipaddr",
472 1.1 thorpej bootjunkv, BOOTJUNKV_SIZE - 1)) > 0) {
473 1.1 thorpej bootjunkv[proplen] = '\0';
474 1.1 thorpej if (dotted2ip(bootjunkv, &bdp->ip_address.s_addr) == 0)
475 1.1 thorpej bdp->ip_address.s_addr = 0;
476 1.1 thorpej }
477 1.1 thorpej if (bdp->ip_mask.s_addr == 0 &&
478 1.1 thorpej (proplen = OF_getprop(options, "netmask",
479 1.1 thorpej bootjunkv, BOOTJUNKV_SIZE - 1)) > 0) {
480 1.1 thorpej bootjunkv[proplen] = '\0';
481 1.1 thorpej if (dotted2ip(bootjunkv, &bdp->ip_mask.s_addr) == 0)
482 1.1 thorpej bdp->ip_mask.s_addr = 0;
483 1.1 thorpej }
484 1.1 thorpej if (bdp->hostname[0] == '\0' &&
485 1.1 thorpej (proplen = OF_getprop(options, "hostname",
486 1.1 thorpej bdp->hostname, sizeof(bdp->hostname) - 1)) > 0) {
487 1.1 thorpej bdp->hostname[proplen] = '\0';
488 1.1 thorpej }
489 1.1 thorpej if (bdp->root[0] == '\0' &&
490 1.1 thorpej (proplen = OF_getprop(options, "rootfs",
491 1.1 thorpej bootjunkv, BOOTJUNKV_SIZE - 1)) > 0) {
492 1.1 thorpej bootjunkv[proplen] = '\0';
493 1.1 thorpej parse_server_path(bootjunkv, &bdp->root_ip, bdp->root);
494 1.1 thorpej }
495 1.1 thorpej if (bdp->swap[0] == '\0' &&
496 1.1 thorpej (proplen = OF_getprop(options, "swapfs",
497 1.1 thorpej bootjunkv, BOOTJUNKV_SIZE - 1)) > 0) {
498 1.1 thorpej bootjunkv[proplen] = '\0';
499 1.1 thorpej parse_server_path(bootjunkv, &bdp->swap_ip, bdp->swap);
500 1.1 thorpej }
501 1.1 thorpej }
502 1.1 thorpej }
503 1.1 thorpej
504 1.1 thorpej #endif /* BOOT_FW_DHCP */
505 1.1 thorpej
506 1.1 thorpej void
507 1.1 thorpej ofw_getbootinfo(bp_pp, ba_pp)
508 1.1 thorpej char **bp_pp;
509 1.1 thorpej char **ba_pp;
510 1.1 thorpej {
511 1.1 thorpej int chosen;
512 1.1 thorpej int bp_len;
513 1.1 thorpej int ba_len;
514 1.1 thorpej char *bootpathv;
515 1.1 thorpej char *bootargsv;
516 1.1 thorpej
517 1.1 thorpej /* Read the bootpath and bootargs out of OFW. */
518 1.1 thorpej /* XXX is bootpath still interesting? --emg */
519 1.1 thorpej if ((chosen = OF_finddevice("/chosen")) == -1)
520 1.1 thorpej panic("no /chosen from OFW");
521 1.1 thorpej bp_len = OF_getproplen(chosen, "bootpath");
522 1.1 thorpej ba_len = OF_getproplen(chosen, "bootargs");
523 1.1 thorpej if (bp_len < 0 || ba_len < 0)
524 1.1 thorpej panic("can't get boot data from OFW");
525 1.1 thorpej
526 1.1 thorpej bootpathv = (char *)ofw_malloc(bp_len);
527 1.1 thorpej bootargsv = (char *)ofw_malloc(ba_len);
528 1.1 thorpej
529 1.1 thorpej if (bp_len)
530 1.1 thorpej OF_getprop(chosen, "bootpath", bootpathv, bp_len);
531 1.1 thorpej else
532 1.1 thorpej bootpathv[0] = '\0';
533 1.1 thorpej
534 1.1 thorpej if (ba_len)
535 1.1 thorpej OF_getprop(chosen, "bootargs", bootargsv, ba_len);
536 1.1 thorpej else
537 1.1 thorpej bootargsv[0] = '\0';
538 1.1 thorpej
539 1.1 thorpej *bp_pp = bootpathv;
540 1.1 thorpej *ba_pp = bootargsv;
541 1.1 thorpej #ifdef DIAGNOSTIC
542 1.1 thorpej printf("bootpath=<%s>, bootargs=<%s>\n", bootpathv, bootargsv);
543 1.1 thorpej #endif
544 1.1 thorpej }
545 1.1 thorpej
546 1.1 thorpej vm_offset_t
547 1.1 thorpej ofw_getcleaninfo(void)
548 1.1 thorpej {
549 1.1 thorpej int cpu;
550 1.1 thorpej vm_offset_t vclean, pclean;
551 1.1 thorpej
552 1.1 thorpej if ((cpu = OF_finddevice("/cpu")) == -1)
553 1.1 thorpej panic("no /cpu from OFW");
554 1.1 thorpej
555 1.1 thorpej if ((OF_getprop(cpu, "d-cache-flush-address", &vclean,
556 1.1 thorpej sizeof(vclean))) != sizeof(vclean)) {
557 1.1 thorpej #ifdef DEBUG
558 1.1 thorpej printf("no OFW d-cache-flush-address property\n");
559 1.1 thorpej #endif
560 1.1 thorpej return -1;
561 1.1 thorpej }
562 1.1 thorpej
563 1.1 thorpej if ((pclean = ofw_gettranslation(
564 1.1 thorpej of_decode_int((unsigned char *)&vclean))) == -1)
565 1.1 thorpej panic("OFW failed to translate cache flush address");
566 1.1 thorpej
567 1.1 thorpej return pclean;
568 1.1 thorpej }
569 1.1 thorpej
570 1.1 thorpej void
571 1.1 thorpej ofw_configisa(pio, pmem)
572 1.1 thorpej vm_offset_t *pio;
573 1.1 thorpej vm_offset_t *pmem;
574 1.1 thorpej {
575 1.1 thorpej int vl;
576 1.1 thorpej
577 1.1 thorpej if ((vl = OF_finddevice("/vlbus")) == -1) /* old style OFW dev info tree */
578 1.1 thorpej ofw_configisaonly(pio, pmem);
579 1.1 thorpej else /* old style OFW dev info tree */
580 1.1 thorpej ofw_configvl(vl, pio, pmem);
581 1.1 thorpej }
582 1.1 thorpej
583 1.1 thorpej static void
584 1.1 thorpej ofw_configisaonly(pio, pmem)
585 1.1 thorpej vm_offset_t *pio;
586 1.1 thorpej vm_offset_t *pmem;
587 1.1 thorpej {
588 1.1 thorpej int isa;
589 1.1 thorpej int rangeidx;
590 1.1 thorpej int size;
591 1.1 thorpej vm_offset_t hi, start;
592 1.1 thorpej struct isa_range ranges[2];
593 1.1 thorpej
594 1.1 thorpej if ((isa = OF_finddevice("/isa")) == -1)
595 1.1 thorpej panic("OFW has no /isa device node");
596 1.1 thorpej
597 1.1 thorpej /* expect to find two isa ranges: IO/data and memory/data */
598 1.1 thorpej if ((size = OF_getprop(isa, "ranges", ranges, sizeof(ranges)))
599 1.1 thorpej != sizeof(ranges))
600 1.1 thorpej panic("unexpected size of OFW /isa ranges property: %d", size);
601 1.1 thorpej
602 1.1 thorpej *pio = *pmem = -1;
603 1.1 thorpej
604 1.1 thorpej for (rangeidx = 0; rangeidx < 2; ++rangeidx) {
605 1.1 thorpej hi = of_decode_int((unsigned char *)
606 1.1 thorpej &ranges[rangeidx].isa_phys_hi);
607 1.1 thorpej start = of_decode_int((unsigned char *)
608 1.1 thorpej &ranges[rangeidx].parent_phys_start);
609 1.1 thorpej
610 1.1 thorpej if (hi & 1) { /* then I/O space */
611 1.1 thorpej *pio = start;
612 1.1 thorpej } else {
613 1.1 thorpej *pmem = start;
614 1.1 thorpej }
615 1.1 thorpej } /* END for */
616 1.1 thorpej
617 1.1 thorpej if ((*pio == -1) || (*pmem == -1))
618 1.1 thorpej panic("bad OFW /isa ranges property");
619 1.1 thorpej
620 1.1 thorpej }
621 1.1 thorpej
622 1.1 thorpej static void
623 1.1 thorpej ofw_configvl(vl, pio, pmem)
624 1.1 thorpej int vl;
625 1.1 thorpej vm_offset_t *pio;
626 1.1 thorpej vm_offset_t *pmem;
627 1.1 thorpej {
628 1.1 thorpej int isa;
629 1.1 thorpej int ir, vr;
630 1.1 thorpej int size;
631 1.1 thorpej vm_offset_t hi, start;
632 1.1 thorpej struct vl_isa_range isa_ranges[2];
633 1.1 thorpej struct vl_range vl_ranges[2];
634 1.1 thorpej
635 1.1 thorpej if ((isa = OF_finddevice("/vlbus/isa")) == -1)
636 1.1 thorpej panic("OFW has no /vlbus/isa device node");
637 1.1 thorpej
638 1.1 thorpej /* expect to find two isa ranges: IO/data and memory/data */
639 1.1 thorpej if ((size = OF_getprop(isa, "ranges", isa_ranges, sizeof(isa_ranges)))
640 1.1 thorpej != sizeof(isa_ranges))
641 1.1 thorpej panic("unexpected size of OFW /vlbus/isa ranges property: %d",
642 1.1 thorpej size);
643 1.1 thorpej
644 1.1 thorpej /* expect to find two vl ranges: IO/data and memory/data */
645 1.1 thorpej if ((size = OF_getprop(vl, "ranges", vl_ranges, sizeof(vl_ranges)))
646 1.1 thorpej != sizeof(vl_ranges))
647 1.1 thorpej panic("unexpected size of OFW /vlbus ranges property: %d", size);
648 1.1 thorpej
649 1.1 thorpej *pio = -1;
650 1.1 thorpej *pmem = -1;
651 1.1 thorpej
652 1.1 thorpej for (ir = 0; ir < 2; ++ir) {
653 1.1 thorpej for (vr = 0; vr < 2; ++vr) {
654 1.1 thorpej if ((isa_ranges[ir].parent_phys_hi
655 1.1 thorpej == vl_ranges[vr].vl_phys_hi) &&
656 1.1 thorpej (isa_ranges[ir].parent_phys_lo
657 1.1 thorpej == vl_ranges[vr].vl_phys_lo)) {
658 1.1 thorpej hi = of_decode_int((unsigned char *)
659 1.1 thorpej &isa_ranges[ir].isa_phys_hi);
660 1.1 thorpej start = of_decode_int((unsigned char *)
661 1.1 thorpej &vl_ranges[vr].parent_phys_start);
662 1.1 thorpej
663 1.1 thorpej if (hi & 1) { /* then I/O space */
664 1.1 thorpej *pio = start;
665 1.1 thorpej } else {
666 1.1 thorpej *pmem = start;
667 1.1 thorpej }
668 1.1 thorpej } /* END if */
669 1.1 thorpej } /* END for */
670 1.1 thorpej } /* END for */
671 1.1 thorpej
672 1.1 thorpej if ((*pio == -1) || (*pmem == -1))
673 1.1 thorpej panic("bad OFW /isa ranges property");
674 1.1 thorpej }
675 1.1 thorpej
676 1.1 thorpej void
677 1.1 thorpej ofw_configisadma(pdma)
678 1.1 thorpej vm_offset_t *pdma;
679 1.1 thorpej {
680 1.1 thorpej int root;
681 1.1 thorpej int rangeidx;
682 1.1 thorpej int size;
683 1.1 thorpej struct dma_range *dr;
684 1.1 thorpej #if NISADMA > 0
685 1.1 thorpej extern bus_dma_segment_t *pmap_isa_dma_ranges;
686 1.1 thorpej extern int pmap_isa_dma_nranges;
687 1.1 thorpej #endif
688 1.1 thorpej
689 1.1 thorpej if ((root = OF_finddevice("/")) == -1 ||
690 1.1 thorpej (size = OF_getproplen(root, "dma-ranges")) <= 0 ||
691 1.1 thorpej (OFdmaranges = (struct dma_range *)ofw_malloc(size)) == 0 ||
692 1.1 thorpej OF_getprop(root, "dma-ranges", OFdmaranges, size) != size)
693 1.1 thorpej panic("bad / dma-ranges property");
694 1.1 thorpej
695 1.1 thorpej nOFdmaranges = size / sizeof(struct dma_range);
696 1.1 thorpej
697 1.1 thorpej #if NISADMA > 0
698 1.1 thorpej /* Allocate storage for non-OFW representation of the range. */
699 1.1 thorpej pmap_isa_dma_ranges = ofw_malloc(nOFdmaranges *
700 1.1 thorpej sizeof(bus_dma_segment_t));
701 1.1 thorpej if (pmap_isa_dma_ranges == NULL)
702 1.1 thorpej panic("unable to allocate pmap_isa_dma_ranges");
703 1.1 thorpej pmap_isa_dma_nranges = nOFdmaranges;
704 1.1 thorpej #endif
705 1.1 thorpej
706 1.1 thorpej for (rangeidx = 0, dr = OFdmaranges; rangeidx < nOFdmaranges;
707 1.1 thorpej ++rangeidx, ++dr) {
708 1.1 thorpej dr->start = of_decode_int((unsigned char *)&dr->start);
709 1.1 thorpej dr->size = of_decode_int((unsigned char *)&dr->size);
710 1.1 thorpej #if NISADMA > 0
711 1.1 thorpej pmap_isa_dma_ranges[rangeidx].ds_addr = dr->start;
712 1.1 thorpej pmap_isa_dma_ranges[rangeidx].ds_len = dr->size;
713 1.1 thorpej #endif
714 1.1 thorpej }
715 1.1 thorpej
716 1.1 thorpej #ifdef DEBUG
717 1.1 thorpej printf("dma ranges size = %d\n", size);
718 1.1 thorpej
719 1.1 thorpej for (rangeidx = 0; rangeidx < nOFdmaranges; ++rangeidx) {
720 1.1 thorpej printf("%08lx %08lx\n",
721 1.1 thorpej (u_long)OFdmaranges[rangeidx].start,
722 1.1 thorpej (u_long)OFdmaranges[rangeidx].size);
723 1.1 thorpej }
724 1.1 thorpej #endif
725 1.1 thorpej }
726 1.1 thorpej
727 1.1 thorpej /*
728 1.1 thorpej * Memory configuration:
729 1.1 thorpej *
730 1.1 thorpej * We start off running in the environment provided by OFW.
731 1.1 thorpej * This has the MMU turned on, the kernel code and data
732 1.1 thorpej * mapped-in at KERNEL_BASE (0xF0000000), OFW's text and
733 1.1 thorpej * data mapped-in at OFW_VIRT_BASE (0xF7000000), and (possibly)
734 1.1 thorpej * page0 mapped-in at 0x0.
735 1.1 thorpej *
736 1.1 thorpej * The strategy is to set-up the address space for proc0 --
737 1.1 thorpej * including the allocation of space for new page tables -- while
738 1.1 thorpej * memory is still managed by OFW. We then effectively create a
739 1.1 thorpej * copy of the address space by dumping all of OFW's translations
740 1.1 thorpej * and poking them into the new page tables. We then notify OFW
741 1.1 thorpej * that we are assuming control of memory-management by installing
742 1.1 thorpej * our callback-handler, and switch to the NetBSD-managed page
743 1.1 thorpej * tables with the setttb() call.
744 1.1 thorpej *
745 1.1 thorpej * This scheme may cause some amount of memory to be wasted within
746 1.1 thorpej * OFW as dead page tables, but it shouldn't be more than about
747 1.1 thorpej * 20-30KB. (It's also possible that OFW will re-use the space.)
748 1.1 thorpej */
749 1.1 thorpej void
750 1.1 thorpej ofw_configmem(void)
751 1.1 thorpej {
752 1.1 thorpej pv_addr_t proc0_ttbbase;
753 1.1 thorpej pv_addr_t proc0_ptpt;
754 1.1 thorpej
755 1.1 thorpej /* Set-up proc0 address space. */
756 1.1 thorpej ofw_construct_proc0_addrspace(&proc0_ttbbase, &proc0_ptpt);
757 1.1 thorpej
758 1.1 thorpej /*
759 1.1 thorpej * Get a dump of OFW's picture of physical memory.
760 1.1 thorpej * This is used below to initialize a load of variables used by pmap.
761 1.1 thorpej * We get it now rather than later because we are about to
762 1.1 thorpej * tell OFW to stop managing memory.
763 1.1 thorpej */
764 1.1 thorpej ofw_getphysmeminfo();
765 1.1 thorpej
766 1.1 thorpej /* We are about to take control of memory-management from OFW.
767 1.1 thorpej * Establish callbacks for OFW to use for its future memory needs.
768 1.1 thorpej * This is required for us to keep using OFW services.
769 1.1 thorpej */
770 1.1 thorpej
771 1.1 thorpej /* First initialize our callback memory allocator. */
772 1.1 thorpej ofw_initallocator();
773 1.1 thorpej
774 1.1 thorpej OF_set_callback((void(*)())ofw_callbackhandler);
775 1.1 thorpej
776 1.1 thorpej /* Switch to the proc0 pagetables. */
777 1.1 thorpej setttb(proc0_ttbbase.pv_pa);
778 1.1 thorpej
779 1.1 thorpej /* Aaaaaaaah, running in the proc0 address space! */
780 1.1 thorpej /* I feel good... */
781 1.1 thorpej
782 1.1 thorpej /* Set-up the various globals which describe physical memory for pmap. */
783 1.1 thorpej {
784 1.1 thorpej struct mem_region *mp;
785 1.1 thorpej int totalcnt;
786 1.1 thorpej int availcnt;
787 1.1 thorpej int i;
788 1.1 thorpej
789 1.1 thorpej /* physmem, physical_start, physical_end */
790 1.1 thorpej physmem = 0;
791 1.1 thorpej for (totalcnt = 0, mp = OFphysmem; totalcnt < nOFphysmem;
792 1.1 thorpej totalcnt++, mp++) {
793 1.1 thorpej #ifdef OLDPRINTFS
794 1.1 thorpej printf("physmem: %x, %x\n", mp->start, mp->size);
795 1.1 thorpej #endif
796 1.1 thorpej physmem += btoc(mp->size);
797 1.1 thorpej }
798 1.1 thorpej physical_start = OFphysmem[0].start;
799 1.1 thorpej mp--;
800 1.1 thorpej physical_end = mp->start + mp->size;
801 1.1 thorpej
802 1.1 thorpej /* free_pages, physical_freestart, physical_freeend */
803 1.1 thorpej free_pages = 0;
804 1.1 thorpej for (availcnt = 0, mp = OFphysavail; availcnt < nOFphysavail;
805 1.1 thorpej availcnt++, mp++) {
806 1.1 thorpej #ifdef OLDPRINTFS
807 1.1 thorpej printf("physavail: %x, %x\n", mp->start, mp->size);
808 1.1 thorpej #endif
809 1.1 thorpej free_pages += btoc(mp->size);
810 1.1 thorpej }
811 1.1 thorpej physical_freestart = OFphysavail[0].start;
812 1.1 thorpej mp--;
813 1.1 thorpej physical_freeend = mp->start + mp->size;
814 1.1 thorpej #ifdef OLDPRINTFS
815 1.1 thorpej printf("pmap_bootstrap: physmem = %x, free_pages = %x\n",
816 1.1 thorpej physmem, free_pages);
817 1.1 thorpej #endif
818 1.1 thorpej
819 1.1 thorpej /*
820 1.1 thorpej * This is a hack to work with the existing pmap code.
821 1.1 thorpej * That code depends on a RiscPC BootConfig structure
822 1.1 thorpej * containing, among other things, an array describing
823 1.1 thorpej * the regions of physical memory. So, for now, we need
824 1.1 thorpej * to stuff our OFW-derived physical memory info into a
825 1.1 thorpej * "fake" BootConfig structure.
826 1.1 thorpej *
827 1.1 thorpej * An added twist is that we initialize the BootConfig
828 1.1 thorpej * structure with our "available" physical memory regions
829 1.1 thorpej * rather than the "total" physical memory regions. Why?
830 1.1 thorpej * Because:
831 1.1 thorpej *
832 1.1 thorpej * (a) the VM code requires that the "free" pages it is
833 1.1 thorpej * initialized with have consecutive indices. This
834 1.1 thorpej * allows it to use more efficient data structures
835 1.1 thorpej * (presumably).
836 1.1 thorpej * (b) the current pmap routines which report the initial
837 1.1 thorpej * set of free page indices (pmap_next_page) and
838 1.1 thorpej * which map addresses to indices (pmap_page_index)
839 1.1 thorpej * assume that the free pages are consecutive across
840 1.1 thorpej * memory region boundaries.
841 1.1 thorpej *
842 1.1 thorpej * This means that memory which is "stolen" at startup time
843 1.1 thorpej * (say, for page descriptors) MUST come from either the
844 1.1 thorpej * bottom of the first region or the top of the last.
845 1.1 thorpej *
846 1.1 thorpej * This requirement doesn't mesh well with OFW (or at least
847 1.1 thorpej * our use of it). We can get around it for the time being
848 1.1 thorpej * by pretending that our "available" region array describes
849 1.1 thorpej * all of our physical memory. This may cause some important
850 1.1 thorpej * information to be excluded from a dump file, but so far
851 1.1 thorpej * I haven't come across any other negative effects.
852 1.1 thorpej *
853 1.1 thorpej * In the long-run we should fix the index
854 1.1 thorpej * generation/translation code in the pmap module.
855 1.1 thorpej */
856 1.1 thorpej
857 1.1 thorpej if (DRAM_BLOCKS < (availcnt + 1))
858 1.1 thorpej panic("more ofw memory regions than bootconfig blocks");
859 1.1 thorpej
860 1.1 thorpej for (i = 0, mp = OFphysavail; i < nOFphysavail; i++, mp++) {
861 1.1 thorpej bootconfig.dram[i].address = mp->start;
862 1.1 thorpej bootconfig.dram[i].pages = btoc(mp->size);
863 1.1 thorpej }
864 1.1 thorpej bootconfig.dramblocks = availcnt;
865 1.1 thorpej }
866 1.1 thorpej
867 1.1 thorpej /* Initialize pmap module. */
868 1.1 thorpej pmap_bootstrap((pd_entry_t *)proc0_ttbbase.pv_va, proc0_ptpt);
869 1.1 thorpej }
870 1.1 thorpej
871 1.1 thorpej
872 1.1 thorpej /*
873 1.1 thorpej ************************************************************
874 1.1 thorpej
875 1.1 thorpej Routines private to this module
876 1.1 thorpej
877 1.1 thorpej ************************************************************
878 1.1 thorpej */
879 1.1 thorpej
880 1.1 thorpej /* N.B. Not supposed to call printf in callback-handler! Could deadlock! */
881 1.1 thorpej static void
882 1.1 thorpej ofw_callbackhandler(args)
883 1.1 thorpej struct ofw_cbargs *args;
884 1.1 thorpej {
885 1.1 thorpej char *name = args->name;
886 1.1 thorpej int nargs = args->nargs;
887 1.1 thorpej int nreturns = args->nreturns;
888 1.1 thorpej int *args_n_results = args->args_n_results;
889 1.1 thorpej
890 1.1 thorpej ofw_callbacks++;
891 1.1 thorpej
892 1.1 thorpej #if defined(OFWGENCFG)
893 1.1 thorpej /* Check this first, so that we don't waste IRQ time parsing. */
894 1.1 thorpej if (strcmp(name, "tick") == 0) {
895 1.1 thorpej vm_offset_t frame;
896 1.1 thorpej
897 1.1 thorpej /* Check format. */
898 1.1 thorpej if (nargs != 1 || nreturns < 1) {
899 1.1 thorpej args_n_results[nargs] = -1;
900 1.1 thorpej args->nreturns = 1;
901 1.1 thorpej return;
902 1.1 thorpej }
903 1.1 thorpej args_n_results[nargs] = 0; /* properly formatted request */
904 1.1 thorpej
905 1.1 thorpej /*
906 1.1 thorpej * Note that we are running in the IRQ frame, with interrupts
907 1.1 thorpej * disabled.
908 1.1 thorpej *
909 1.1 thorpej * We need to do two things here:
910 1.1 thorpej * - copy a few words out of the input frame into a global
911 1.1 thorpej * area, for later use by our real tick-handling code
912 1.1 thorpej * - patch a few words in the frame so that when OFW returns
913 1.1 thorpej * from the interrupt it will resume with our handler
914 1.1 thorpej * rather than the code that was actually interrupted.
915 1.1 thorpej * Our handler will resume when it finishes with the code
916 1.1 thorpej * that was actually interrupted.
917 1.1 thorpej *
918 1.1 thorpej * It's simplest to do this in assembler, since it requires
919 1.1 thorpej * switching frames and grovelling about with registers.
920 1.1 thorpej */
921 1.1 thorpej frame = (vm_offset_t)args_n_results[0];
922 1.1 thorpej if (ofw_handleticks)
923 1.1 thorpej dotickgrovelling(frame);
924 1.1 thorpej args_n_results[nargs + 1] = frame;
925 1.1 thorpej args->nreturns = 1;
926 1.1 thorpej } else
927 1.1 thorpej #endif
928 1.1 thorpej
929 1.1 thorpej if (strcmp(name, "map") == 0) {
930 1.1 thorpej vm_offset_t va;
931 1.1 thorpej vm_offset_t pa;
932 1.1 thorpej vm_size_t size;
933 1.1 thorpej int mode;
934 1.1 thorpej int ap_bits;
935 1.1 thorpej int dom_bits;
936 1.1 thorpej int cb_bits;
937 1.1 thorpej
938 1.1 thorpej /* Check format. */
939 1.1 thorpej if (nargs != 4 || nreturns < 2) {
940 1.1 thorpej args_n_results[nargs] = -1;
941 1.1 thorpej args->nreturns = 1;
942 1.1 thorpej return;
943 1.1 thorpej }
944 1.1 thorpej args_n_results[nargs] = 0; /* properly formatted request */
945 1.1 thorpej
946 1.1 thorpej pa = (vm_offset_t)args_n_results[0];
947 1.1 thorpej va = (vm_offset_t)args_n_results[1];
948 1.1 thorpej size = (vm_size_t)args_n_results[2];
949 1.1 thorpej mode = args_n_results[3];
950 1.1 thorpej ap_bits = (mode & 0x00000C00);
951 1.1 thorpej dom_bits = (mode & 0x000001E0);
952 1.1 thorpej cb_bits = (mode & 0x000000C0);
953 1.1 thorpej
954 1.1 thorpej /* Sanity checks. */
955 1.1 thorpej if ((va & PGOFSET) != 0 || va < OFW_VIRT_BASE ||
956 1.1 thorpej (va + size) > (OFW_VIRT_BASE + OFW_VIRT_SIZE) ||
957 1.1 thorpej (pa & PGOFSET) != 0 || (size & PGOFSET) != 0 ||
958 1.1 thorpej size == 0 || (dom_bits >> 5) != 0) {
959 1.1 thorpej args_n_results[nargs + 1] = -1;
960 1.1 thorpej args->nreturns = 1;
961 1.1 thorpej return;
962 1.1 thorpej }
963 1.1 thorpej
964 1.1 thorpej /* Write-back anything stuck in the cache. */
965 1.1 thorpej cpu_idcache_wbinv_all();
966 1.1 thorpej
967 1.1 thorpej /* Install new mappings. */
968 1.1 thorpej {
969 1.1 thorpej pt_entry_t *pte = vtopte(va);
970 1.1 thorpej int npages = size >> PGSHIFT;
971 1.1 thorpej
972 1.1 thorpej ap_bits >>= 10;
973 1.1 thorpej for (; npages > 0; pte++, pa += NBPG, npages--)
974 1.1 thorpej *pte = (pa | PT_AP(ap_bits) | L2_SPAGE | cb_bits);
975 1.1 thorpej }
976 1.1 thorpej
977 1.1 thorpej /* Clean out tlb. */
978 1.1 thorpej tlb_flush();
979 1.1 thorpej
980 1.1 thorpej args_n_results[nargs + 1] = 0;
981 1.1 thorpej args->nreturns = 2;
982 1.1 thorpej } else if (strcmp(name, "unmap") == 0) {
983 1.1 thorpej vm_offset_t va;
984 1.1 thorpej vm_size_t size;
985 1.1 thorpej
986 1.1 thorpej /* Check format. */
987 1.1 thorpej if (nargs != 2 || nreturns < 1) {
988 1.1 thorpej args_n_results[nargs] = -1;
989 1.1 thorpej args->nreturns = 1;
990 1.1 thorpej return;
991 1.1 thorpej }
992 1.1 thorpej args_n_results[nargs] = 0; /* properly formatted request */
993 1.1 thorpej
994 1.1 thorpej va = (vm_offset_t)args_n_results[0];
995 1.1 thorpej size = (vm_size_t)args_n_results[1];
996 1.1 thorpej
997 1.1 thorpej /* Sanity checks. */
998 1.1 thorpej if ((va & PGOFSET) != 0 || va < OFW_VIRT_BASE ||
999 1.1 thorpej (va + size) > (OFW_VIRT_BASE + OFW_VIRT_SIZE) ||
1000 1.1 thorpej (size & PGOFSET) != 0 || size == 0) {
1001 1.1 thorpej args_n_results[nargs + 1] = -1;
1002 1.1 thorpej args->nreturns = 1;
1003 1.1 thorpej return;
1004 1.1 thorpej }
1005 1.1 thorpej
1006 1.1 thorpej /* Write-back anything stuck in the cache. */
1007 1.1 thorpej cpu_idcache_wbinv_all();
1008 1.1 thorpej
1009 1.1 thorpej /* Zero the mappings. */
1010 1.1 thorpej {
1011 1.1 thorpej pt_entry_t *pte = vtopte(va);
1012 1.1 thorpej int npages = size >> PGSHIFT;
1013 1.1 thorpej
1014 1.1 thorpej for (; npages > 0; pte++, npages--)
1015 1.1 thorpej *pte = 0;
1016 1.1 thorpej }
1017 1.1 thorpej
1018 1.1 thorpej /* Clean out tlb. */
1019 1.1 thorpej tlb_flush();
1020 1.1 thorpej
1021 1.1 thorpej args->nreturns = 1;
1022 1.1 thorpej } else if (strcmp(name, "translate") == 0) {
1023 1.1 thorpej vm_offset_t va;
1024 1.1 thorpej vm_offset_t pa;
1025 1.1 thorpej int mode;
1026 1.1 thorpej pt_entry_t pte;
1027 1.1 thorpej
1028 1.1 thorpej /* Check format. */
1029 1.1 thorpej if (nargs != 1 || nreturns < 4) {
1030 1.1 thorpej args_n_results[nargs] = -1;
1031 1.1 thorpej args->nreturns = 1;
1032 1.1 thorpej return;
1033 1.1 thorpej }
1034 1.1 thorpej args_n_results[nargs] = 0; /* properly formatted request */
1035 1.1 thorpej
1036 1.1 thorpej va = (vm_offset_t)args_n_results[0];
1037 1.1 thorpej
1038 1.1 thorpej /* Sanity checks.
1039 1.1 thorpej * For now, I am only willing to translate va's in the
1040 1.1 thorpej * "ofw range." Eventually, I may be more generous. -JJK
1041 1.1 thorpej */
1042 1.1 thorpej if ((va & PGOFSET) != 0 || va < OFW_VIRT_BASE ||
1043 1.1 thorpej va >= (OFW_VIRT_BASE + OFW_VIRT_SIZE)) {
1044 1.1 thorpej args_n_results[nargs + 1] = -1;
1045 1.1 thorpej args->nreturns = 1;
1046 1.1 thorpej return;
1047 1.1 thorpej }
1048 1.1 thorpej
1049 1.1 thorpej /* Lookup mapping. */
1050 1.1 thorpej pte = *vtopte(va);
1051 1.1 thorpej if (pte == 0) {
1052 1.1 thorpej /* No mapping. */
1053 1.1 thorpej args_n_results[nargs + 1] = -1;
1054 1.1 thorpej args->nreturns = 2;
1055 1.1 thorpej } else {
1056 1.1 thorpej /* Existing mapping. */
1057 1.1 thorpej pa = (pte & PG_FRAME) | (va & ~PG_FRAME);
1058 1.1 thorpej mode = (pte & 0x0C00) | (0 << 5) | (pte & 0x000C); /* AP | DOM | CB */
1059 1.1 thorpej
1060 1.1 thorpej args_n_results[nargs + 1] = 0;
1061 1.1 thorpej args_n_results[nargs + 2] = pa;
1062 1.1 thorpej args_n_results[nargs + 3] = mode;
1063 1.1 thorpej args->nreturns = 4;
1064 1.1 thorpej }
1065 1.1 thorpej } else if (strcmp(name, "claim-phys") == 0) {
1066 1.1 thorpej struct pglist alloclist = TAILQ_HEAD_INITIALIZER(alloclist);
1067 1.1 thorpej vm_offset_t low, high;
1068 1.1 thorpej vm_size_t align, size;
1069 1.1 thorpej
1070 1.1 thorpej /*
1071 1.1 thorpej * XXX
1072 1.1 thorpej * XXX THIS IS A GROSS HACK AND NEEDS TO BE REWRITTEN. -- cgd
1073 1.1 thorpej * XXX
1074 1.1 thorpej */
1075 1.1 thorpej
1076 1.1 thorpej /* Check format. */
1077 1.1 thorpej if (nargs != 4 || nreturns < 3) {
1078 1.1 thorpej args_n_results[nargs] = -1;
1079 1.1 thorpej args->nreturns = 1;
1080 1.1 thorpej return;
1081 1.1 thorpej }
1082 1.1 thorpej args_n_results[nargs] = 0; /* properly formatted request */
1083 1.1 thorpej
1084 1.1 thorpej low = args_n_results[0];
1085 1.1 thorpej size = args_n_results[2];
1086 1.1 thorpej align = args_n_results[3];
1087 1.1 thorpej high = args_n_results[1] + size;
1088 1.1 thorpej
1089 1.1 thorpej #if 0
1090 1.1 thorpej printf("claim-phys: low = 0x%x, size = 0x%x, align = 0x%x, high = 0x%x\n",
1091 1.1 thorpej low, size, align, high);
1092 1.1 thorpej align = size;
1093 1.1 thorpej printf("forcing align to be 0x%x\n", align);
1094 1.1 thorpej #endif
1095 1.1 thorpej
1096 1.1 thorpej args_n_results[nargs + 1] =
1097 1.1 thorpej uvm_pglistalloc(size, low, high, align, 0, &alloclist, 1, 0);
1098 1.1 thorpej #if 0
1099 1.1 thorpej printf(" -> 0x%lx", args_n_results[nargs + 1]);
1100 1.1 thorpej #endif
1101 1.1 thorpej if (args_n_results[nargs + 1] != 0) {
1102 1.1 thorpej #if 0
1103 1.1 thorpej printf("(failed)\n");
1104 1.1 thorpej #endif
1105 1.1 thorpej args_n_results[nargs + 1] = -1;
1106 1.1 thorpej args->nreturns = 2;
1107 1.1 thorpej return;
1108 1.1 thorpej }
1109 1.1 thorpej args_n_results[nargs + 2] = alloclist.tqh_first->phys_addr;
1110 1.1 thorpej #if 0
1111 1.1 thorpej printf("(succeeded: pa = 0x%lx)\n", args_n_results[nargs + 2]);
1112 1.1 thorpej #endif
1113 1.1 thorpej args->nreturns = 3;
1114 1.1 thorpej
1115 1.1 thorpej } else if (strcmp(name, "release-phys") == 0) {
1116 1.1 thorpej printf("unimplemented ofw callback - %s\n", name);
1117 1.1 thorpej args_n_results[nargs] = -1;
1118 1.1 thorpej args->nreturns = 1;
1119 1.1 thorpej } else if (strcmp(name, "claim-virt") == 0) {
1120 1.1 thorpej vm_offset_t va;
1121 1.1 thorpej vm_size_t size;
1122 1.1 thorpej vm_offset_t align;
1123 1.1 thorpej
1124 1.1 thorpej /* XXX - notyet */
1125 1.1 thorpej /* printf("unimplemented ofw callback - %s\n", name);*/
1126 1.1 thorpej args_n_results[nargs] = -1;
1127 1.1 thorpej args->nreturns = 1;
1128 1.1 thorpej return;
1129 1.1 thorpej
1130 1.1 thorpej /* Check format. */
1131 1.1 thorpej if (nargs != 2 || nreturns < 3) {
1132 1.1 thorpej args_n_results[nargs] = -1;
1133 1.1 thorpej args->nreturns = 1;
1134 1.1 thorpej return;
1135 1.1 thorpej }
1136 1.1 thorpej args_n_results[nargs] = 0; /* properly formatted request */
1137 1.1 thorpej
1138 1.1 thorpej /* Allocate size bytes with specified alignment. */
1139 1.1 thorpej size = (vm_size_t)args_n_results[0];
1140 1.1 thorpej align = (vm_offset_t)args_n_results[1];
1141 1.1 thorpej if (align % NBPG != 0) {
1142 1.1 thorpej args_n_results[nargs + 1] = -1;
1143 1.1 thorpej args->nreturns = 2;
1144 1.1 thorpej return;
1145 1.1 thorpej }
1146 1.1 thorpej
1147 1.1 thorpej if (va == 0) {
1148 1.1 thorpej /* Couldn't allocate. */
1149 1.1 thorpej args_n_results[nargs + 1] = -1;
1150 1.1 thorpej args->nreturns = 2;
1151 1.1 thorpej } else {
1152 1.1 thorpej /* Successful allocation. */
1153 1.1 thorpej args_n_results[nargs + 1] = 0;
1154 1.1 thorpej args_n_results[nargs + 2] = va;
1155 1.1 thorpej args->nreturns = 3;
1156 1.1 thorpej }
1157 1.1 thorpej } else if (strcmp(name, "release-virt") == 0) {
1158 1.1 thorpej vm_offset_t va;
1159 1.1 thorpej vm_size_t size;
1160 1.1 thorpej
1161 1.1 thorpej /* XXX - notyet */
1162 1.1 thorpej printf("unimplemented ofw callback - %s\n", name);
1163 1.1 thorpej args_n_results[nargs] = -1;
1164 1.1 thorpej args->nreturns = 1;
1165 1.1 thorpej return;
1166 1.1 thorpej
1167 1.1 thorpej /* Check format. */
1168 1.1 thorpej if (nargs != 2 || nreturns < 1) {
1169 1.1 thorpej args_n_results[nargs] = -1;
1170 1.1 thorpej args->nreturns = 1;
1171 1.1 thorpej return;
1172 1.1 thorpej }
1173 1.1 thorpej args_n_results[nargs] = 0; /* properly formatted request */
1174 1.1 thorpej
1175 1.1 thorpej /* Release bytes. */
1176 1.1 thorpej va = (vm_offset_t)args_n_results[0];
1177 1.1 thorpej size = (vm_size_t)args_n_results[1];
1178 1.1 thorpej
1179 1.1 thorpej args->nreturns = 1;
1180 1.1 thorpej } else {
1181 1.1 thorpej args_n_results[nargs] = -1;
1182 1.1 thorpej args->nreturns = 1;
1183 1.1 thorpej }
1184 1.1 thorpej }
1185 1.1 thorpej
1186 1.1 thorpej #define KERNEL_VMDATA_PTS (KERNEL_VM_SIZE >> (PDSHIFT + 2))
1187 1.1 thorpej #define KERNEL_OFW_PTS 4
1188 1.1 thorpej #define KERNEL_IO_PTS 4
1189 1.1 thorpej
1190 1.1 thorpej static void
1191 1.1 thorpej ofw_construct_proc0_addrspace(proc0_ttbbase, proc0_ptpt)
1192 1.1 thorpej pv_addr_t *proc0_ttbbase;
1193 1.1 thorpej pv_addr_t *proc0_ptpt;
1194 1.1 thorpej {
1195 1.1 thorpej int i, oft;
1196 1.1 thorpej pv_addr_t proc0_pagedir;
1197 1.1 thorpej pv_addr_t proc0_pt_pte;
1198 1.1 thorpej pv_addr_t proc0_pt_sys;
1199 1.1 thorpej pv_addr_t proc0_pt_kernel;
1200 1.1 thorpej pv_addr_t proc0_pt_vmdata[KERNEL_VMDATA_PTS];
1201 1.1 thorpej pv_addr_t proc0_pt_ofw[KERNEL_OFW_PTS];
1202 1.1 thorpej pv_addr_t proc0_pt_io[KERNEL_IO_PTS];
1203 1.1 thorpej pv_addr_t msgbuf;
1204 1.1 thorpej vm_offset_t L1pagetable;
1205 1.1 thorpej vm_offset_t L2pagetable;
1206 1.1 thorpej struct mem_translation *tp;
1207 1.1 thorpej
1208 1.1 thorpej /* Set-up the system page. */
1209 1.1 thorpej systempage.pv_va = ofw_claimvirt(0, NBPG, 0);
1210 1.1 thorpej if (systempage.pv_va == -1) {
1211 1.1 thorpej /* Something was already mapped to VA 0. */
1212 1.1 thorpej systempage.pv_va = 0;
1213 1.1 thorpej systempage.pv_pa = ofw_gettranslation(0);
1214 1.1 thorpej if (systempage.pv_pa == -1)
1215 1.1 thorpej panic("bogus result from gettranslation(0)");
1216 1.1 thorpej } else {
1217 1.1 thorpej /* We were just allocated the page-length range at VA 0. */
1218 1.1 thorpej if (systempage.pv_va != 0)
1219 1.1 thorpej panic("bogus result from claimvirt(0, NBPG, 0)");
1220 1.1 thorpej
1221 1.1 thorpej /* Now allocate a physical page, and establish the mapping. */
1222 1.1 thorpej systempage.pv_pa = ofw_claimphys(0, NBPG, NBPG);
1223 1.1 thorpej if (systempage.pv_pa == -1)
1224 1.1 thorpej panic("bogus result from claimphys(0, NBPG, NBPG)");
1225 1.1 thorpej ofw_settranslation(systempage.pv_va, systempage.pv_pa,
1226 1.1 thorpej NBPG, -1); /* XXX - mode? -JJK */
1227 1.1 thorpej
1228 1.1 thorpej /* Zero the memory. */
1229 1.1 thorpej bzero((char *)systempage.pv_va, NBPG);
1230 1.1 thorpej }
1231 1.1 thorpej
1232 1.1 thorpej /* Allocate/initialize space for the proc0, NetBSD-managed */
1233 1.1 thorpej /* page tables that we will be switching to soon. */
1234 1.1 thorpej ofw_claimpages(&virt_freeptr, &proc0_pagedir, PD_SIZE);
1235 1.1 thorpej ofw_claimpages(&virt_freeptr, &proc0_pt_pte, PT_SIZE);
1236 1.1 thorpej ofw_claimpages(&virt_freeptr, &proc0_pt_sys, PT_SIZE);
1237 1.1 thorpej ofw_claimpages(&virt_freeptr, &proc0_pt_kernel, PT_SIZE);
1238 1.1 thorpej for (i = 0; i < KERNEL_VMDATA_PTS; i++)
1239 1.1 thorpej ofw_claimpages(&virt_freeptr, &proc0_pt_vmdata[i], PT_SIZE);
1240 1.1 thorpej for (i = 0; i < KERNEL_OFW_PTS; i++)
1241 1.1 thorpej ofw_claimpages(&virt_freeptr, &proc0_pt_ofw[i], PT_SIZE);
1242 1.1 thorpej for (i = 0; i < KERNEL_IO_PTS; i++)
1243 1.1 thorpej ofw_claimpages(&virt_freeptr, &proc0_pt_io[i], PT_SIZE);
1244 1.1 thorpej
1245 1.1 thorpej /* Allocate/initialize space for stacks. */
1246 1.1 thorpej #ifndef OFWGENCFG
1247 1.1 thorpej ofw_claimpages(&virt_freeptr, &irqstack, NBPG);
1248 1.1 thorpej #endif
1249 1.1 thorpej ofw_claimpages(&virt_freeptr, &undstack, NBPG);
1250 1.1 thorpej ofw_claimpages(&virt_freeptr, &abtstack, NBPG);
1251 1.1 thorpej ofw_claimpages(&virt_freeptr, &kernelstack, UPAGES * NBPG);
1252 1.1 thorpej
1253 1.1 thorpej /* Allocate/initialize space for msgbuf area. */
1254 1.1 thorpej ofw_claimpages(&virt_freeptr, &msgbuf, MSGBUFSIZE);
1255 1.1 thorpej msgbufphys = msgbuf.pv_pa;
1256 1.1 thorpej
1257 1.1 thorpej /*
1258 1.1 thorpej * OK, we're done allocating.
1259 1.1 thorpej * Get a dump of OFW's translations, and make the appropriate
1260 1.1 thorpej * entries in the L2 pagetables that we just allocated.
1261 1.1 thorpej */
1262 1.1 thorpej
1263 1.1 thorpej ofw_getvirttranslations();
1264 1.1 thorpej
1265 1.1 thorpej for (oft = 0, tp = OFtranslations; oft < nOFtranslations;
1266 1.1 thorpej oft++, tp++) {
1267 1.1 thorpej
1268 1.1 thorpej vm_offset_t va, pa;
1269 1.1 thorpej int npages = tp->size / NBPG;
1270 1.1 thorpej
1271 1.1 thorpej /* Size must be an integral number of pages. */
1272 1.1 thorpej if (npages == 0 || tp->size % NBPG != 0)
1273 1.1 thorpej panic("illegal ofw translation (size)");
1274 1.1 thorpej
1275 1.1 thorpej /* Make an entry for each page in the appropriate table. */
1276 1.1 thorpej for (va = tp->virt, pa = tp->phys; npages > 0;
1277 1.1 thorpej va += NBPG, pa += NBPG, npages--) {
1278 1.1 thorpej vm_offset_t L2pagetable;
1279 1.1 thorpej
1280 1.1 thorpej /*
1281 1.1 thorpej * Map the top bits to the appropriate L2 pagetable.
1282 1.1 thorpej * The only allowable regions are page0, the
1283 1.1 thorpej * kernel-static area, and the ofw area.
1284 1.1 thorpej */
1285 1.1 thorpej switch (va >> (PDSHIFT + 2)) {
1286 1.1 thorpej case 0:
1287 1.1 thorpej /* page0 */
1288 1.1 thorpej L2pagetable = proc0_pt_sys.pv_va;
1289 1.1 thorpej break;
1290 1.1 thorpej
1291 1.1 thorpej case (KERNEL_BASE >> (PDSHIFT + 2)):
1292 1.1 thorpej /* kernel static area */
1293 1.1 thorpej L2pagetable = proc0_pt_kernel.pv_va;
1294 1.1 thorpej break;
1295 1.1 thorpej
1296 1.1 thorpej case ( OFW_VIRT_BASE >> (PDSHIFT + 2)):
1297 1.1 thorpej case ((OFW_VIRT_BASE + 0x00400000) >> (PDSHIFT + 2)):
1298 1.1 thorpej case ((OFW_VIRT_BASE + 0x00800000) >> (PDSHIFT + 2)):
1299 1.1 thorpej case ((OFW_VIRT_BASE + 0x00C00000) >> (PDSHIFT + 2)):
1300 1.1 thorpej /* ofw area */
1301 1.1 thorpej L2pagetable = proc0_pt_ofw[(va >> (PDSHIFT + 2))
1302 1.1 thorpej & 0x3].pv_va;
1303 1.1 thorpej break;
1304 1.1 thorpej
1305 1.1 thorpej case ( IO_VIRT_BASE >> (PDSHIFT + 2)):
1306 1.1 thorpej case ((IO_VIRT_BASE + 0x00400000) >> (PDSHIFT + 2)):
1307 1.1 thorpej case ((IO_VIRT_BASE + 0x00800000) >> (PDSHIFT + 2)):
1308 1.1 thorpej case ((IO_VIRT_BASE + 0x00C00000) >> (PDSHIFT + 2)):
1309 1.1 thorpej /* io area */
1310 1.1 thorpej L2pagetable = proc0_pt_io[(va >> (PDSHIFT + 2))
1311 1.1 thorpej & 0x3].pv_va;
1312 1.1 thorpej break;
1313 1.1 thorpej
1314 1.1 thorpej default:
1315 1.1 thorpej /* illegal */
1316 1.1 thorpej panic("illegal ofw translation (addr) %#lx", va);
1317 1.1 thorpej }
1318 1.1 thorpej
1319 1.1 thorpej /* Sanity. The current entry should be null. */
1320 1.1 thorpej {
1321 1.1 thorpej pt_entry_t pte;
1322 1.1 thorpej pte = ReadWord(L2pagetable + ((va >> 10)
1323 1.1 thorpej & 0x00000FFC));
1324 1.1 thorpej if (pte != 0)
1325 1.1 thorpej panic("illegal ofw translation (%#lx, %#lx, %#lx, %x)",
1326 1.1 thorpej L2pagetable, va, pa, pte);
1327 1.1 thorpej }
1328 1.1 thorpej
1329 1.1 thorpej /* Make the entry. */
1330 1.1 thorpej if ((tp->mode & 0xC) == 0xC)
1331 1.1 thorpej map_entry(L2pagetable, va, pa);
1332 1.1 thorpej else
1333 1.1 thorpej map_entry_nc(L2pagetable, va, pa);
1334 1.1 thorpej }
1335 1.1 thorpej }
1336 1.1 thorpej
1337 1.1 thorpej /*
1338 1.1 thorpej * We don't actually want some of the mappings that we just
1339 1.1 thorpej * set up to appear in proc0's address space. In particular,
1340 1.1 thorpej * we don't want aliases to physical addresses that the kernel
1341 1.1 thorpej * has-mapped/will-map elsewhere.
1342 1.1 thorpej */
1343 1.1 thorpej ofw_discardmappings(proc0_pt_kernel.pv_va,
1344 1.1 thorpej proc0_pt_sys.pv_va, PT_SIZE);
1345 1.1 thorpej ofw_discardmappings(proc0_pt_kernel.pv_va,
1346 1.1 thorpej proc0_pt_kernel.pv_va, PT_SIZE);
1347 1.1 thorpej for (i = 0; i < KERNEL_VMDATA_PTS; i++)
1348 1.1 thorpej ofw_discardmappings(proc0_pt_kernel.pv_va,
1349 1.1 thorpej proc0_pt_vmdata[i].pv_va, PT_SIZE);
1350 1.1 thorpej for (i = 0; i < KERNEL_OFW_PTS; i++)
1351 1.1 thorpej ofw_discardmappings(proc0_pt_kernel.pv_va,
1352 1.1 thorpej proc0_pt_ofw[i].pv_va, PT_SIZE);
1353 1.1 thorpej for (i = 0; i < KERNEL_IO_PTS; i++)
1354 1.1 thorpej ofw_discardmappings(proc0_pt_kernel.pv_va,
1355 1.1 thorpej proc0_pt_io[i].pv_va, PT_SIZE);
1356 1.1 thorpej ofw_discardmappings(proc0_pt_kernel.pv_va,
1357 1.1 thorpej msgbuf.pv_va, MSGBUFSIZE);
1358 1.1 thorpej
1359 1.1 thorpej /*
1360 1.1 thorpej * We did not throw away the proc0_pt_pte and proc0_pagedir
1361 1.1 thorpej * mappings as well still want them. However we don't want them
1362 1.1 thorpej * cached ...
1363 1.1 thorpej * Really these should be uncached when allocated.
1364 1.1 thorpej */
1365 1.1 thorpej map_entry_nc(proc0_pt_kernel.pv_va, proc0_pt_pte.pv_va,
1366 1.1 thorpej proc0_pt_pte.pv_pa);
1367 1.1 thorpej for (i = 0; i < (PD_SIZE / NBPG); ++i)
1368 1.1 thorpej map_entry_nc(proc0_pt_kernel.pv_va,
1369 1.1 thorpej proc0_pagedir.pv_va + NBPG * i,
1370 1.1 thorpej proc0_pagedir.pv_pa + NBPG * i);
1371 1.1 thorpej
1372 1.1 thorpej /*
1373 1.1 thorpej * Construct the proc0 L2 pagetables that map page tables.
1374 1.1 thorpej */
1375 1.1 thorpej
1376 1.1 thorpej /* Map entries in the L2pagetable used to map L2PTs. */
1377 1.1 thorpej L2pagetable = proc0_pt_pte.pv_va;
1378 1.1 thorpej map_entry_nc(L2pagetable, (0x00000000 >> (PGSHIFT-2)),
1379 1.1 thorpej proc0_pt_sys.pv_pa);
1380 1.1 thorpej map_entry_nc(L2pagetable, (KERNEL_BASE >> (PGSHIFT-2)),
1381 1.1 thorpej proc0_pt_kernel.pv_pa);
1382 1.1 thorpej map_entry_nc(L2pagetable, (PROCESS_PAGE_TBLS_BASE >> (PGSHIFT-2)),
1383 1.1 thorpej proc0_pt_pte.pv_pa);
1384 1.1 thorpej for (i = 0; i < KERNEL_VMDATA_PTS; i++)
1385 1.1 thorpej map_entry_nc(L2pagetable, ((KERNEL_VM_BASE + i * 0x00400000)
1386 1.1 thorpej >> (PGSHIFT-2)), proc0_pt_vmdata[i].pv_pa);
1387 1.1 thorpej for (i = 0; i < KERNEL_OFW_PTS; i++)
1388 1.1 thorpej map_entry_nc(L2pagetable, ((OFW_VIRT_BASE + i * 0x00400000)
1389 1.1 thorpej >> (PGSHIFT-2)), proc0_pt_ofw[i].pv_pa);
1390 1.1 thorpej for (i = 0; i < KERNEL_IO_PTS; i++)
1391 1.1 thorpej map_entry_nc(L2pagetable, ((IO_VIRT_BASE + i * 0x00400000)
1392 1.1 thorpej >> (PGSHIFT-2)), proc0_pt_io[i].pv_pa);
1393 1.1 thorpej
1394 1.1 thorpej /* Construct the proc0 L1 pagetable. */
1395 1.1 thorpej L1pagetable = proc0_pagedir.pv_va;
1396 1.1 thorpej
1397 1.1 thorpej map_pagetable(L1pagetable, 0x0, proc0_pt_sys.pv_pa);
1398 1.1 thorpej map_pagetable(L1pagetable, KERNEL_BASE, proc0_pt_kernel.pv_pa);
1399 1.1 thorpej map_pagetable(L1pagetable, PROCESS_PAGE_TBLS_BASE,
1400 1.1 thorpej proc0_pt_pte.pv_pa);
1401 1.1 thorpej for (i = 0; i < KERNEL_VMDATA_PTS; i++)
1402 1.1 thorpej map_pagetable(L1pagetable, KERNEL_VM_BASE + i * 0x00400000,
1403 1.1 thorpej proc0_pt_vmdata[i].pv_pa);
1404 1.1 thorpej for (i = 0; i < KERNEL_OFW_PTS; i++)
1405 1.1 thorpej map_pagetable(L1pagetable, OFW_VIRT_BASE + i * 0x00400000,
1406 1.1 thorpej proc0_pt_ofw[i].pv_pa);
1407 1.1 thorpej for (i = 0; i < KERNEL_IO_PTS; i++)
1408 1.1 thorpej map_pagetable(L1pagetable, IO_VIRT_BASE + i * 0x00400000,
1409 1.1 thorpej proc0_pt_io[i].pv_pa);
1410 1.1 thorpej
1411 1.1 thorpej /*
1412 1.1 thorpej * gross hack for the sake of not thrashing the TLB and making
1413 1.1 thorpej * cache flush more efficient: blast l1 ptes for sections.
1414 1.1 thorpej */
1415 1.1 thorpej for (oft = 0, tp = OFtranslations; oft < nOFtranslations; oft++, tp++) {
1416 1.1 thorpej vm_offset_t va = tp->virt;
1417 1.1 thorpej vm_offset_t pa = tp->phys;
1418 1.1 thorpej
1419 1.1 thorpej if (((va & (NBPD - 1)) == 0) && ((pa & (NBPD - 1)) == 0)) {
1420 1.1 thorpej int nsections = tp->size / NBPD;
1421 1.1 thorpej
1422 1.1 thorpej while (nsections--) {
1423 1.2 thorpej /* XXXJRT prot?? */
1424 1.2 thorpej pmap_map_section(L1pagetable, va, pa,
1425 1.2 thorpej VM_PROT_READ|VM_PROT_WRITE,
1426 1.2 thorpej (tp->mode & 0xC) == 0xC ? PTE_CACHE
1427 1.2 thorpej : PTE_NOCACHE);
1428 1.1 thorpej va += NBPD;
1429 1.1 thorpej pa += NBPD;
1430 1.1 thorpej } /* END while */
1431 1.1 thorpej } /* END if */
1432 1.1 thorpej } /* END for */
1433 1.1 thorpej
1434 1.1 thorpej /* OUT parameters are the new ttbbase and the pt which maps pts. */
1435 1.1 thorpej *proc0_ttbbase = proc0_pagedir;
1436 1.1 thorpej *proc0_ptpt = proc0_pt_pte;
1437 1.1 thorpej }
1438 1.1 thorpej
1439 1.1 thorpej
1440 1.1 thorpej static void
1441 1.1 thorpej ofw_getphysmeminfo()
1442 1.1 thorpej {
1443 1.1 thorpej int phandle;
1444 1.1 thorpej int mem_len;
1445 1.1 thorpej int avail_len;
1446 1.1 thorpej int i;
1447 1.1 thorpej
1448 1.1 thorpej if ((phandle = OF_finddevice("/memory")) == -1 ||
1449 1.1 thorpej (mem_len = OF_getproplen(phandle, "reg")) <= 0 ||
1450 1.1 thorpej (OFphysmem = (struct mem_region *)ofw_malloc(mem_len)) == 0 ||
1451 1.1 thorpej OF_getprop(phandle, "reg", OFphysmem, mem_len) != mem_len ||
1452 1.1 thorpej (avail_len = OF_getproplen(phandle, "available")) <= 0 ||
1453 1.1 thorpej (OFphysavail = (struct mem_region *)ofw_malloc(avail_len)) == 0 ||
1454 1.1 thorpej OF_getprop(phandle, "available", OFphysavail, avail_len)
1455 1.1 thorpej != avail_len)
1456 1.1 thorpej panic("can't get physmeminfo from OFW");
1457 1.1 thorpej
1458 1.1 thorpej nOFphysmem = mem_len / sizeof(struct mem_region);
1459 1.1 thorpej nOFphysavail = avail_len / sizeof(struct mem_region);
1460 1.1 thorpej
1461 1.1 thorpej /*
1462 1.1 thorpej * Sort the blocks in each array into ascending address order.
1463 1.1 thorpej * Also, page-align all blocks.
1464 1.1 thorpej */
1465 1.1 thorpej for (i = 0; i < 2; i++) {
1466 1.1 thorpej struct mem_region *tmp = (i == 0) ? OFphysmem : OFphysavail;
1467 1.1 thorpej struct mem_region *mp;
1468 1.1 thorpej int cnt = (i == 0) ? nOFphysmem : nOFphysavail;
1469 1.1 thorpej int j;
1470 1.1 thorpej
1471 1.1 thorpej #ifdef OLDPRINTFS
1472 1.1 thorpej printf("ofw_getphysmeminfo: %d blocks\n", cnt);
1473 1.1 thorpej #endif
1474 1.1 thorpej
1475 1.1 thorpej /* XXX - Convert all the values to host order. -JJK */
1476 1.1 thorpej for (j = 0, mp = tmp; j < cnt; j++, mp++) {
1477 1.1 thorpej mp->start = of_decode_int((unsigned char *)&mp->start);
1478 1.1 thorpej mp->size = of_decode_int((unsigned char *)&mp->size);
1479 1.1 thorpej }
1480 1.1 thorpej
1481 1.1 thorpej for (j = 0, mp = tmp; j < cnt; j++, mp++) {
1482 1.1 thorpej u_int s, sz;
1483 1.1 thorpej struct mem_region *mp1;
1484 1.1 thorpej
1485 1.1 thorpej /* Page-align start of the block. */
1486 1.1 thorpej s = mp->start % NBPG;
1487 1.1 thorpej if (s != 0) {
1488 1.1 thorpej s = (NBPG - s);
1489 1.1 thorpej
1490 1.1 thorpej if (mp->size >= s) {
1491 1.1 thorpej mp->start += s;
1492 1.1 thorpej mp->size -= s;
1493 1.1 thorpej }
1494 1.1 thorpej }
1495 1.1 thorpej
1496 1.1 thorpej /* Page-align the size. */
1497 1.1 thorpej mp->size -= mp->size % NBPG;
1498 1.1 thorpej
1499 1.1 thorpej /* Handle empty block. */
1500 1.1 thorpej if (mp->size == 0) {
1501 1.1 thorpej bcopy(mp + 1, mp, (cnt - (mp - tmp))
1502 1.1 thorpej * sizeof(struct mem_region));
1503 1.1 thorpej cnt--;
1504 1.1 thorpej mp--;
1505 1.1 thorpej continue;
1506 1.1 thorpej }
1507 1.1 thorpej
1508 1.1 thorpej /* Bubble sort. */
1509 1.1 thorpej s = mp->start;
1510 1.1 thorpej sz = mp->size;
1511 1.1 thorpej for (mp1 = tmp; mp1 < mp; mp1++)
1512 1.1 thorpej if (s < mp1->start)
1513 1.1 thorpej break;
1514 1.1 thorpej if (mp1 < mp) {
1515 1.1 thorpej bcopy(mp1, mp1 + 1, (char *)mp - (char *)mp1);
1516 1.1 thorpej mp1->start = s;
1517 1.1 thorpej mp1->size = sz;
1518 1.1 thorpej }
1519 1.1 thorpej }
1520 1.1 thorpej
1521 1.1 thorpej #ifdef OLDPRINTFS
1522 1.1 thorpej for (mp = tmp; mp->size; mp++) {
1523 1.1 thorpej printf("%x, %x\n", mp->start, mp->size);
1524 1.1 thorpej }
1525 1.1 thorpej #endif
1526 1.1 thorpej }
1527 1.1 thorpej }
1528 1.1 thorpej
1529 1.1 thorpej
1530 1.1 thorpej static void
1531 1.1 thorpej ofw_getvirttranslations(void)
1532 1.1 thorpej {
1533 1.1 thorpej int mmu_phandle;
1534 1.1 thorpej int mmu_ihandle;
1535 1.1 thorpej int trans_len;
1536 1.1 thorpej int over, len;
1537 1.1 thorpej int i;
1538 1.1 thorpej struct mem_translation *tp;
1539 1.1 thorpej
1540 1.1 thorpej mmu_ihandle = ofw_mmu_ihandle();
1541 1.1 thorpej
1542 1.1 thorpej /* overallocate to avoid increases during allocation */
1543 1.1 thorpej over = 4 * sizeof(struct mem_translation);
1544 1.1 thorpej if ((mmu_phandle = OF_instance_to_package(mmu_ihandle)) == -1 ||
1545 1.1 thorpej (len = OF_getproplen(mmu_phandle, "translations")) <= 0 ||
1546 1.1 thorpej (OFtranslations = ofw_malloc(len + over)) == 0 ||
1547 1.1 thorpej (trans_len = OF_getprop(mmu_phandle, "translations",
1548 1.1 thorpej OFtranslations, len + over)) > (len + over))
1549 1.1 thorpej panic("can't get virttranslations from OFW");
1550 1.1 thorpej
1551 1.1 thorpej /* XXX - Convert all the values to host order. -JJK */
1552 1.1 thorpej nOFtranslations = trans_len / sizeof(struct mem_translation);
1553 1.1 thorpej #ifdef OLDPRINTFS
1554 1.1 thorpej printf("ofw_getvirtmeminfo: %d blocks\n", nOFtranslations);
1555 1.1 thorpej #endif
1556 1.1 thorpej for (i = 0, tp = OFtranslations; i < nOFtranslations; i++, tp++) {
1557 1.1 thorpej tp->virt = of_decode_int((unsigned char *)&tp->virt);
1558 1.1 thorpej tp->size = of_decode_int((unsigned char *)&tp->size);
1559 1.1 thorpej tp->phys = of_decode_int((unsigned char *)&tp->phys);
1560 1.1 thorpej tp->mode = of_decode_int((unsigned char *)&tp->mode);
1561 1.1 thorpej }
1562 1.1 thorpej }
1563 1.1 thorpej
1564 1.1 thorpej /*
1565 1.1 thorpej * ofw_valloc: allocate blocks of VM for IO and other special purposes
1566 1.1 thorpej */
1567 1.1 thorpej typedef struct _vfree {
1568 1.1 thorpej struct _vfree *pNext;
1569 1.1 thorpej vm_offset_t start;
1570 1.1 thorpej vm_size_t size;
1571 1.1 thorpej } VFREE, *PVFREE;
1572 1.1 thorpej
1573 1.1 thorpej static VFREE vfinitial = { NULL, IO_VIRT_BASE, IO_VIRT_SIZE };
1574 1.1 thorpej
1575 1.1 thorpej static PVFREE vflist = &vfinitial;
1576 1.1 thorpej
1577 1.1 thorpej static vm_offset_t
1578 1.1 thorpej ofw_valloc(size, align)
1579 1.1 thorpej vm_offset_t size;
1580 1.1 thorpej vm_offset_t align;
1581 1.1 thorpej {
1582 1.1 thorpej PVFREE *ppvf;
1583 1.1 thorpej PVFREE pNew;
1584 1.1 thorpej vm_offset_t new;
1585 1.1 thorpej vm_offset_t lead;
1586 1.1 thorpej
1587 1.1 thorpej for (ppvf = &vflist; *ppvf; ppvf = &((*ppvf)->pNext)) {
1588 1.1 thorpej if (align == 0) {
1589 1.1 thorpej new = (*ppvf)->start;
1590 1.1 thorpej lead = 0;
1591 1.1 thorpej } else {
1592 1.1 thorpej new = ((*ppvf)->start + (align - 1)) & ~(align - 1);
1593 1.1 thorpej lead = new - (*ppvf)->start;
1594 1.1 thorpej }
1595 1.1 thorpej
1596 1.1 thorpej if (((*ppvf)->size - lead) >= size) {
1597 1.1 thorpej if (lead == 0) {
1598 1.1 thorpej /* using whole block */
1599 1.1 thorpej if (size == (*ppvf)->size) {
1600 1.1 thorpej /* splice out of list */
1601 1.1 thorpej (*ppvf) = (*ppvf)->pNext;
1602 1.1 thorpej } else { /* tail of block is free */
1603 1.1 thorpej (*ppvf)->start = new + size;
1604 1.1 thorpej (*ppvf)->size -= size;
1605 1.1 thorpej }
1606 1.1 thorpej } else {
1607 1.1 thorpej vm_size_t tail = ((*ppvf)->start
1608 1.1 thorpej + (*ppvf)->size) - (new + size);
1609 1.1 thorpej /* free space at beginning */
1610 1.1 thorpej (*ppvf)->size = lead;
1611 1.1 thorpej
1612 1.1 thorpej if (tail != 0) {
1613 1.1 thorpej /* free space at tail */
1614 1.1 thorpej pNew = ofw_malloc(sizeof(VFREE));
1615 1.1 thorpej pNew->pNext = (*ppvf)->pNext;
1616 1.1 thorpej (*ppvf)->pNext = pNew;
1617 1.1 thorpej pNew->start = new + size;
1618 1.1 thorpej pNew->size = tail;
1619 1.1 thorpej }
1620 1.1 thorpej }
1621 1.1 thorpej return new;
1622 1.1 thorpej } /* END if */
1623 1.1 thorpej } /* END for */
1624 1.1 thorpej
1625 1.1 thorpej return -1;
1626 1.1 thorpej }
1627 1.1 thorpej
1628 1.1 thorpej vm_offset_t
1629 1.1 thorpej ofw_map(pa, size, cb_bits)
1630 1.1 thorpej vm_offset_t pa;
1631 1.1 thorpej vm_size_t size;
1632 1.1 thorpej int cb_bits;
1633 1.1 thorpej {
1634 1.1 thorpej vm_offset_t va;
1635 1.1 thorpej
1636 1.1 thorpej if ((va = ofw_valloc(size, size)) == -1)
1637 1.1 thorpej panic("cannot alloc virtual memory for %#lx", pa);
1638 1.1 thorpej
1639 1.1 thorpej ofw_claimvirt(va, size, 0); /* make sure OFW knows about the memory */
1640 1.1 thorpej
1641 1.1 thorpej ofw_settranslation(va, pa, size, PT_AP(AP_KRW) | cb_bits);
1642 1.1 thorpej
1643 1.1 thorpej return va;
1644 1.1 thorpej }
1645 1.1 thorpej
1646 1.1 thorpej static int
1647 1.1 thorpej ofw_mem_ihandle(void)
1648 1.1 thorpej {
1649 1.1 thorpej static int mem_ihandle = 0;
1650 1.1 thorpej int chosen;
1651 1.1 thorpej
1652 1.1 thorpej if (mem_ihandle != 0)
1653 1.1 thorpej return(mem_ihandle);
1654 1.1 thorpej
1655 1.1 thorpej if ((chosen = OF_finddevice("/chosen")) == -1 ||
1656 1.1 thorpej OF_getprop(chosen, "memory", &mem_ihandle, sizeof(int)) < 0)
1657 1.1 thorpej panic("ofw_mem_ihandle");
1658 1.1 thorpej
1659 1.1 thorpej mem_ihandle = of_decode_int((unsigned char *)&mem_ihandle);
1660 1.1 thorpej
1661 1.1 thorpej return(mem_ihandle);
1662 1.1 thorpej }
1663 1.1 thorpej
1664 1.1 thorpej
1665 1.1 thorpej static int
1666 1.1 thorpej ofw_mmu_ihandle(void)
1667 1.1 thorpej {
1668 1.1 thorpej static int mmu_ihandle = 0;
1669 1.1 thorpej int chosen;
1670 1.1 thorpej
1671 1.1 thorpej if (mmu_ihandle != 0)
1672 1.1 thorpej return(mmu_ihandle);
1673 1.1 thorpej
1674 1.1 thorpej if ((chosen = OF_finddevice("/chosen")) == -1 ||
1675 1.1 thorpej OF_getprop(chosen, "mmu", &mmu_ihandle, sizeof(int)) < 0)
1676 1.1 thorpej panic("ofw_mmu_ihandle");
1677 1.1 thorpej
1678 1.1 thorpej mmu_ihandle = of_decode_int((unsigned char *)&mmu_ihandle);
1679 1.1 thorpej
1680 1.1 thorpej return(mmu_ihandle);
1681 1.1 thorpej }
1682 1.1 thorpej
1683 1.1 thorpej
1684 1.1 thorpej /* Return -1 on failure. */
1685 1.1 thorpej static vm_offset_t
1686 1.1 thorpej ofw_claimphys(pa, size, align)
1687 1.1 thorpej vm_offset_t pa;
1688 1.1 thorpej vm_size_t size;
1689 1.1 thorpej vm_offset_t align;
1690 1.1 thorpej {
1691 1.1 thorpej int mem_ihandle = ofw_mem_ihandle();
1692 1.1 thorpej
1693 1.1 thorpej /* printf("ofw_claimphys (%x, %x, %x) --> ", pa, size, align);*/
1694 1.1 thorpej if (align == 0) {
1695 1.1 thorpej /* Allocate at specified base; alignment is ignored. */
1696 1.1 thorpej pa = OF_call_method_1("claim", mem_ihandle, 3, pa, size, align);
1697 1.1 thorpej } else {
1698 1.1 thorpej /* Allocate anywhere, with specified alignment. */
1699 1.1 thorpej pa = OF_call_method_1("claim", mem_ihandle, 2, size, align);
1700 1.1 thorpej }
1701 1.1 thorpej
1702 1.1 thorpej /* printf("%x\n", pa);*/
1703 1.1 thorpej return(pa);
1704 1.1 thorpej }
1705 1.1 thorpej
1706 1.1 thorpej
1707 1.1 thorpej #if 0
1708 1.1 thorpej /* Return -1 on failure. */
1709 1.1 thorpej static vm_offset_t
1710 1.1 thorpej ofw_releasephys(pa, size)
1711 1.1 thorpej vm_offset_t pa;
1712 1.1 thorpej vm_size_t size;
1713 1.1 thorpej {
1714 1.1 thorpej int mem_ihandle = ofw_mem_ihandle();
1715 1.1 thorpej
1716 1.1 thorpej /* printf("ofw_releasephys (%x, %x)\n", pa, size);*/
1717 1.1 thorpej
1718 1.1 thorpej return (OF_call_method_1("release", mem_ihandle, 2, pa, size));
1719 1.1 thorpej }
1720 1.1 thorpej #endif
1721 1.1 thorpej
1722 1.1 thorpej /* Return -1 on failure. */
1723 1.1 thorpej static vm_offset_t
1724 1.1 thorpej ofw_claimvirt(va, size, align)
1725 1.1 thorpej vm_offset_t va;
1726 1.1 thorpej vm_size_t size;
1727 1.1 thorpej vm_offset_t align;
1728 1.1 thorpej {
1729 1.1 thorpej int mmu_ihandle = ofw_mmu_ihandle();
1730 1.1 thorpej
1731 1.1 thorpej /*printf("ofw_claimvirt (%x, %x, %x) --> ", va, size, align);*/
1732 1.1 thorpej if (align == 0) {
1733 1.1 thorpej /* Allocate at specified base; alignment is ignored. */
1734 1.1 thorpej va = OF_call_method_1("claim", mmu_ihandle, 3, va, size, align);
1735 1.1 thorpej } else {
1736 1.1 thorpej /* Allocate anywhere, with specified alignment. */
1737 1.1 thorpej va = OF_call_method_1("claim", mmu_ihandle, 2, size, align);
1738 1.1 thorpej }
1739 1.1 thorpej
1740 1.1 thorpej /*printf("%x\n", va);*/
1741 1.1 thorpej return(va);
1742 1.1 thorpej }
1743 1.1 thorpej
1744 1.1 thorpej
1745 1.1 thorpej /* Return -1 if no mapping. */
1746 1.1 thorpej vm_offset_t
1747 1.1 thorpej ofw_gettranslation(va)
1748 1.1 thorpej vm_offset_t va;
1749 1.1 thorpej {
1750 1.1 thorpej int mmu_ihandle = ofw_mmu_ihandle();
1751 1.1 thorpej vm_offset_t pa;
1752 1.1 thorpej int mode;
1753 1.1 thorpej int exists;
1754 1.1 thorpej
1755 1.1 thorpej /*printf("ofw_gettranslation (%x) --> ", va);*/
1756 1.1 thorpej exists = 0; /* gets set to true if translation exists */
1757 1.1 thorpej if (OF_call_method("translate", mmu_ihandle, 1, 3, va, &pa, &mode,
1758 1.1 thorpej &exists) != 0)
1759 1.1 thorpej return(-1);
1760 1.1 thorpej
1761 1.1 thorpej /*printf("%x\n", exists ? pa : -1);*/
1762 1.1 thorpej return(exists ? pa : -1);
1763 1.1 thorpej }
1764 1.1 thorpej
1765 1.1 thorpej
1766 1.1 thorpej static void
1767 1.1 thorpej ofw_settranslation(va, pa, size, mode)
1768 1.1 thorpej vm_offset_t va;
1769 1.1 thorpej vm_offset_t pa;
1770 1.1 thorpej vm_size_t size;
1771 1.1 thorpej int mode;
1772 1.1 thorpej {
1773 1.1 thorpej int mmu_ihandle = ofw_mmu_ihandle();
1774 1.1 thorpej
1775 1.1 thorpej /*printf("ofw_settranslation (%x, %x, %x, %x) --> void", va, pa, size, mode);*/
1776 1.1 thorpej if (OF_call_method("map", mmu_ihandle, 4, 0, pa, va, size, mode) != 0)
1777 1.1 thorpej panic("ofw_settranslation failed");
1778 1.1 thorpej }
1779 1.1 thorpej
1780 1.1 thorpej /*
1781 1.1 thorpej * Allocation routine used before the kernel takes over memory.
1782 1.1 thorpej * Use this for efficient storage for things that aren't rounded to
1783 1.1 thorpej * page size.
1784 1.1 thorpej *
1785 1.1 thorpej * The point here is not necessarily to be very efficient (even though
1786 1.1 thorpej * that's sort of nice), but to do proper dynamic allocation to avoid
1787 1.1 thorpej * size-limitation errors.
1788 1.1 thorpej *
1789 1.1 thorpej */
1790 1.1 thorpej
1791 1.1 thorpej typedef struct _leftover {
1792 1.1 thorpej struct _leftover *pNext;
1793 1.1 thorpej vm_size_t size;
1794 1.1 thorpej } LEFTOVER, *PLEFTOVER;
1795 1.1 thorpej
1796 1.1 thorpej /* leftover bits of pages. first word is pointer to next.
1797 1.1 thorpej second word is size of leftover */
1798 1.1 thorpej static PLEFTOVER leftovers = NULL;
1799 1.1 thorpej
1800 1.1 thorpej static void *
1801 1.1 thorpej ofw_malloc(size)
1802 1.1 thorpej vm_size_t size;
1803 1.1 thorpej {
1804 1.1 thorpej PLEFTOVER *ppLeftover;
1805 1.1 thorpej PLEFTOVER pLeft;
1806 1.1 thorpej pv_addr_t new;
1807 1.1 thorpej vm_size_t newSize, claim_size;
1808 1.1 thorpej
1809 1.1 thorpej /* round and set minimum size */
1810 1.1 thorpej size = max(sizeof(LEFTOVER),
1811 1.1 thorpej ((size + (sizeof(LEFTOVER) - 1)) & ~(sizeof(LEFTOVER) - 1)));
1812 1.1 thorpej
1813 1.1 thorpej for (ppLeftover = &leftovers; *ppLeftover;
1814 1.1 thorpej ppLeftover = &((*ppLeftover)->pNext))
1815 1.1 thorpej if ((*ppLeftover)->size >= size)
1816 1.1 thorpej break;
1817 1.1 thorpej
1818 1.1 thorpej if (*ppLeftover) { /* have a leftover of the right size */
1819 1.1 thorpej /* remember the leftover */
1820 1.1 thorpej new.pv_va = (vm_offset_t)*ppLeftover;
1821 1.1 thorpej if ((*ppLeftover)->size < (size + sizeof(LEFTOVER))) {
1822 1.1 thorpej /* splice out of chain */
1823 1.1 thorpej *ppLeftover = (*ppLeftover)->pNext;
1824 1.1 thorpej } else {
1825 1.1 thorpej /* remember the next pointer */
1826 1.1 thorpej pLeft = (*ppLeftover)->pNext;
1827 1.1 thorpej newSize = (*ppLeftover)->size - size; /* reduce size */
1828 1.1 thorpej /* move pointer */
1829 1.1 thorpej *ppLeftover = (PLEFTOVER)(((vm_offset_t)*ppLeftover)
1830 1.1 thorpej + size);
1831 1.1 thorpej (*ppLeftover)->pNext = pLeft;
1832 1.1 thorpej (*ppLeftover)->size = newSize;
1833 1.1 thorpej }
1834 1.1 thorpej } else {
1835 1.1 thorpej claim_size = (size + NBPG - 1) & ~(NBPG - 1);
1836 1.1 thorpej ofw_claimpages(&virt_freeptr, &new, claim_size);
1837 1.1 thorpej if ((size + sizeof(LEFTOVER)) <= claim_size) {
1838 1.1 thorpej pLeft = (PLEFTOVER)(new.pv_va + size);
1839 1.1 thorpej pLeft->pNext = leftovers;
1840 1.1 thorpej pLeft->size = claim_size - size;
1841 1.1 thorpej leftovers = pLeft;
1842 1.1 thorpej }
1843 1.1 thorpej }
1844 1.1 thorpej
1845 1.1 thorpej return (void *)(new.pv_va);
1846 1.1 thorpej }
1847 1.1 thorpej
1848 1.1 thorpej /*
1849 1.1 thorpej * Here is a really, really sleazy free. It's not used right now,
1850 1.1 thorpej * because it's not worth the extra complexity for just a few bytes.
1851 1.1 thorpej *
1852 1.1 thorpej */
1853 1.1 thorpej #if 0
1854 1.1 thorpej static void
1855 1.1 thorpej ofw_free(addr, size)
1856 1.1 thorpej vm_offset_t addr;
1857 1.1 thorpej vm_size_t size;
1858 1.1 thorpej {
1859 1.1 thorpej PLEFTOVER pLeftover = (PLEFTOVER)addr;
1860 1.1 thorpej
1861 1.1 thorpej /* splice right into list without checks or compaction */
1862 1.1 thorpej pLeftover->pNext = leftovers;
1863 1.1 thorpej pLeftover->size = size;
1864 1.1 thorpej leftovers = pLeftover;
1865 1.1 thorpej }
1866 1.1 thorpej #endif
1867 1.1 thorpej
1868 1.1 thorpej /*
1869 1.1 thorpej * Allocate and zero round(size)/NBPG pages of memory.
1870 1.1 thorpej * We guarantee that the allocated memory will be
1871 1.1 thorpej * aligned to a boundary equal to the smallest power of
1872 1.1 thorpej * 2 greater than or equal to size.
1873 1.1 thorpej * free_pp is an IN/OUT parameter which points to the
1874 1.1 thorpej * last allocated virtual address in an allocate-downwards
1875 1.1 thorpej * stack. pv_p is an OUT parameter which contains the
1876 1.1 thorpej * virtual and physical base addresses of the allocated
1877 1.1 thorpej * memory.
1878 1.1 thorpej */
1879 1.1 thorpej static void
1880 1.1 thorpej ofw_claimpages(free_pp, pv_p, size)
1881 1.1 thorpej vm_offset_t *free_pp;
1882 1.1 thorpej pv_addr_t *pv_p;
1883 1.1 thorpej vm_size_t size;
1884 1.1 thorpej {
1885 1.1 thorpej /* round-up to page boundary */
1886 1.1 thorpej vm_size_t alloc_size = (size + NBPG - 1) & ~(NBPG - 1);
1887 1.1 thorpej vm_size_t aligned_size;
1888 1.1 thorpej vm_offset_t va, pa;
1889 1.1 thorpej
1890 1.1 thorpej if (alloc_size == 0)
1891 1.1 thorpej panic("ofw_claimpages zero");
1892 1.1 thorpej
1893 1.1 thorpej for (aligned_size = 1; aligned_size < alloc_size; aligned_size <<= 1)
1894 1.1 thorpej ;
1895 1.1 thorpej
1896 1.1 thorpej /* The only way to provide the alignment guarantees is to
1897 1.1 thorpej * allocate the virtual and physical ranges separately,
1898 1.1 thorpej * then do an explicit map call.
1899 1.1 thorpej */
1900 1.1 thorpej va = (*free_pp & ~(aligned_size - 1)) - aligned_size;
1901 1.1 thorpej if (ofw_claimvirt(va, alloc_size, 0) != va)
1902 1.1 thorpej panic("ofw_claimpages va alloc");
1903 1.1 thorpej pa = ofw_claimphys(0, alloc_size, aligned_size);
1904 1.1 thorpej if (pa == -1)
1905 1.1 thorpej panic("ofw_claimpages pa alloc");
1906 1.1 thorpej /* XXX - what mode? -JJK */
1907 1.1 thorpej ofw_settranslation(va, pa, alloc_size, -1);
1908 1.1 thorpej
1909 1.1 thorpej /* The memory's mapped-in now, so we can zero it. */
1910 1.1 thorpej bzero((char *)va, alloc_size);
1911 1.1 thorpej
1912 1.1 thorpej /* Set OUT parameters. */
1913 1.1 thorpej *free_pp = va;
1914 1.1 thorpej pv_p->pv_va = va;
1915 1.1 thorpej pv_p->pv_pa = pa;
1916 1.1 thorpej }
1917 1.1 thorpej
1918 1.1 thorpej
1919 1.1 thorpej static void
1920 1.1 thorpej ofw_discardmappings(L2pagetable, va, size)
1921 1.1 thorpej vm_offset_t L2pagetable;
1922 1.1 thorpej vm_offset_t va;
1923 1.1 thorpej vm_size_t size;
1924 1.1 thorpej {
1925 1.1 thorpej /* round-up to page boundary */
1926 1.1 thorpej vm_size_t alloc_size = (size + NBPG - 1) & ~(NBPG - 1);
1927 1.1 thorpej int npages = alloc_size / NBPG;
1928 1.1 thorpej
1929 1.1 thorpej if (npages == 0)
1930 1.1 thorpej panic("ofw_discardmappings zero");
1931 1.1 thorpej
1932 1.1 thorpej /* Discard each mapping. */
1933 1.1 thorpej for (; npages > 0; va += NBPG, npages--) {
1934 1.1 thorpej /* Sanity. The current entry should be non-null. */
1935 1.1 thorpej if (ReadWord(L2pagetable + ((va >> 10) & 0x00000FFC)) == 0)
1936 1.1 thorpej panic("ofw_discardmappings zero entry");
1937 1.1 thorpej
1938 1.1 thorpej /* Clear the entry. */
1939 1.1 thorpej WriteWord(L2pagetable + ((va >> 10) & 0x00000FFC), 0);
1940 1.1 thorpej }
1941 1.1 thorpej }
1942 1.1 thorpej
1943 1.1 thorpej
1944 1.1 thorpej static void
1945 1.1 thorpej ofw_initallocator(void)
1946 1.1 thorpej {
1947 1.1 thorpej
1948 1.1 thorpej }
1949