2 * SPDX-License-Identifier: BSD-4-Clause
4 * Copyright (C) 1996 Wolfgang Solfrank.
5 * Copyright (C) 1996 TooLs GmbH.
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. All advertising materials mentioning features or use of this software
17 * must display the following acknowledgement:
18 * This product includes software developed by TooLs GmbH.
19 * 4. The name of TooLs GmbH may not be used to endorse or promote products
20 * derived from this software without specific prior written permission.
22 * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
23 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
24 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
25 * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
26 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
27 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
28 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
29 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
30 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
31 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 * $NetBSD: ofw_machdep.c,v 1.5 2000/05/23 13:25:43 tsubai Exp $
36 #include <sys/cdefs.h>
37 __FBSDID("$FreeBSD$");
39 #include "opt_platform.h"
40 #include <sys/param.h>
42 #include <sys/systm.h>
45 #include <sys/fcntl.h>
46 #include <sys/malloc.h>
49 #include <sys/endian.h>
51 #include <net/ethernet.h>
53 #include <dev/fdt/fdt_common.h>
54 #include <dev/ofw/openfirm.h>
55 #include <dev/ofw/ofw_pci.h>
56 #include <dev/ofw/ofw_bus.h>
57 #include <dev/ofw/ofw_subr.h>
60 #include <vm/vm_param.h>
61 #include <vm/vm_page.h>
63 #include <machine/bus.h>
64 #include <machine/cpu.h>
65 #include <machine/md_var.h>
66 #include <machine/platform.h>
67 #include <machine/ofw_machdep.h>
68 #include <machine/trap.h>
70 #include <contrib/libfdt/libfdt.h>
76 extern register_t ofmsr[5];
77 extern void *openfirmware_entry;
78 char save_trap_init[0x2f00]; /* EXC_LAST */
79 char save_trap_of[0x2f00]; /* EXC_LAST */
82 static int openfirmware(void *args);
85 ofw_save_trap_vec(char *save_trap_vec)
87 if (!ofw_real_mode || !hw_direct_map)
90 bcopy((void *)PHYS_TO_DMAP(EXC_RST), save_trap_vec, EXC_LAST - EXC_RST);
94 ofw_restore_trap_vec(char *restore_trap_vec)
96 if (!ofw_real_mode || !hw_direct_map)
99 bcopy(restore_trap_vec, (void *)PHYS_TO_DMAP(EXC_RST),
101 __syncicache((void *)PHYS_TO_DMAP(EXC_RSVD), EXC_LAST - EXC_RSVD);
105 * Saved SPRG0-3 from OpenFirmware. Will be restored prior to the callback.
107 register_t ofw_sprg0_save;
110 ofw_sprg_prepare(void)
116 * Assume that interrupt are disabled at this point, or
117 * SPRG1-3 could be trashed
120 __asm __volatile("mtsprg1 %0\n\t"
128 __asm __volatile("mfsprg0 %0\n\t"
133 : "=&r"(ofw_sprg0_save)
142 ofw_sprg_restore(void)
148 * Note that SPRG1-3 contents are irrelevant. They are scratch
149 * registers used in the early portion of trap handling when
150 * interrupts are disabled.
152 * PCPU data cannot be used until this routine is called !
154 #ifndef __powerpc64__
155 __asm __volatile("mtsprg0 %0" :: "r"(ofw_sprg0_save));
161 parse_ofw_memory(phandle_t node, const char *prop, struct mem_region *output)
163 cell_t address_cells, size_cells;
164 cell_t OFmem[4 * PHYS_AVAIL_SZ];
171 * Get #address-cells from root node, defaulting to 1 if it cannot
174 phandle = OF_finddevice("/");
175 if (OF_getencprop(phandle, "#address-cells", &address_cells,
176 sizeof(address_cells)) < (ssize_t)sizeof(address_cells))
178 if (OF_getencprop(phandle, "#size-cells", &size_cells,
179 sizeof(size_cells)) < (ssize_t)sizeof(size_cells))
185 if (node == -1 || (sz = OF_getencprop(node, prop,
186 OFmem, sizeof(OFmem))) <= 0)
187 panic("Physical memory map not found");
191 while (i < sz/sizeof(cell_t)) {
192 output[j].mr_start = OFmem[i++];
193 if (address_cells == 2) {
194 output[j].mr_start <<= 32;
195 output[j].mr_start += OFmem[i++];
198 output[j].mr_size = OFmem[i++];
199 if (size_cells == 2) {
200 output[j].mr_size <<= 32;
201 output[j].mr_size += OFmem[i++];
204 if (output[j].mr_start > BUS_SPACE_MAXADDR)
208 * Constrain memory to that which we can access.
209 * 32-bit AIM can only reference 32 bits of address currently,
210 * but Book-E can access 36 bits.
212 if (((uint64_t)output[j].mr_start +
213 (uint64_t)output[j].mr_size - 1) >
215 output[j].mr_size = BUS_SPACE_MAXADDR -
216 output[j].mr_start + 1;
221 sz = j*sizeof(output[0]);
228 excise_fdt_reserved(struct mem_region *avail, int asz)
238 chosen = OF_finddevice("/chosen");
239 fdtmapsize = OF_getprop(chosen, "fdtmemreserv", fdtmap, sizeof(fdtmap));
241 for (j = 0; j < fdtmapsize/sizeof(fdtmap[0]); j++) {
242 fdtmap[j].address = be64toh(fdtmap[j].address) & ~PAGE_MASK;
243 fdtmap[j].size = round_page(be64toh(fdtmap[j].size));
246 KASSERT(j*sizeof(fdtmap[0]) < sizeof(fdtmap),
247 ("Exceeded number of FDT reservations"));
248 /* Add a virtual entry for the FDT itself */
250 fdtmap[j].address = (vm_offset_t)fdt & ~PAGE_MASK;
251 fdtmap[j].size = round_page(fdt_totalsize(fdt));
252 fdtmapsize += sizeof(fdtmap[0]);
255 for (i = 0; i < asz; i++) {
256 for (j = 0; j < fdtmapsize/sizeof(fdtmap[0]); j++) {
258 * Case 1: Exclusion region encloses complete
259 * available entry. Drop it and move on.
261 if (fdtmap[j].address <= avail[i].mr_start &&
262 fdtmap[j].address + fdtmap[j].size >=
263 avail[i].mr_start + avail[i].mr_size) {
264 for (k = i+1; k < asz; k++)
265 avail[k-1] = avail[k];
267 i--; /* Repeat some entries */
272 * Case 2: Exclusion region starts in available entry.
273 * Trim it to where the entry begins and append
274 * a new available entry with the region after
275 * the excluded region, if any.
277 if (fdtmap[j].address >= avail[i].mr_start &&
278 fdtmap[j].address < avail[i].mr_start +
280 if (fdtmap[j].address + fdtmap[j].size <
281 avail[i].mr_start + avail[i].mr_size) {
282 avail[asz].mr_start =
283 fdtmap[j].address + fdtmap[j].size;
284 avail[asz].mr_size = avail[i].mr_start +
290 avail[i].mr_size = fdtmap[j].address -
295 * Case 3: Exclusion region ends in available entry.
296 * Move start point to where the exclusion zone ends.
297 * The case of a contained exclusion zone has already
298 * been caught in case 2.
300 if (fdtmap[j].address + fdtmap[j].size >=
301 avail[i].mr_start && fdtmap[j].address +
302 fdtmap[j].size < avail[i].mr_start +
304 avail[i].mr_size += avail[i].mr_start;
306 fdtmap[j].address + fdtmap[j].size;
307 avail[i].mr_size -= avail[i].mr_start;
317 * This is called during powerpc_init, before the system is really initialized.
318 * It shall provide the total and the available regions of RAM.
319 * The available regions need not take the kernel into account.
322 ofw_mem_regions(struct mem_region *memp, int *memsz,
323 struct mem_region *availp, int *availsz)
333 * Get memory from all the /memory nodes.
335 for (phandle = OF_child(OF_peer(0)); phandle != 0;
336 phandle = OF_peer(phandle)) {
337 if (OF_getprop(phandle, "name", name, sizeof(name)) <= 0)
339 if (strncmp(name, "memory", sizeof(name)) != 0 &&
340 strncmp(name, "memory@", strlen("memory@")) != 0)
343 res = parse_ofw_memory(phandle, "reg", &memp[msz]);
344 msz += res/sizeof(struct mem_region);
345 if (OF_getproplen(phandle, "available") >= 0)
346 res = parse_ofw_memory(phandle, "available",
349 res = parse_ofw_memory(phandle, "reg", &availp[asz]);
350 asz += res/sizeof(struct mem_region);
354 phandle = OF_finddevice("/chosen");
355 if (OF_hasprop(phandle, "fdtmemreserv"))
356 asz = excise_fdt_reserved(availp, asz);
364 OF_initial_setup(void *fdt_ptr, void *junk, int (*openfirm)(void *))
371 __asm __volatile("mfsprg0 %0" : "=&r"(ofmsr[1]));
373 __asm __volatile("mfsprg1 %0" : "=&r"(ofmsr[2]));
374 __asm __volatile("mfsprg2 %0" : "=&r"(ofmsr[3]));
375 __asm __volatile("mfsprg3 %0" : "=&r"(ofmsr[4]));
376 openfirmware_entry = openfirm;
378 if (ofmsr[0] & PSL_DR)
383 ofw_save_trap_vec(save_trap_init);
394 boolean_t status = FALSE;
398 if (openfirmware_entry != NULL) {
400 status = OF_install(OFW_STD_REAL, 0);
403 status = OF_install(OFW_STD_32BIT, 0);
405 status = OF_install(OFW_STD_DIRECT, 0);
412 err = OF_init(openfirmware);
418 bus_space_tag_t fdt_bt;
419 vm_offset_t tmp_fdt_ptr;
424 status = OF_install(OFW_FDT, 0);
428 #ifdef AIM /* AIM-only for now -- Book-E does this remapping in early init */
429 /* Get the FDT size for mapping if we can */
430 tmp_fdt_ptr = pmap_early_io_map((vm_paddr_t)fdt, PAGE_SIZE);
431 if (fdt_check_header((void *)tmp_fdt_ptr) != 0) {
432 pmap_early_io_unmap(tmp_fdt_ptr, PAGE_SIZE);
435 fdt_size = fdt_totalsize((void *)tmp_fdt_ptr);
436 pmap_early_io_unmap(tmp_fdt_ptr, PAGE_SIZE);
439 * Map this for real. Use bus_space_map() to take advantage
440 * of its auto-remapping function once the kernel is loaded.
441 * This is a dirty hack, but what we have.
443 #ifdef _LITTLE_ENDIAN
448 bus_space_map(fdt_bt, (vm_paddr_t)fdt, fdt_size, 0, &fdt_va);
450 err = OF_init((void *)fdt_va);
457 #ifdef FDT_DTB_STATIC
459 * Check for a statically included blob already in the kernel and
460 * needing no mapping.
463 status = OF_install(OFW_FDT, 0);
466 err = OF_init(&fdt_static_dtb);
488 KASSERT(!pmap_bootstrapped, ("Cannot call ofw_quiesce after VM is up"));
490 args.name = (cell_t)(uintptr_t)"quiesce";
497 openfirmware_core(void *args)
502 if (openfirmware_entry == NULL)
506 * Turn off exceptions - we really don't want to end up
507 * anywhere unexpected with PCPU set to something strange
508 * or the stack pointer wrong.
510 oldmsr = intr_disable();
514 /* Save trap vectors */
515 ofw_save_trap_vec(save_trap_of);
517 /* Restore initially saved trap vectors */
518 ofw_restore_trap_vec(save_trap_init);
520 #ifndef __powerpc64__
522 * Clear battable[] translations
524 if (!(cpu_features & PPC_FEATURE_64))
525 __asm __volatile("mtdbatu 2, %0\n"
526 "mtdbatu 3, %0" : : "r" (0));
530 result = ofwcall(args);
532 /* Restore trap vecotrs */
533 ofw_restore_trap_vec(save_trap_of);
537 intr_restore(oldmsr);
546 volatile int in_progress;
550 ofw_rendezvous_dispatch(void *xargs)
552 struct ofw_rv_args *rv_args = xargs;
554 /* NOTE: Interrupts are disabled here */
556 if (PCPU_GET(cpuid) == 0) {
558 * Execute all OF calls on CPU 0
560 rv_args->retval = openfirmware_core(rv_args->args);
561 rv_args->in_progress = 0;
564 * Spin with interrupts off on other CPUs while OF has
565 * control of the machine.
567 while (rv_args->in_progress)
574 openfirmware(void *args)
578 struct ofw_rv_args rv_args;
581 if (openfirmware_entry == NULL)
586 result = openfirmware_core(args);
589 rv_args.in_progress = 1;
590 smp_rendezvous(smp_no_rendezvous_barrier,
591 ofw_rendezvous_dispatch, smp_no_rendezvous_barrier,
593 result = rv_args.retval;
596 result = openfirmware_core(args);
612 args.name = (cell_t)(uintptr_t)"interpret";
615 args.arg = (cell_t)(uintptr_t)"reset-all";
616 openfirmware_core(&args); /* Don't do rendezvous! */
618 for (;;); /* just in case */
624 OF_getetheraddr(device_t dev, u_char *addr)
628 node = ofw_bus_get_node(dev);
629 OF_getprop(node, "local-mac-address", addr, ETHER_ADDR_LEN);
633 * Return a bus handle and bus tag that corresponds to the register
634 * numbered regno for the device referenced by the package handle
635 * dev. This function is intended to be used by console drivers in
636 * early boot only. It works by mapping the address of the device's
637 * register in the address space of its parent and recursively walk
638 * the device tree upward this way.
641 OF_decode_addr(phandle_t dev, int regno, bus_space_tag_t *tag,
642 bus_space_handle_t *handle, bus_size_t *sz)
649 res = ofw_reg_to_paddr(dev, regno, &addr, &size, &pci_hi);
653 if (pci_hi == OFW_PADDR_NOT_PCI) {
658 flags = (pci_hi & OFW_PCI_PHYS_HI_PREFETCHABLE) ?
659 BUS_SPACE_MAP_PREFETCHABLE: 0;
665 return (bus_space_map(*tag, addr, size, flags, handle));