upa.c revision 178443
1166060Smarius/*- 2166060Smarius * Copyright (c) 2006 Marius Strobl <marius@FreeBSD.org> 3166060Smarius * All rights reserved. 4166060Smarius * 5166060Smarius * Redistribution and use in source and binary forms, with or without 6166060Smarius * modification, are permitted provided that the following conditions 7166060Smarius * are met: 8166060Smarius * 1. Redistributions of source code must retain the above copyright 9166060Smarius * notice, this list of conditions and the following disclaimer. 10166060Smarius * 2. Redistributions in binary form must reproduce the above copyright 11166060Smarius * notice, this list of conditions and the following disclaimer in the 12166060Smarius * documentation and/or other materials provided with the distribution. 13166060Smarius * 14166060Smarius * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15166060Smarius * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16166060Smarius * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17166060Smarius * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18166060Smarius * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19166060Smarius * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20166060Smarius * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21166060Smarius * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22166060Smarius * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23166060Smarius * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24166060Smarius * SUCH DAMAGE. 25166060Smarius */ 26166060Smarius 27166060Smarius#include <sys/cdefs.h> 28166060Smarius__FBSDID("$FreeBSD: head/sys/sparc64/sparc64/upa.c 178443 2008-04-23 20:04:38Z marius $"); 29166060Smarius 30166060Smarius#include <sys/param.h> 31166060Smarius#include <sys/systm.h> 32166060Smarius#include <sys/bus.h> 33166060Smarius#include <sys/kernel.h> 34166060Smarius#include <sys/module.h> 35166060Smarius#include <sys/pcpu.h> 36166060Smarius#include <sys/resource.h> 37166060Smarius#include <sys/rman.h> 38166060Smarius 39166060Smarius#include <dev/ofw/ofw_bus.h> 40166060Smarius#include <dev/ofw/ofw_bus_subr.h> 41166060Smarius#include <dev/ofw/openfirm.h> 42166060Smarius 43166060Smarius#include <machine/bus.h> 44166060Smarius#include <machine/bus_common.h> 45166060Smarius#include <machine/resource.h> 46166060Smarius 47166060Smarius#define UPA_NREG 3 48166060Smarius 49166060Smarius#define UPA_CFG 0 50166060Smarius#define UPA_IMR1 1 51166060Smarius#define UPA_IMR2 2 52166060Smarius 53166060Smarius/* UPA_CFG bank */ 54166060Smarius#define UPA_CFG_UPA0 0x00 /* UPA0 config register */ 55166060Smarius#define UPA_CFG_UPA1 0x08 /* UPA1 config register */ 56166060Smarius#define UPA_CFG_IF 0x10 /* interface config register */ 57166060Smarius#define UPA_CFG_IF_RST 0x00 58166060Smarius#define UPA_CFG_IF_POK_RST 0x02 59166060Smarius#define UPA_CFG_IF_POK 0x03 60166060Smarius#define UPA_CFG_ESTAR 0x18 /* Estar config register */ 61166060Smarius#define UPA_CFG_ESTAR_SPEED_FULL 0x01 62166060Smarius#define UPA_CFG_ESTAR_SPEED_1_2 0x02 63166060Smarius#define UPA_CFG_ESTAR_SPEED_1_64 0x40 64166060Smarius 65166060Smarius#define UPA_INO_BASE 0x2a 66172066Smarius#define UPA_INO_MAX 0x2b 67166060Smarius 68166060Smariusstruct upa_regs { 69166060Smarius uint64_t phys; 70166060Smarius uint64_t size; 71166060Smarius}; 72166060Smarius 73166060Smariusstruct upa_ranges { 74166060Smarius uint64_t child; 75166060Smarius uint64_t parent; 76166060Smarius uint64_t size; 77166060Smarius}; 78166060Smarius 79166060Smariusstruct upa_devinfo { 80166060Smarius struct ofw_bus_devinfo udi_obdinfo; 81166060Smarius struct resource_list udi_rl; 82166060Smarius}; 83166060Smarius 84166060Smariusstruct upa_softc { 85166060Smarius struct resource *sc_res[UPA_NREG]; 86166060Smarius bus_space_tag_t sc_bt[UPA_NREG]; 87166060Smarius bus_space_handle_t sc_bh[UPA_NREG]; 88166060Smarius 89166060Smarius uint32_t sc_ign; 90166060Smarius 91166060Smarius int sc_nrange; 92166060Smarius struct upa_ranges *sc_ranges; 93166060Smarius}; 94166060Smarius 95166060Smarius#define UPA_READ(sc, reg, off) \ 96166060Smarius bus_space_read_8((sc)->sc_bt[(reg)], (sc)->sc_bh[(reg)], (off)) 97166060Smarius#define UPA_WRITE(sc, reg, off, val) \ 98166060Smarius bus_space_write_8((sc)->sc_bt[(reg)], (sc)->sc_bh[(reg)], (off), (val)) 99166060Smarius 100166060Smariusstatic device_probe_t upa_probe; 101166060Smariusstatic device_attach_t upa_attach; 102166060Smariusstatic bus_alloc_resource_t upa_alloc_resource; 103166060Smariusstatic bus_setup_intr_t upa_setup_intr; 104166060Smariusstatic bus_print_child_t upa_print_child; 105166060Smariusstatic bus_probe_nomatch_t upa_probe_nomatch; 106166060Smariusstatic bus_get_resource_list_t upa_get_resource_list; 107166060Smariusstatic ofw_bus_get_devinfo_t upa_get_devinfo; 108166060Smarius 109172066Smariusstatic void upa_intr_enable(void *); 110172066Smariusstatic void upa_intr_disable(void *); 111178443Smariusstatic void upa_intr_assign(void *); 112166060Smariusstatic struct upa_devinfo *upa_setup_dinfo(device_t, struct upa_softc *, 113166060Smarius phandle_t, uint32_t); 114166060Smariusstatic void upa_destroy_dinfo(struct upa_devinfo *); 115166060Smariusstatic int upa_print_res(struct upa_devinfo *); 116166060Smarius 117166060Smariusstatic device_method_t upa_methods[] = { 118166060Smarius /* Device interface */ 119166060Smarius DEVMETHOD(device_probe, upa_probe), 120166060Smarius DEVMETHOD(device_attach, upa_attach), 121166060Smarius DEVMETHOD(device_shutdown, bus_generic_shutdown), 122166060Smarius DEVMETHOD(device_suspend, bus_generic_suspend), 123166060Smarius DEVMETHOD(device_resume, bus_generic_resume), 124166060Smarius 125166060Smarius /* Bus interface */ 126166060Smarius DEVMETHOD(bus_print_child, upa_print_child), 127166060Smarius DEVMETHOD(bus_probe_nomatch, upa_probe_nomatch), 128166060Smarius DEVMETHOD(bus_read_ivar, bus_generic_read_ivar), 129166060Smarius DEVMETHOD(bus_write_ivar, bus_generic_write_ivar), 130166060Smarius DEVMETHOD(bus_alloc_resource, upa_alloc_resource), 131166060Smarius DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 132166060Smarius DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 133166060Smarius DEVMETHOD(bus_release_resource, bus_generic_rl_release_resource), 134166060Smarius DEVMETHOD(bus_setup_intr, upa_setup_intr), 135166060Smarius DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr), 136166060Smarius DEVMETHOD(bus_get_resource, bus_generic_rl_get_resource), 137166060Smarius DEVMETHOD(bus_get_resource_list, upa_get_resource_list), 138166060Smarius 139166060Smarius /* ofw_bus interface */ 140166060Smarius DEVMETHOD(ofw_bus_get_devinfo, upa_get_devinfo), 141166060Smarius DEVMETHOD(ofw_bus_get_compat, ofw_bus_gen_get_compat), 142166060Smarius DEVMETHOD(ofw_bus_get_model, ofw_bus_gen_get_model), 143166060Smarius DEVMETHOD(ofw_bus_get_name, ofw_bus_gen_get_name), 144166060Smarius DEVMETHOD(ofw_bus_get_node, ofw_bus_gen_get_node), 145166060Smarius DEVMETHOD(ofw_bus_get_type, ofw_bus_gen_get_type), 146166060Smarius 147166060Smarius { NULL, NULL } 148166060Smarius}; 149166060Smarius 150166060Smariusstatic devclass_t upa_devclass; 151166060Smarius 152166060SmariusDEFINE_CLASS_0(upa, upa_driver, upa_methods, sizeof(struct upa_softc)); 153166060SmariusDRIVER_MODULE(upa, nexus, upa_driver, upa_devclass, 0, 0); 154166060Smarius 155172066Smariusstatic const struct intr_controller upa_ic = { 156172066Smarius upa_intr_enable, 157172066Smarius upa_intr_disable, 158178443Smarius upa_intr_assign, 159172066Smarius /* The interrupts are pulse type and thus automatically cleared. */ 160172066Smarius NULL 161172066Smarius}; 162172066Smarius 163172066Smariusstruct upa_icarg { 164172066Smarius struct upa_softc *uica_sc; 165172066Smarius u_int uica_imr; 166172066Smarius}; 167172066Smarius 168166060Smariusstatic int 169166060Smariusupa_probe(device_t dev) 170166060Smarius{ 171166060Smarius const char* compat; 172166060Smarius 173166060Smarius compat = ofw_bus_get_compat(dev); 174166060Smarius if (compat != NULL && strcmp(ofw_bus_get_name(dev), "upa") == 0 && 175166060Smarius strcmp(compat, "upa64s") == 0) { 176166060Smarius device_set_desc(dev, "UPA bridge"); 177166060Smarius return (BUS_PROBE_DEFAULT); 178166060Smarius } 179166060Smarius return (ENXIO); 180166060Smarius} 181166060Smarius 182166060Smariusstatic int 183166060Smariusupa_attach(device_t dev) 184166060Smarius{ 185166060Smarius struct upa_devinfo *udi; 186172066Smarius struct upa_icarg *uica; 187166060Smarius struct upa_softc *sc; 188166060Smarius phandle_t child, node; 189166060Smarius device_t cdev; 190166060Smarius uint32_t portid; 191172066Smarius int i, imr, j, rid; 192166060Smarius#if 1 193169175Smarius device_t *children, schizo; 194169175Smarius u_long scount, sstart, ucount, ustart; 195172066Smarius int nchildren; 196166060Smarius#endif 197166060Smarius 198166060Smarius sc = device_get_softc(dev); 199166060Smarius node = ofw_bus_get_node(dev); 200166060Smarius for (i = UPA_CFG; i <= UPA_IMR2; i++) { 201166060Smarius rid = i; 202169175Smarius /* 203169175Smarius * The UPA_IMR{1,2} resources are shared with that of the 204169175Smarius * Schizo PCI bus B CSR bank. 205169175Smarius */ 206166060Smarius#if 0 207166060Smarius sc->sc_res[i] = bus_alloc_resource_any(dev, SYS_RES_MEMORY, 208169175Smarius &rid, ((i == UPA_IMR1 || i == UPA_IMR2) ? RF_SHAREABLE : 209169175Smarius 0) | RF_ACTIVE); 210166060Smarius if (sc->sc_res[i] == NULL) { 211166060Smarius device_printf(dev, 212166060Smarius "could not allocate resource %d\n", i); 213166060Smarius goto fail; 214166060Smarius } 215166060Smarius sc->sc_bt[i] = rman_get_bustag(sc->sc_res[i]); 216166060Smarius sc->sc_bh[i] = rman_get_bushandle(sc->sc_res[i]); 217166060Smarius#else 218166060Smarius /* 219166060Smarius * Workaround for the fact that rman(9) only allows to 220166060Smarius * share resources of the same size. 221166060Smarius */ 222169175Smarius if (i == UPA_IMR1 || i == UPA_IMR2) { 223169175Smarius if (bus_get_resource(dev, SYS_RES_MEMORY, i, &ustart, 224169175Smarius &ucount) != 0) { 225169175Smarius device_printf(dev, 226169175Smarius "could not determine UPA resource\n"); 227169175Smarius goto fail; 228169175Smarius } 229166060Smarius if (device_get_children(device_get_parent(dev), 230166060Smarius &children, &nchildren) != 0) { 231166060Smarius device_printf(dev, "could not get children\n"); 232166060Smarius goto fail; 233166060Smarius } 234169175Smarius schizo = NULL; 235166060Smarius for (j = 0; j < nchildren; j++) { 236169175Smarius if (ofw_bus_get_type(children[j]) != NULL && 237169175Smarius strcmp(ofw_bus_get_type(children[j]), 238166060Smarius "pci") == 0 && 239169175Smarius ofw_bus_get_compat(children[j]) != NULL && 240169175Smarius strcmp(ofw_bus_get_compat(children[j]), 241166060Smarius "pci108e,8001") == 0 && 242169175Smarius ((bus_get_resource_start(children[j], 243166060Smarius SYS_RES_MEMORY, 0) >> 20) & 1) == 1) { 244169175Smarius schizo = children[j]; 245166060Smarius break; 246166060Smarius } 247166060Smarius } 248166060Smarius free(children, M_TEMP); 249166060Smarius if (schizo == NULL) { 250166060Smarius device_printf(dev, "could not find Schizo\n"); 251166060Smarius goto fail; 252166060Smarius } 253169175Smarius if (bus_get_resource(schizo, SYS_RES_MEMORY, 0, 254169175Smarius &sstart, &scount) != 0) { 255166060Smarius device_printf(dev, 256169175Smarius "could not determine Schizo resource\n"); 257166060Smarius goto fail; 258166060Smarius } 259169175Smarius sc->sc_res[i] = bus_alloc_resource(dev, SYS_RES_MEMORY, 260169175Smarius &rid, sstart, sstart + scount - 1, scount, 261169175Smarius RF_SHAREABLE | RF_ACTIVE); 262166060Smarius } else 263166060Smarius sc->sc_res[i] = bus_alloc_resource_any(dev, 264166060Smarius SYS_RES_MEMORY, &rid, RF_ACTIVE); 265166060Smarius if (sc->sc_res[i] == NULL) { 266166060Smarius device_printf(dev, 267166060Smarius "could not allocate resource %d\n", i); 268166060Smarius goto fail; 269166060Smarius } 270166060Smarius sc->sc_bt[i] = rman_get_bustag(sc->sc_res[i]); 271166060Smarius sc->sc_bh[i] = rman_get_bushandle(sc->sc_res[i]); 272169175Smarius if (i == UPA_IMR1 || i == UPA_IMR2) 273166060Smarius bus_space_subregion(sc->sc_bt[i], sc->sc_bh[i], 274169175Smarius ustart - sstart, ucount, &sc->sc_bh[i]); 275166060Smarius#endif 276166060Smarius } 277166060Smarius 278172066Smarius if (OF_getprop(node, "portid", &sc->sc_ign, sizeof(sc->sc_ign)) == -1) { 279172066Smarius device_printf(dev, "could not determine IGN\n"); 280166060Smarius goto fail; 281166060Smarius } 282166060Smarius 283166060Smarius sc->sc_nrange = OF_getprop_alloc(node, "ranges", sizeof(*sc->sc_ranges), 284166060Smarius (void **)&sc->sc_ranges); 285166060Smarius if (sc->sc_nrange == -1) { 286166060Smarius device_printf(dev, "could not determine ranges\n"); 287166060Smarius goto fail; 288166060Smarius } 289166060Smarius 290172066Smarius /* 291172066Smarius * Hunt through all the interrupt mapping regs and register our 292172066Smarius * interrupt controller for the corresponding interrupt vectors. 293172066Smarius */ 294172066Smarius for (i = UPA_INO_BASE; i <= UPA_INO_MAX; i++) { 295172066Smarius imr = 0; 296172066Smarius for (j = UPA_IMR1; j <= UPA_IMR2; j++) { 297172066Smarius if (INTVEC(UPA_READ(sc, j, 0x0)) == 298172066Smarius INTMAP_VEC(sc->sc_ign, i)) { 299172066Smarius imr = j; 300172066Smarius break; 301172066Smarius } 302172066Smarius } 303172066Smarius if (imr == 0) 304172066Smarius continue; 305172066Smarius uica = malloc(sizeof(*uica), M_DEVBUF, M_NOWAIT); 306172066Smarius if (uica == NULL) 307172066Smarius panic("%s: could not allocate interrupt controller " 308172066Smarius "argument", __func__); 309172066Smarius uica->uica_sc = sc; 310172066Smarius uica->uica_imr = imr; 311172066Smarius#ifdef UPA_DEBUG 312172066Smarius device_printf(dev, "intr map (INO %d) IMR%d: %#lx\n", 313172066Smarius i, imr, (u_long)UPA_READ(sc, imr, 0x0)); 314172066Smarius#endif 315172066Smarius if (intr_controller_register(INTMAP_VEC(sc->sc_ign, i), 316172066Smarius &upa_ic, uica) != 0) 317172066Smarius panic("%s: could not register interrupt controller " 318172066Smarius "for INO %d", __func__, i); 319172066Smarius } 320172066Smarius 321166060Smarius /* Make sure the power level is appropriate for normal operation. */ 322166060Smarius if (UPA_READ(sc, UPA_CFG, UPA_CFG_IF) != UPA_CFG_IF_POK) { 323166060Smarius if (bootverbose) 324166060Smarius device_printf(dev, "applying power\n"); 325166060Smarius UPA_WRITE(sc, UPA_CFG, UPA_CFG_ESTAR, UPA_CFG_ESTAR_SPEED_1_2); 326166060Smarius UPA_WRITE(sc, UPA_CFG, UPA_CFG_ESTAR, UPA_CFG_ESTAR_SPEED_FULL); 327166060Smarius (void)UPA_READ(sc, UPA_CFG, UPA_CFG_ESTAR); 328166060Smarius UPA_WRITE(sc, UPA_CFG, UPA_CFG_IF, UPA_CFG_IF_POK_RST); 329166060Smarius (void)UPA_READ(sc, UPA_CFG, UPA_CFG_IF); 330166060Smarius DELAY(20000); 331166060Smarius UPA_WRITE(sc, UPA_CFG, UPA_CFG_IF, UPA_CFG_IF_POK); 332166060Smarius (void)UPA_READ(sc, UPA_CFG, UPA_CFG_IF); 333166060Smarius } 334166060Smarius 335166060Smarius for (child = OF_child(node); child != 0; child = OF_peer(child)) { 336166060Smarius /* 337166060Smarius * The `upa-portid' properties of the children are used as 338172066Smarius * index for the interrupt mapping registers. 339166060Smarius * The `upa-portid' properties are also used to make up the 340166060Smarius * INOs of the children as the values contained in their 341166060Smarius * `interrupts' properties are bogus. 342166060Smarius */ 343166060Smarius if (OF_getprop(child, "upa-portid", &portid, 344166060Smarius sizeof(portid)) == -1) { 345166060Smarius device_printf(dev, 346166060Smarius "could not determine upa-portid of child 0x%lx\n", 347166060Smarius (unsigned long)child); 348166060Smarius continue; 349166060Smarius } 350166060Smarius if (portid > 1) { 351166060Smarius device_printf(dev, 352166060Smarius "upa-portid %d of child 0x%lx invalid\n", portid, 353166060Smarius (unsigned long)child); 354166060Smarius continue; 355166060Smarius } 356166060Smarius if ((udi = upa_setup_dinfo(dev, sc, child, portid)) == NULL) 357166060Smarius continue; 358172066Smarius if ((cdev = device_add_child(dev, NULL, -1)) == NULL) { 359166060Smarius device_printf(dev, "<%s>: device_add_child failed\n", 360166060Smarius udi->udi_obdinfo.obd_name); 361166060Smarius upa_destroy_dinfo(udi); 362166060Smarius continue; 363166060Smarius } 364166060Smarius device_set_ivars(cdev, udi); 365166060Smarius } 366166060Smarius 367166060Smarius return (bus_generic_attach(dev)); 368166060Smarius 369166060Smarius fail: 370166060Smarius for (i = UPA_CFG; i <= UPA_IMR2 && sc->sc_res[i] != NULL; i++) 371166060Smarius bus_release_resource(dev, SYS_RES_MEMORY, 372166060Smarius rman_get_rid(sc->sc_res[i]), sc->sc_res[i]); 373166060Smarius return (ENXIO); 374166060Smarius} 375166060Smarius 376166060Smariusstatic int 377166060Smariusupa_print_child(device_t dev, device_t child) 378166060Smarius{ 379166060Smarius int rv; 380166060Smarius 381166060Smarius rv = bus_print_child_header(dev, child); 382166060Smarius rv += upa_print_res(device_get_ivars(child)); 383166060Smarius rv += bus_print_child_footer(dev, child); 384166060Smarius return (rv); 385166060Smarius} 386166060Smarius 387166060Smariusstatic void 388166060Smariusupa_probe_nomatch(device_t dev, device_t child) 389166060Smarius{ 390166060Smarius const char *type; 391166060Smarius 392166060Smarius device_printf(dev, "<%s>", ofw_bus_get_name(child)); 393166060Smarius upa_print_res(device_get_ivars(child)); 394166060Smarius type = ofw_bus_get_type(child); 395166060Smarius printf(" type %s (no driver attached)\n", 396166060Smarius type != NULL ? type : "unknown"); 397166060Smarius} 398166060Smarius 399166060Smariusstatic struct resource * 400166060Smariusupa_alloc_resource(device_t dev, device_t child, int type, int *rid, 401166060Smarius u_long start, u_long end, u_long count, u_int flags) 402166060Smarius{ 403166060Smarius struct resource_list *rl; 404166060Smarius struct resource_list_entry *rle; 405166060Smarius struct upa_softc *sc; 406166060Smarius struct resource *rv; 407166060Smarius bus_addr_t cend, cstart; 408166060Smarius int i, isdefault, passthrough; 409166060Smarius 410166060Smarius isdefault = (start == 0UL && end == ~0UL); 411166060Smarius passthrough = (device_get_parent(child) != dev); 412166060Smarius sc = device_get_softc(dev); 413166060Smarius rl = BUS_GET_RESOURCE_LIST(dev, child); 414166060Smarius rle = NULL; 415166060Smarius switch (type) { 416166060Smarius case SYS_RES_IRQ: 417166060Smarius return (resource_list_alloc(rl, dev, child, type, rid, start, 418166060Smarius end, count, flags)); 419166060Smarius case SYS_RES_MEMORY: 420166060Smarius if (!passthrough) { 421166060Smarius rle = resource_list_find(rl, type, *rid); 422166060Smarius if (rle == NULL) 423166060Smarius return (NULL); 424166060Smarius if (rle->res != NULL) 425166060Smarius panic("%s: resource entry is busy", __func__); 426166060Smarius if (isdefault) { 427166060Smarius start = rle->start; 428166060Smarius count = ulmax(count, rle->count); 429166060Smarius end = ulmax(rle->end, start + count - 1); 430166060Smarius } 431166060Smarius } 432166060Smarius for (i = 0; i < sc->sc_nrange; i++) { 433166060Smarius cstart = sc->sc_ranges[i].child; 434166060Smarius cend = cstart + sc->sc_ranges[i].size - 1; 435166060Smarius if (start < cstart || start > cend) 436166060Smarius continue; 437166060Smarius if (end < cstart || end > cend) 438166060Smarius return (NULL); 439166060Smarius start += sc->sc_ranges[i].parent - cstart; 440166060Smarius end += sc->sc_ranges[i].parent - cstart; 441166060Smarius rv = bus_generic_alloc_resource(dev, child, type, rid, 442166060Smarius start, end, count, flags); 443166060Smarius if (!passthrough) 444166060Smarius rle->res = rv; 445166060Smarius return (rv); 446166060Smarius } 447166060Smarius /* FALLTHROUGH */ 448166060Smarius default: 449166060Smarius return (NULL); 450166060Smarius } 451166060Smarius} 452166060Smarius 453172066Smariusstatic void 454172066Smariusupa_intr_enable(void *arg) 455172066Smarius{ 456172066Smarius struct intr_vector *iv = arg; 457172066Smarius struct upa_icarg *uica = iv->iv_icarg; 458172066Smarius 459172066Smarius UPA_WRITE(uica->uica_sc, uica->uica_imr, 0x0, 460172066Smarius INTMAP_ENABLE(iv->iv_vec, iv->iv_mid)); 461172066Smarius (void)UPA_READ(uica->uica_sc, uica->uica_imr, 0x0); 462172066Smarius} 463172066Smarius 464172066Smariusstatic void 465172066Smariusupa_intr_disable(void *arg) 466172066Smarius{ 467172066Smarius struct intr_vector *iv = arg; 468172066Smarius struct upa_icarg *uica = iv->iv_icarg; 469172066Smarius 470172066Smarius UPA_WRITE(uica->uica_sc, uica->uica_imr, 0x0, iv->iv_vec); 471172066Smarius (void)UPA_READ(uica->uica_sc, uica->uica_imr, 0x0); 472172066Smarius} 473172066Smarius 474178443Smariusstatic void 475178443Smariusupa_intr_assign(void *arg) 476178443Smarius{ 477178443Smarius struct intr_vector *iv = arg; 478178443Smarius struct upa_icarg *uica = iv->iv_icarg; 479178443Smarius 480178443Smarius UPA_WRITE(uica->uica_sc, uica->uica_imr, 0x0, INTMAP_TID( 481178443Smarius UPA_READ(uica->uica_sc, uica->uica_imr, 0x0), iv->iv_mid)); 482178443Smarius (void)UPA_READ(uica->uica_sc, uica->uica_imr, 0x0); 483178443Smarius} 484178443Smarius 485166060Smariusstatic int 486166060Smariusupa_setup_intr(device_t dev, device_t child, struct resource *ires, int flags, 487166901Spiso driver_filter_t *filt, driver_intr_t *func, void *arg, void **cookiep) 488166060Smarius{ 489166060Smarius struct upa_softc *sc; 490172066Smarius u_long vec; 491166060Smarius 492166060Smarius sc = device_get_softc(dev); 493166060Smarius /* 494172066Smarius * Make sure the vector is fully specified and we registered 495172066Smarius * our interrupt controller for it. 496172066Smarius */ 497172066Smarius vec = rman_get_start(ires); 498172066Smarius if (INTIGN(vec) != sc->sc_ign || intr_vectors[vec].iv_ic != &upa_ic) { 499172066Smarius device_printf(dev, "invalid interrupt vector 0x%lx\n", vec); 500172066Smarius return (EINVAL); 501172066Smarius } 502172066Smarius return (bus_generic_setup_intr(dev, child, ires, flags, filt, func, 503172066Smarius arg, cookiep)); 504166060Smarius} 505166060Smarius 506166060Smariusstatic struct resource_list * 507166060Smariusupa_get_resource_list(device_t dev, device_t child) 508166060Smarius{ 509166060Smarius struct upa_devinfo *udi; 510166060Smarius 511166060Smarius udi = device_get_ivars(child); 512166060Smarius return (&udi->udi_rl); 513166060Smarius} 514166060Smarius 515166060Smariusstatic const struct ofw_bus_devinfo * 516166060Smariusupa_get_devinfo(device_t dev, device_t child) 517166060Smarius{ 518166060Smarius struct upa_devinfo *udi; 519166060Smarius 520166060Smarius udi = device_get_ivars(child); 521166060Smarius return (&udi->udi_obdinfo); 522166060Smarius} 523166060Smarius 524166060Smariusstatic struct upa_devinfo * 525166060Smariusupa_setup_dinfo(device_t dev, struct upa_softc *sc, phandle_t node, 526166060Smarius uint32_t portid) 527166060Smarius{ 528166060Smarius struct upa_devinfo *udi; 529166060Smarius struct upa_regs *reg; 530166060Smarius uint32_t intr; 531166060Smarius int i, nreg; 532166060Smarius 533166060Smarius udi = malloc(sizeof(*udi), M_DEVBUF, M_WAITOK | M_ZERO); 534166060Smarius if (ofw_bus_gen_setup_devinfo(&udi->udi_obdinfo, node) != 0) { 535166060Smarius free(udi, M_DEVBUF); 536166060Smarius return (NULL); 537166060Smarius } 538166060Smarius resource_list_init(&udi->udi_rl); 539166060Smarius 540166060Smarius nreg = OF_getprop_alloc(node, "reg", sizeof(*reg), (void **)®); 541166060Smarius if (nreg == -1) { 542166060Smarius device_printf(dev, "<%s>: incomplete\n", 543166060Smarius udi->udi_obdinfo.obd_name); 544166060Smarius goto fail; 545166060Smarius } 546166060Smarius for (i = 0; i < nreg; i++) 547166060Smarius resource_list_add(&udi->udi_rl, SYS_RES_MEMORY, i, reg[i].phys, 548166060Smarius reg[i].phys + reg[i].size - 1, reg[i].size); 549166060Smarius free(reg, M_OFWPROP); 550166060Smarius 551172066Smarius intr = INTMAP_VEC(sc->sc_ign, (UPA_INO_BASE + portid)); 552166060Smarius resource_list_add(&udi->udi_rl, SYS_RES_IRQ, 0, intr, intr, 1); 553166060Smarius 554166060Smarius return (udi); 555166060Smarius 556166060Smarius fail: 557166060Smarius upa_destroy_dinfo(udi); 558166060Smarius return (NULL); 559166060Smarius} 560166060Smarius 561166060Smariusstatic void 562166060Smariusupa_destroy_dinfo(struct upa_devinfo *dinfo) 563166060Smarius{ 564166060Smarius 565166060Smarius resource_list_free(&dinfo->udi_rl); 566166060Smarius ofw_bus_gen_destroy_devinfo(&dinfo->udi_obdinfo); 567166060Smarius free(dinfo, M_DEVBUF); 568166060Smarius} 569166060Smarius 570166060Smariusstatic int 571166060Smariusupa_print_res(struct upa_devinfo *udi) 572166060Smarius{ 573166060Smarius int rv; 574166060Smarius 575166060Smarius rv = 0; 576166060Smarius rv += resource_list_print_type(&udi->udi_rl, "mem", SYS_RES_MEMORY, 577166060Smarius "%#lx"); 578166060Smarius rv += resource_list_print_type(&udi->udi_rl, "irq", SYS_RES_IRQ, 579166060Smarius "%ld"); 580166060Smarius return (rv); 581166060Smarius} 582