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