diff options
Diffstat (limited to 'sys/sparc64')
-rw-r--r-- | sys/sparc64/include/ofw_machdep.h | 3 | ||||
-rw-r--r-- | sys/sparc64/sparc64/ofw_machdep.c | 110 |
2 files changed, 112 insertions, 1 deletions
diff --git a/sys/sparc64/include/ofw_machdep.h b/sys/sparc64/include/ofw_machdep.h index 64c7d56..f7062f7 100644 --- a/sys/sparc64/include/ofw_machdep.h +++ b/sys/sparc64/include/ofw_machdep.h @@ -30,7 +30,8 @@ #include <sys/bus.h> -void OF_getetheraddr(device_t dev, u_char *addr); +int OF_decode_addr(phandle_t, int *, bus_addr_t *); +void OF_getetheraddr(device_t, u_char *); void cpu_shutdown(void *); void openfirmware_exit(void *); diff --git a/sys/sparc64/sparc64/ofw_machdep.c b/sys/sparc64/sparc64/ofw_machdep.c index 9cd4c02..404eeaf 100644 --- a/sys/sparc64/sparc64/ofw_machdep.c +++ b/sys/sparc64/sparc64/ofw_machdep.c @@ -36,8 +36,15 @@ #include <dev/ofw/openfirm.h> +#include <machine/bus.h> #include <machine/idprom.h> #include <machine/ofw_machdep.h> +#include <machine/ofw_upa.h> +#include <machine/resource.h> + +#include <sparc64/pci/ofw_pci.h> +#include <sparc64/isa/ofw_isa.h> +#include <sparc64/sbus/ofw_sbus.h> void OF_getetheraddr(device_t dev, u_char *addr) @@ -50,3 +57,106 @@ OF_getetheraddr(device_t dev, u_char *addr) panic("Could not determine the machine ethernet address"); bcopy(&idp.id_ether, addr, ETHER_ADDR_LEN); } + +int +OF_decode_addr(phandle_t node, int *space, bus_addr_t *addr) +{ + char name[32]; + union { + struct isa_ranges isa[4]; + struct sbus_ranges sbus[8]; + struct upa_ranges upa[4]; + } range; + union { + struct isa_regs isa; + struct sbus_regs sbus; + } reg; + phandle_t bus, pbus; + u_long child, dummy, phys; + int cs, i, rsz, type; + + bus = OF_parent(node); + if (bus == NULL) + return (ENXIO); + if (OF_getprop(bus, "name", name, sizeof(name)) == -1) + return (ENXIO); + name[sizeof(name) - 1] = '\0'; + if (strcmp(name, "ebus") == 0) { + if (OF_getprop(node, "reg", ®.isa, sizeof(reg.isa)) == -1) + return (ENXIO); + rsz = OF_getprop(bus, "ranges", range.isa, sizeof(range.isa)); + if (rsz == -1) + return (ENXIO); + phys = ISA_REG_PHYS(®.isa); + dummy = phys + 1; + type = ofw_isa_map_iorange(range.isa, rsz / sizeof(*range.isa), + &phys, &dummy); + if (type == SYS_RES_MEMORY) { + cs = PCI_CS_MEM32; + *space = PCI_MEMORY_BUS_SPACE; + } else { + cs = PCI_CS_IO; + *space = PCI_IO_BUS_SPACE; + } + + /* Find the topmost PCI node (the host bridge) */ + while (1) { + pbus = OF_parent(bus); + if (pbus == NULL) + return (ENXIO); + if (OF_getprop(pbus, "name", name, sizeof(name)) == -1) + return (ENXIO); + name[sizeof(name) - 1] = '\0'; + if (strcmp(name, "pci") != 0) + break; + bus = pbus; + } + + /* There wasn't a PCI bridge. */ + if (bus == OF_parent(node)) + return (ENXIO); + + /* Make sure we reached the UPA/PCI node. */ + if (OF_getprop(pbus, "device_type", name, sizeof(name)) == -1) + return (ENXIO); + name[sizeof(name) - 1] = '\0'; + if (strcmp(name, "upa") != 0) + return (ENXIO); + + rsz = OF_getprop(bus, "ranges", range.upa, sizeof(range.upa)); + if (rsz == -1) + return (ENXIO); + for (i = 0; i < (rsz / sizeof(range.upa[0])); i++) { + child = UPA_RANGE_CHILD(&range.upa[i]); + if (UPA_RANGE_CS(&range.upa[i]) == cs && + phys >= child && + phys - child < UPA_RANGE_SIZE(&range.upa[i])) { + *addr = UPA_RANGE_PHYS(&range.upa[i]) + phys; + return (0); + } + } + } else if (strcmp(name, "sbus") == 0) { + if (OF_getprop(node, "reg", ®.sbus, sizeof(reg.sbus)) == -1) + return (ENXIO); + rsz = OF_getprop(bus, "ranges", range.sbus, + sizeof(range.sbus)); + if (rsz == -1) + return (ENXIO); + for (i = 0; i < (rsz / sizeof(range.sbus[0])); i++) { + if (reg.sbus.sbr_slot != range.sbus[i].cspace) + continue; + if (reg.sbus.sbr_offset < range.sbus[i].coffset || + reg.sbus.sbr_offset >= range.sbus[i].coffset + + range.sbus[i].size) + continue; + /* Found it... */ + phys = range.sbus[i].poffset | + ((bus_addr_t)range.sbus[i].pspace << 32); + phys += reg.sbus.sbr_offset - range.sbus[i].coffset; + *addr = phys; + *space = SBUS_BUS_SPACE; + return (0); + } + } + return (ENXIO); +} |