1 /* $NetBSD: upa.c,v 1.22 2021/05/10 23:53:44 thorpej Exp $ */ 2 /* $OpenBSD: upa.c,v 1.8 2008/01/17 22:53:18 kettenis Exp $ */ 3 4 /* 5 * Copyright (c) 2002 Jason L. Wright (jason@thought.net) 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 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 * 17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 19 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 20 * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, 21 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 22 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 23 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 25 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 26 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 27 * POSSIBILITY OF SUCH DAMAGE. 28 * 29 * Effort sponsored in part by the Defense Advanced Research Projects 30 * Agency (DARPA) and Air Force Research Laboratory, Air Force 31 * Materiel Command, USAF, under agreement number F30602-01-2-0537. 32 */ 33 34 #include <sys/cdefs.h> 35 __KERNEL_RCSID(0, "$NetBSD: upa.c,v 1.22 2021/05/10 23:53:44 thorpej Exp $"); 36 37 #include <sys/types.h> 38 #include <sys/param.h> 39 #include <sys/systm.h> 40 #include <sys/kernel.h> 41 #include <sys/device.h> 42 #include <sys/conf.h> 43 #include <sys/kmem.h> 44 45 #include <sys/bus.h> 46 #include <machine/autoconf.h> 47 #include <machine/openfirm.h> 48 49 struct upa_range { 50 u_int64_t ur_space; 51 u_int64_t ur_addr; 52 u_int64_t ur_len; 53 }; 54 55 struct upa_softc { 56 device_t sc_dev; 57 bus_space_tag_t sc_bt; 58 bus_space_handle_t sc_reg[3]; 59 struct upa_range *sc_range; 60 int sc_node; 61 int sc_nrange; 62 bus_space_tag_t sc_cbt; 63 }; 64 65 int upa_match(device_t, cfdata_t, void *); 66 void upa_attach(device_t, device_t, void *); 67 68 CFATTACH_DECL_NEW(upa, sizeof(struct upa_softc), 69 upa_match, upa_attach, NULL, NULL); 70 71 int upa_print(void *, const char *); 72 bus_space_tag_t upa_alloc_bus_tag(struct upa_softc *); 73 int upa_bus_map(bus_space_tag_t, bus_addr_t, 74 bus_size_t, int, vaddr_t, bus_space_handle_t *); 75 paddr_t upa_bus_mmap(bus_space_tag_t, bus_addr_t, off_t, int, int); 76 77 int 78 upa_match(device_t parent, cfdata_t match, void *aux) 79 { 80 struct mainbus_attach_args *ma = aux; 81 82 if (strcmp(ma->ma_name, "upa") == 0) 83 return (1); 84 85 return (0); 86 } 87 88 void 89 upa_attach(device_t parent, device_t self, void *aux) 90 { 91 struct upa_softc *sc = device_private(self); 92 struct mainbus_attach_args *ma = aux; 93 int i, node; 94 95 sc->sc_dev = self; 96 sc->sc_bt = ma->ma_bustag; 97 sc->sc_node = ma->ma_node; 98 99 for (i = 0; i < 3; i++) { 100 if (i >= ma->ma_nreg) { 101 printf(": no register %d\n", i); 102 return; 103 } 104 if (bus_space_map(sc->sc_bt, ma->ma_reg[i].ur_paddr, 105 ma->ma_reg[i].ur_len, 0, &sc->sc_reg[i])) { 106 printf(": failed to map reg%d\n", i); 107 return; 108 } 109 } 110 111 if (prom_getprop(sc->sc_node, "ranges", sizeof(struct upa_range), 112 &sc->sc_nrange, (void **)&sc->sc_range)) 113 panic("upa: can't get ranges"); 114 115 printf("\n"); 116 117 sc->sc_cbt = upa_alloc_bus_tag(sc); 118 119 for (node = OF_child(sc->sc_node); node; node = OF_peer(node)) { 120 char buf[32]; 121 struct mainbus_attach_args map; 122 123 bzero(&map, sizeof(map)); 124 if (OF_getprop(node, "device_type", buf, sizeof(buf)) <= 0) 125 continue; 126 if (prom_getprop(node, "reg", sizeof(*map.ma_reg), 127 &map.ma_nreg, (void **)&map.ma_reg) != 0) 128 continue; 129 if (OF_getprop(node, "name", buf, sizeof(buf)) <= 0) 130 continue; 131 map.ma_node = node; 132 map.ma_name = buf; 133 map.ma_bustag = sc->sc_cbt; 134 map.ma_dmatag = ma->ma_dmatag; 135 config_found(sc->sc_dev, &map, upa_print, 136 CFARG_DEVHANDLE, prom_node_to_devhandle(node), 137 CFARG_EOL); 138 } 139 } 140 141 int 142 upa_print(void *args, const char *name) 143 { 144 struct mainbus_attach_args *ma = args; 145 146 if (name) 147 printf("\"%s\" at %s", ma->ma_name, name); 148 return (UNCONF); 149 } 150 151 bus_space_tag_t 152 upa_alloc_bus_tag(struct upa_softc *sc) 153 { 154 struct sparc_bus_space_tag *bt; 155 156 bt = kmem_zalloc(sizeof(*bt), KM_SLEEP); 157 *bt = *sc->sc_bt; 158 bt->cookie = sc; 159 bt->parent = sc->sc_bt; 160 bt->sparc_bus_map = upa_bus_map; 161 bt->sparc_bus_mmap = upa_bus_mmap; 162 163 return bt; 164 } 165 166 int 167 upa_bus_map(bus_space_tag_t t, bus_addr_t offset, 168 bus_size_t size, int flags, vaddr_t v, bus_space_handle_t *hp) 169 { 170 struct upa_softc *sc = t->cookie; 171 int i; 172 173 if (t->parent == 0 || t->parent->sparc_bus_map == 0) { 174 printf("\n__upa_bus_map: invalid parent"); 175 return (EINVAL); 176 } 177 178 t = t->parent; 179 180 for (i = 0; i < sc->sc_nrange; i++) { 181 if (offset < sc->sc_range[i].ur_space) 182 continue; 183 if (offset >= (sc->sc_range[i].ur_space + 184 sc->sc_range[i].ur_space)) 185 continue; 186 break; 187 } 188 if (i == sc->sc_nrange) 189 return (EINVAL); 190 191 offset -= sc->sc_range[i].ur_space; 192 offset += sc->sc_range[i].ur_addr; 193 194 return ((*t->sparc_bus_map)(t, offset, size, flags, v, hp)); 195 } 196 197 paddr_t 198 upa_bus_mmap(bus_space_tag_t t, bus_addr_t paddr, off_t off, int prot, 199 int flags) 200 { 201 struct upa_softc *sc = t->cookie; 202 int i; 203 204 if (t->parent == 0 || t->parent->sparc_bus_map == 0) { 205 printf("\n__upa_bus_map: invalid parent"); 206 return (EINVAL); 207 } 208 209 t = t->parent; 210 211 for (i = 0; i < sc->sc_nrange; i++) { 212 if (paddr + off < sc->sc_range[i].ur_space) 213 continue; 214 if (paddr + off >= (sc->sc_range[i].ur_space + 215 sc->sc_range[i].ur_space)) 216 continue; 217 break; 218 } 219 if (i == sc->sc_nrange) 220 return (EINVAL); 221 222 paddr -= sc->sc_range[i].ur_space; 223 paddr += sc->sc_range[i].ur_addr; 224 225 return ((*t->sparc_bus_mmap)(t, paddr, off, prot, flags)); 226 } 227