ofw_pci.c revision 266128
1/*- 2 * Copyright (c) 2011 Nathan Whitehorn 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 */ 26 27#include <sys/cdefs.h> 28__FBSDID("$FreeBSD: stable/10/sys/powerpc/ofw/ofw_pci.c 266128 2014-05-15 14:26:11Z ian $"); 29#include <sys/param.h> 30#include <sys/systm.h> 31#include <sys/module.h> 32#include <sys/bus.h> 33#include <sys/conf.h> 34#include <sys/kernel.h> 35 36#include <dev/ofw/openfirm.h> 37#include <dev/ofw/ofw_pci.h> 38#include <dev/ofw/ofw_bus.h> 39#include <dev/ofw/ofw_bus_subr.h> 40 41#include <dev/pci/pcivar.h> 42#include <dev/pci/pcireg.h> 43 44#include <machine/bus.h> 45#include <machine/intr_machdep.h> 46#include <machine/md_var.h> 47#include <machine/pio.h> 48#include <machine/resource.h> 49 50#include <sys/rman.h> 51 52#include <vm/vm.h> 53#include <vm/pmap.h> 54 55#include <powerpc/ofw/ofw_pci.h> 56 57#include "pcib_if.h" 58 59/* 60 * Bus interface. 61 */ 62static int ofw_pci_read_ivar(device_t, device_t, int, 63 uintptr_t *); 64static struct resource * ofw_pci_alloc_resource(device_t bus, 65 device_t child, int type, int *rid, u_long start, 66 u_long end, u_long count, u_int flags); 67static int ofw_pci_release_resource(device_t bus, device_t child, 68 int type, int rid, struct resource *res); 69static int ofw_pci_activate_resource(device_t bus, device_t child, 70 int type, int rid, struct resource *res); 71static int ofw_pci_deactivate_resource(device_t bus, 72 device_t child, int type, int rid, 73 struct resource *res); 74static int ofw_pci_adjust_resource(device_t bus, device_t child, 75 int type, struct resource *res, u_long start, 76 u_long end); 77 78/* 79 * pcib interface. 80 */ 81static int ofw_pci_maxslots(device_t); 82static int ofw_pci_route_interrupt(device_t, device_t, int); 83 84/* 85 * ofw_bus interface 86 */ 87static phandle_t ofw_pci_get_node(device_t bus, device_t dev); 88 89/* 90 * local methods 91 */ 92 93static int ofw_pci_nranges(phandle_t node); 94static int ofw_pci_fill_ranges(phandle_t node, struct ofw_pci_range *ranges); 95 96/* 97 * Driver methods. 98 */ 99static device_method_t ofw_pci_methods[] = { 100 /* Device interface */ 101 DEVMETHOD(device_attach, ofw_pci_attach), 102 103 /* Bus interface */ 104 DEVMETHOD(bus_print_child, bus_generic_print_child), 105 DEVMETHOD(bus_read_ivar, ofw_pci_read_ivar), 106 DEVMETHOD(bus_setup_intr, bus_generic_setup_intr), 107 DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr), 108 DEVMETHOD(bus_alloc_resource, ofw_pci_alloc_resource), 109 DEVMETHOD(bus_release_resource, ofw_pci_release_resource), 110 DEVMETHOD(bus_activate_resource, ofw_pci_activate_resource), 111 DEVMETHOD(bus_deactivate_resource, ofw_pci_deactivate_resource), 112 DEVMETHOD(bus_adjust_resource, ofw_pci_adjust_resource), 113 114 /* pcib interface */ 115 DEVMETHOD(pcib_maxslots, ofw_pci_maxslots), 116 DEVMETHOD(pcib_route_interrupt, ofw_pci_route_interrupt), 117 118 /* ofw_bus interface */ 119 DEVMETHOD(ofw_bus_get_node, ofw_pci_get_node), 120 121 DEVMETHOD_END 122}; 123 124DEFINE_CLASS_0(ofw_pci, ofw_pci_driver, ofw_pci_methods, 0); 125 126int 127ofw_pci_init(device_t dev) 128{ 129 struct ofw_pci_softc *sc; 130 phandle_t node; 131 u_int32_t busrange[2]; 132 struct ofw_pci_range *rp; 133 int error; 134 135 node = ofw_bus_get_node(dev); 136 sc = device_get_softc(dev); 137 sc->sc_initialized = 1; 138 139 if (OF_getprop(node, "reg", &sc->sc_pcir, sizeof(sc->sc_pcir)) == -1) 140 return (ENXIO); 141 142 if (OF_getprop(node, "bus-range", busrange, sizeof(busrange)) != 8) 143 busrange[0] = 0; 144 145 sc->sc_dev = dev; 146 sc->sc_node = node; 147 sc->sc_bus = busrange[0]; 148 149 if (sc->sc_quirks & OFW_PCI_QUIRK_RANGES_ON_CHILDREN) { 150 phandle_t c; 151 int n, i; 152 153 sc->sc_nrange = 0; 154 for (c = OF_child(node); c != 0; c = OF_peer(c)) { 155 n = ofw_pci_nranges(c); 156 if (n > 0) 157 sc->sc_nrange += n; 158 } 159 if (sc->sc_nrange == 0) 160 return (ENXIO); 161 sc->sc_range = malloc(sc->sc_nrange * sizeof(sc->sc_range[0]), 162 M_DEVBUF, M_WAITOK); 163 i = 0; 164 for (c = OF_child(node); c != 0; c = OF_peer(c)) { 165 n = ofw_pci_fill_ranges(c, &sc->sc_range[i]); 166 if (n > 0) 167 i += n; 168 } 169 KASSERT(i == sc->sc_nrange, ("range count mismatch")); 170 } else { 171 sc->sc_nrange = ofw_pci_nranges(node); 172 if (sc->sc_nrange <= 0) { 173 device_printf(dev, "could not get ranges\n"); 174 return (ENXIO); 175 } 176 sc->sc_range = malloc(sc->sc_nrange * sizeof(sc->sc_range[0]), 177 M_DEVBUF, M_WAITOK); 178 ofw_pci_fill_ranges(node, sc->sc_range); 179 } 180 181 sc->sc_io_rman.rm_type = RMAN_ARRAY; 182 sc->sc_io_rman.rm_descr = "PCI I/O Ports"; 183 error = rman_init(&sc->sc_io_rman); 184 if (error) { 185 device_printf(dev, "rman_init() failed. error = %d\n", error); 186 return (error); 187 } 188 189 sc->sc_mem_rman.rm_type = RMAN_ARRAY; 190 sc->sc_mem_rman.rm_descr = "PCI Memory"; 191 error = rman_init(&sc->sc_mem_rman); 192 if (error) { 193 device_printf(dev, "rman_init() failed. error = %d\n", error); 194 return (error); 195 } 196 197 for (rp = sc->sc_range; rp < sc->sc_range + sc->sc_nrange && 198 rp->pci_hi != 0; rp++) { 199 error = 0; 200 201 switch (rp->pci_hi & OFW_PCI_PHYS_HI_SPACEMASK) { 202 case OFW_PCI_PHYS_HI_SPACE_CONFIG: 203 break; 204 case OFW_PCI_PHYS_HI_SPACE_IO: 205 error = rman_manage_region(&sc->sc_io_rman, rp->pci, 206 rp->pci + rp->size - 1); 207 break; 208 case OFW_PCI_PHYS_HI_SPACE_MEM32: 209 case OFW_PCI_PHYS_HI_SPACE_MEM64: 210 error = rman_manage_region(&sc->sc_mem_rman, rp->pci, 211 rp->pci + rp->size - 1); 212 break; 213 } 214 215 if (error) { 216 device_printf(dev, 217 "rman_manage_region(%x, %#jx, %#jx) failed. " 218 "error = %d\n", rp->pci_hi & 219 OFW_PCI_PHYS_HI_SPACEMASK, rp->pci, 220 rp->pci + rp->size - 1, error); 221 return (error); 222 } 223 } 224 225 ofw_bus_setup_iinfo(node, &sc->sc_pci_iinfo, sizeof(cell_t)); 226 227 return (error); 228} 229 230int 231ofw_pci_attach(device_t dev) 232{ 233 struct ofw_pci_softc *sc; 234 int error; 235 236 sc = device_get_softc(dev); 237 if (!sc->sc_initialized) { 238 error = ofw_pci_init(dev); 239 if (error) 240 return (error); 241 } 242 243 device_add_child(dev, "pci", device_get_unit(dev)); 244 return (bus_generic_attach(dev)); 245} 246 247static int 248ofw_pci_maxslots(device_t dev) 249{ 250 251 return (PCI_SLOTMAX); 252} 253 254static int 255ofw_pci_route_interrupt(device_t bus, device_t dev, int pin) 256{ 257 struct ofw_pci_softc *sc; 258 struct ofw_pci_register reg; 259 uint32_t pintr, mintr[2]; 260 int intrcells; 261 phandle_t iparent; 262 263 sc = device_get_softc(bus); 264 pintr = pin; 265 266 /* Fabricate imap information in case this isn't an OFW device */ 267 bzero(®, sizeof(reg)); 268 reg.phys_hi = (pci_get_bus(dev) << OFW_PCI_PHYS_HI_BUSSHIFT) | 269 (pci_get_slot(dev) << OFW_PCI_PHYS_HI_DEVICESHIFT) | 270 (pci_get_function(dev) << OFW_PCI_PHYS_HI_FUNCTIONSHIFT); 271 272 intrcells = ofw_bus_lookup_imap(ofw_bus_get_node(dev), 273 &sc->sc_pci_iinfo, ®, sizeof(reg), &pintr, sizeof(pintr), 274 mintr, sizeof(mintr), &iparent); 275 if (intrcells) { 276 pintr = ofw_bus_map_intr(dev, iparent, intrcells, mintr); 277 return (pintr); 278 } 279 280 /* Maybe it's a real interrupt, not an intpin */ 281 if (pin > 4) 282 return (pin); 283 284 device_printf(bus, "could not route pin %d for device %d.%d\n", 285 pin, pci_get_slot(dev), pci_get_function(dev)); 286 return (PCI_INVALID_IRQ); 287} 288 289static int 290ofw_pci_read_ivar(device_t dev, device_t child, int which, uintptr_t *result) 291{ 292 struct ofw_pci_softc *sc; 293 294 sc = device_get_softc(dev); 295 296 switch (which) { 297 case PCIB_IVAR_DOMAIN: 298 *result = device_get_unit(dev); 299 return (0); 300 case PCIB_IVAR_BUS: 301 *result = sc->sc_bus; 302 return (0); 303 } 304 305 return (ENOENT); 306} 307 308static struct resource * 309ofw_pci_alloc_resource(device_t bus, device_t child, int type, int *rid, 310 u_long start, u_long end, u_long count, u_int flags) 311{ 312 struct ofw_pci_softc *sc; 313 struct resource *rv; 314 struct rman *rm; 315 int needactivate; 316 317 needactivate = flags & RF_ACTIVE; 318 flags &= ~RF_ACTIVE; 319 320 sc = device_get_softc(bus); 321 322 switch (type) { 323 case SYS_RES_MEMORY: 324 rm = &sc->sc_mem_rman; 325 break; 326 327 case SYS_RES_IOPORT: 328 rm = &sc->sc_io_rman; 329 break; 330 331 case SYS_RES_IRQ: 332 return (bus_alloc_resource(bus, type, rid, start, end, count, 333 flags)); 334 335 default: 336 device_printf(bus, "unknown resource request from %s\n", 337 device_get_nameunit(child)); 338 return (NULL); 339 } 340 341 rv = rman_reserve_resource(rm, start, end, count, flags, child); 342 if (rv == NULL) { 343 device_printf(bus, "failed to reserve resource for %s\n", 344 device_get_nameunit(child)); 345 return (NULL); 346 } 347 348 rman_set_rid(rv, *rid); 349 350 if (needactivate) { 351 if (bus_activate_resource(child, type, *rid, rv) != 0) { 352 device_printf(bus, 353 "failed to activate resource for %s\n", 354 device_get_nameunit(child)); 355 rman_release_resource(rv); 356 return (NULL); 357 } 358 } 359 360 return (rv); 361} 362 363static int 364ofw_pci_release_resource(device_t bus, device_t child, int type, int rid, 365 struct resource *res) 366{ 367 if (rman_get_flags(res) & RF_ACTIVE) { 368 int error = bus_deactivate_resource(child, type, rid, res); 369 if (error) 370 return error; 371 } 372 373 return (rman_release_resource(res)); 374} 375 376static int 377ofw_pci_activate_resource(device_t bus, device_t child, int type, int rid, 378 struct resource *res) 379{ 380 struct ofw_pci_softc *sc; 381 void *p; 382 383 sc = device_get_softc(bus); 384 385 if (type == SYS_RES_IRQ) { 386 return (bus_activate_resource(bus, type, rid, res)); 387 } 388 if (type == SYS_RES_MEMORY || type == SYS_RES_IOPORT) { 389 struct ofw_pci_range *rp; 390 vm_offset_t start; 391 int space; 392 393 start = (vm_offset_t)rman_get_start(res); 394 395 /* 396 * Map this through the ranges list 397 */ 398 for (rp = sc->sc_range; rp < sc->sc_range + sc->sc_nrange && 399 rp->pci_hi != 0; rp++) { 400 if (start < rp->pci || start >= rp->pci + rp->size) 401 continue; 402 403 switch (rp->pci_hi & OFW_PCI_PHYS_HI_SPACEMASK) { 404 case OFW_PCI_PHYS_HI_SPACE_IO: 405 space = SYS_RES_IOPORT; 406 break; 407 case OFW_PCI_PHYS_HI_SPACE_MEM32: 408 case OFW_PCI_PHYS_HI_SPACE_MEM64: 409 space = SYS_RES_MEMORY; 410 break; 411 default: 412 space = -1; 413 } 414 415 if (type == space) { 416 start += (rp->host - rp->pci); 417 break; 418 } 419 } 420 421 if (bootverbose) 422 printf("ofw_pci mapdev: start %zx, len %ld\n", start, 423 rman_get_size(res)); 424 425 p = pmap_mapdev(start, (vm_size_t)rman_get_size(res)); 426 if (p == NULL) 427 return (ENOMEM); 428 429 rman_set_virtual(res, p); 430 rman_set_bustag(res, &bs_le_tag); 431 rman_set_bushandle(res, (u_long)p); 432 } 433 434 return (rman_activate_resource(res)); 435} 436 437static int 438ofw_pci_deactivate_resource(device_t bus, device_t child, int type, int rid, 439 struct resource *res) 440{ 441 /* 442 * If this is a memory resource, unmap it. 443 */ 444 if ((type == SYS_RES_MEMORY) || (type == SYS_RES_IOPORT)) { 445 u_int32_t psize; 446 447 psize = rman_get_size(res); 448 pmap_unmapdev((vm_offset_t)rman_get_virtual(res), psize); 449 } 450 451 return (rman_deactivate_resource(res)); 452} 453 454static int 455ofw_pci_adjust_resource(device_t bus, device_t child, int type, 456 struct resource *res, u_long start, u_long end) 457{ 458 struct rman *rm = NULL; 459 struct ofw_pci_softc *sc = device_get_softc(bus); 460 461 KASSERT(!(rman_get_flags(res) & RF_ACTIVE), 462 ("active resources cannot be adjusted")); 463 if (rman_get_flags(res) & RF_ACTIVE) 464 return (EINVAL); 465 466 switch (type) { 467 case SYS_RES_MEMORY: 468 rm = &sc->sc_mem_rman; 469 break; 470 case SYS_RES_IOPORT: 471 rm = &sc->sc_io_rman; 472 break; 473 default: 474 return (ENXIO); 475 } 476 477 if (!rman_is_region_manager(res, rm)) 478 return (EINVAL); 479 480 return (rman_adjust_resource(res, start, end)); 481} 482 483 484static phandle_t 485ofw_pci_get_node(device_t bus, device_t dev) 486{ 487 struct ofw_pci_softc *sc; 488 489 sc = device_get_softc(bus); 490 /* We only have one child, the PCI bus, which needs our own node. */ 491 492 return (sc->sc_node); 493} 494 495static int 496ofw_pci_nranges(phandle_t node) 497{ 498 int host_address_cells = 1, pci_address_cells = 3, size_cells = 2; 499 ssize_t nbase_ranges; 500 501 OF_getprop(OF_parent(node), "#address-cells", &host_address_cells, 502 sizeof(host_address_cells)); 503 OF_getprop(node, "#address-cells", &pci_address_cells, 504 sizeof(pci_address_cells)); 505 OF_getprop(node, "#size-cells", &size_cells, sizeof(size_cells)); 506 507 nbase_ranges = OF_getproplen(node, "ranges"); 508 if (nbase_ranges <= 0) 509 return (-1); 510 511 return (nbase_ranges / sizeof(cell_t) / 512 (pci_address_cells + host_address_cells + size_cells)); 513} 514 515static int 516ofw_pci_fill_ranges(phandle_t node, struct ofw_pci_range *ranges) 517{ 518 int host_address_cells = 1, pci_address_cells = 3, size_cells = 2; 519 cell_t *base_ranges; 520 ssize_t nbase_ranges; 521 int nranges; 522 int i, j, k; 523 524 OF_getprop(OF_parent(node), "#address-cells", &host_address_cells, 525 sizeof(host_address_cells)); 526 OF_getprop(node, "#address-cells", &pci_address_cells, 527 sizeof(pci_address_cells)); 528 OF_getprop(node, "#size-cells", &size_cells, sizeof(size_cells)); 529 530 nbase_ranges = OF_getproplen(node, "ranges"); 531 if (nbase_ranges <= 0) 532 return (-1); 533 nranges = nbase_ranges / sizeof(cell_t) / 534 (pci_address_cells + host_address_cells + size_cells); 535 536 base_ranges = malloc(nbase_ranges, M_DEVBUF, M_WAITOK); 537 OF_getprop(node, "ranges", base_ranges, nbase_ranges); 538 539 for (i = 0, j = 0; i < nranges; i++) { 540 ranges[i].pci_hi = base_ranges[j++]; 541 ranges[i].pci = 0; 542 for (k = 0; k < pci_address_cells - 1; k++) { 543 ranges[i].pci <<= 32; 544 ranges[i].pci |= base_ranges[j++]; 545 } 546 ranges[i].host = 0; 547 for (k = 0; k < host_address_cells; k++) { 548 ranges[i].host <<= 32; 549 ranges[i].host |= base_ranges[j++]; 550 } 551 ranges[i].size = 0; 552 for (k = 0; k < size_cells; k++) { 553 ranges[i].size <<= 32; 554 ranges[i].size |= base_ranges[j++]; 555 } 556 } 557 558 free(base_ranges, M_DEVBUF); 559 return (nranges); 560} 561 562