1 /*- 2 * SPDX-License-Identifier: BSD-2-Clause 3 * 4 * Copyright (c) 2015-2016 Landon Fuller <landon@landonf.org> 5 * Copyright (c) 2017 The FreeBSD Foundation 6 * All rights reserved. 7 * 8 * Portions of this software were developed by Landon Fuller 9 * under sponsorship from the FreeBSD Foundation. 10 * 11 * Redistribution and use in source and binary forms, with or without 12 * modification, are permitted provided that the following conditions 13 * are met: 14 * 1. Redistributions of source code must retain the above copyright 15 * notice, this list of conditions and the following disclaimer, 16 * without modification. 17 * 2. Redistributions in binary form must reproduce at minimum a disclaimer 18 * similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any 19 * redistribution must be conditioned upon including a substantially 20 * similar Disclaimer requirement for further binary redistribution. 21 * 22 * NO WARRANTY 23 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 24 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 25 * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY 26 * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL 27 * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, 28 * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 29 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 30 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER 31 * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 32 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF 33 * THE POSSIBILITY OF SUCH DAMAGES. 34 */ 35 36 #include <sys/cdefs.h> 37 __FBSDID("$FreeBSD$"); 38 39 #include <sys/param.h> 40 #include <sys/bus.h> 41 #include <sys/refcount.h> 42 #include <sys/systm.h> 43 44 #include <machine/bus.h> 45 #include <sys/rman.h> 46 #include <machine/resource.h> 47 48 #include <dev/bhnd/siba/sibareg.h> 49 50 #include <dev/bhnd/cores/chipc/chipcreg.h> 51 52 #include "nvram/bhnd_nvram.h" 53 54 #include "bhnd_chipc_if.h" 55 56 #include "bhnd_nvram_if.h" 57 #include "bhnd_nvram_map.h" 58 59 #include "bhndreg.h" 60 #include "bhndvar.h" 61 #include "bhnd_private.h" 62 63 static void bhnd_service_registry_free_entry( 64 struct bhnd_service_entry *entry); 65 66 static int compare_ascending_probe_order(const void *lhs, const void *rhs); 67 static int compare_descending_probe_order(const void *lhs, 68 const void *rhs); 69 70 /* BHND core device description table. */ 71 static const struct bhnd_core_desc { 72 uint16_t vendor; 73 uint16_t device; 74 bhnd_devclass_t class; 75 const char *desc; 76 } bhnd_core_descs[] = { 77 #define BHND_CDESC(_mfg, _cid, _cls, _desc) \ 78 { BHND_MFGID_ ## _mfg, BHND_COREID_ ## _cid, \ 79 BHND_DEVCLASS_ ## _cls, _desc } 80 81 BHND_CDESC(BCM, CC, CC, "ChipCommon I/O Controller"), 82 BHND_CDESC(BCM, ILINE20, OTHER, "iLine20 HPNA"), 83 BHND_CDESC(BCM, SRAM, RAM, "SRAM"), 84 BHND_CDESC(BCM, SDRAM, RAM, "SDRAM"), 85 BHND_CDESC(BCM, PCI, PCI, "PCI Bridge"), 86 BHND_CDESC(BCM, MIPS, CPU, "BMIPS CPU"), 87 BHND_CDESC(BCM, ENET, ENET_MAC, "Fast Ethernet MAC"), 88 BHND_CDESC(BCM, V90_CODEC, SOFTMODEM, "V.90 SoftModem Codec"), 89 BHND_CDESC(BCM, USB, USB_DUAL, "USB 1.1 Device/Host Controller"), 90 BHND_CDESC(BCM, ADSL, OTHER, "ADSL Core"), 91 BHND_CDESC(BCM, ILINE100, OTHER, "iLine100 HPNA"), 92 BHND_CDESC(BCM, IPSEC, OTHER, "IPsec Accelerator"), 93 BHND_CDESC(BCM, UTOPIA, OTHER, "UTOPIA ATM Core"), 94 BHND_CDESC(BCM, PCMCIA, PCCARD, "PCMCIA Bridge"), 95 BHND_CDESC(BCM, SOCRAM, RAM, "Internal Memory"), 96 BHND_CDESC(BCM, MEMC, MEMC, "MEMC SDRAM Controller"), 97 BHND_CDESC(BCM, OFDM, OTHER, "OFDM PHY"), 98 BHND_CDESC(BCM, EXTIF, OTHER, "External Interface"), 99 BHND_CDESC(BCM, D11, WLAN, "802.11 MAC/PHY/Radio"), 100 BHND_CDESC(BCM, APHY, WLAN_PHY, "802.11a PHY"), 101 BHND_CDESC(BCM, BPHY, WLAN_PHY, "802.11b PHY"), 102 BHND_CDESC(BCM, GPHY, WLAN_PHY, "802.11g PHY"), 103 BHND_CDESC(BCM, MIPS33, CPU, "BMIPS33 CPU"), 104 BHND_CDESC(BCM, USB11H, USB_HOST, "USB 1.1 Host Controller"), 105 BHND_CDESC(BCM, USB11D, USB_DEV, "USB 1.1 Device Controller"), 106 BHND_CDESC(BCM, USB20H, USB_HOST, "USB 2.0 Host Controller"), 107 BHND_CDESC(BCM, USB20D, USB_DEV, "USB 2.0 Device Controller"), 108 BHND_CDESC(BCM, SDIOH, OTHER, "SDIO Host Controller"), 109 BHND_CDESC(BCM, ROBO, OTHER, "RoboSwitch"), 110 BHND_CDESC(BCM, ATA100, OTHER, "Parallel ATA Controller"), 111 BHND_CDESC(BCM, SATAXOR, OTHER, "SATA DMA/XOR Controller"), 112 BHND_CDESC(BCM, GIGETH, ENET_MAC, "Gigabit Ethernet MAC"), 113 BHND_CDESC(BCM, PCIE, PCIE, "PCIe Bridge"), 114 BHND_CDESC(BCM, NPHY, WLAN_PHY, "802.11n 2x2 PHY"), 115 BHND_CDESC(BCM, SRAMC, MEMC, "SRAM Controller"), 116 BHND_CDESC(BCM, MINIMAC, OTHER, "MINI MAC/PHY"), 117 BHND_CDESC(BCM, ARM11, CPU, "ARM1176 CPU"), 118 BHND_CDESC(BCM, ARM7S, CPU, "ARM7TDMI-S CPU"), 119 BHND_CDESC(BCM, LPPHY, WLAN_PHY, "802.11a/b/g PHY"), 120 BHND_CDESC(BCM, PMU, PMU, "PMU"), 121 BHND_CDESC(BCM, SSNPHY, WLAN_PHY, "802.11n Single-Stream PHY"), 122 BHND_CDESC(BCM, SDIOD, OTHER, "SDIO Device Core"), 123 BHND_CDESC(BCM, ARMCM3, CPU, "ARM Cortex-M3 CPU"), 124 BHND_CDESC(BCM, HTPHY, WLAN_PHY, "802.11n 4x4 PHY"), 125 BHND_CDESC(MIPS,MIPS74K, CPU, "MIPS74k CPU"), 126 BHND_CDESC(BCM, GMAC, ENET_MAC, "Gigabit MAC core"), 127 BHND_CDESC(BCM, DMEMC, MEMC, "DDR1/DDR2 Memory Controller"), 128 BHND_CDESC(BCM, PCIERC, OTHER, "PCIe Root Complex"), 129 BHND_CDESC(BCM, OCP, SOC_BRIDGE, "OCP to OCP Bridge"), 130 BHND_CDESC(BCM, SC, OTHER, "Shared Common Core"), 131 BHND_CDESC(BCM, AHB, SOC_BRIDGE, "OCP to AHB Bridge"), 132 BHND_CDESC(BCM, SPIH, OTHER, "SPI Host Controller"), 133 BHND_CDESC(BCM, I2S, OTHER, "I2S Digital Audio Interface"), 134 BHND_CDESC(BCM, DMEMS, MEMC, "SDR/DDR1 Memory Controller"), 135 BHND_CDESC(BCM, UBUS_SHIM, OTHER, "BCM6362/UBUS WLAN SHIM"), 136 BHND_CDESC(BCM, PCIE2, PCIE, "PCIe Bridge (Gen2)"), 137 138 BHND_CDESC(ARM, APB_BRIDGE, SOC_BRIDGE, "BP135 AMBA3 AXI to APB Bridge"), 139 BHND_CDESC(ARM, PL301, SOC_ROUTER, "PL301 AMBA3 Interconnect"), 140 BHND_CDESC(ARM, EROM, EROM, "PL366 Device Enumeration ROM"), 141 BHND_CDESC(ARM, OOB_ROUTER, OTHER, "PL367 OOB Interrupt Router"), 142 BHND_CDESC(ARM, AXI_UNMAPPED, OTHER, "Unmapped Address Ranges"), 143 144 BHND_CDESC(BCM, 4706_CC, CC, "ChipCommon I/O Controller"), 145 BHND_CDESC(BCM, NS_PCIE2, PCIE, "PCIe Bridge (Gen2)"), 146 BHND_CDESC(BCM, NS_DMA, OTHER, "DMA engine"), 147 BHND_CDESC(BCM, NS_SDIO, OTHER, "SDIO 3.0 Host Controller"), 148 BHND_CDESC(BCM, NS_USB20H, USB_HOST, "USB 2.0 Host Controller"), 149 BHND_CDESC(BCM, NS_USB30H, USB_HOST, "USB 3.0 Host Controller"), 150 BHND_CDESC(BCM, NS_A9JTAG, OTHER, "ARM Cortex A9 JTAG Interface"), 151 BHND_CDESC(BCM, NS_DDR23_MEMC, MEMC, "Denali DDR2/DD3 Memory Controller"), 152 BHND_CDESC(BCM, NS_ROM, NVRAM, "System ROM"), 153 BHND_CDESC(BCM, NS_NAND, NVRAM, "NAND Flash Controller"), 154 BHND_CDESC(BCM, NS_QSPI, NVRAM, "QSPI Flash Controller"), 155 BHND_CDESC(BCM, NS_CC_B, CC_B, "ChipCommon B Auxiliary I/O Controller"), 156 BHND_CDESC(BCM, 4706_SOCRAM, RAM, "Internal Memory"), 157 BHND_CDESC(BCM, IHOST_ARMCA9, CPU, "ARM Cortex A9 CPU"), 158 BHND_CDESC(BCM, 4706_GMAC_CMN, ENET, "Gigabit MAC (Common)"), 159 BHND_CDESC(BCM, 4706_GMAC, ENET_MAC, "Gigabit MAC"), 160 BHND_CDESC(BCM, AMEMC, MEMC, "Denali DDR1/DDR2 Memory Controller"), 161 #undef BHND_CDESC 162 163 /* Derived from inspection of the BCM4331 cores that provide PrimeCell 164 * IDs. Due to lack of documentation, the surmised device name/purpose 165 * provided here may be incorrect. */ 166 { BHND_MFGID_ARM, BHND_PRIMEID_EROM, BHND_DEVCLASS_OTHER, 167 "PL364 Device Enumeration ROM" }, 168 { BHND_MFGID_ARM, BHND_PRIMEID_SWRAP, BHND_DEVCLASS_OTHER, 169 "PL368 Device Management Interface" }, 170 { BHND_MFGID_ARM, BHND_PRIMEID_MWRAP, BHND_DEVCLASS_OTHER, 171 "PL369 Device Management Interface" }, 172 { 0, 0, 0, NULL } 173 }; 174 175 static const struct bhnd_device_quirk bhnd_chipc_clkctl_quirks[]; 176 static const struct bhnd_device_quirk bhnd_pcmcia_clkctl_quirks[]; 177 178 /** 179 * Device table entries for core-specific CLKCTL quirk lookup. 180 */ 181 static const struct bhnd_device bhnd_clkctl_devices[] = { 182 BHND_DEVICE(BCM, CC, NULL, bhnd_chipc_clkctl_quirks), 183 BHND_DEVICE(BCM, PCMCIA, NULL, bhnd_pcmcia_clkctl_quirks), 184 BHND_DEVICE_END, 185 }; 186 187 /** ChipCommon CLKCTL quirks */ 188 static const struct bhnd_device_quirk bhnd_chipc_clkctl_quirks[] = { 189 /* HTAVAIL/ALPAVAIL are bitswapped in chipc's CLKCTL */ 190 BHND_CHIP_QUIRK(4328, HWREV_ANY, BHND_CLKCTL_QUIRK_CCS0), 191 BHND_CHIP_QUIRK(5354, HWREV_ANY, BHND_CLKCTL_QUIRK_CCS0), 192 BHND_DEVICE_QUIRK_END 193 }; 194 195 /** PCMCIA CLKCTL quirks */ 196 static const struct bhnd_device_quirk bhnd_pcmcia_clkctl_quirks[] = { 197 /* HTAVAIL/ALPAVAIL are bitswapped in pcmcia's CLKCTL */ 198 BHND_CHIP_QUIRK(4328, HWREV_ANY, BHND_CLKCTL_QUIRK_CCS0), 199 BHND_CHIP_QUIRK(5354, HWREV_ANY, BHND_CLKCTL_QUIRK_CCS0), 200 BHND_DEVICE_QUIRK_END 201 }; 202 203 /** 204 * Return the name for a given JEP106 manufacturer ID. 205 * 206 * @param vendor A JEP106 Manufacturer ID, including the non-standard ARM 4-bit 207 * JEP106 continuation code. 208 */ 209 const char * 210 bhnd_vendor_name(uint16_t vendor) 211 { 212 switch (vendor) { 213 case BHND_MFGID_ARM: 214 return "ARM"; 215 case BHND_MFGID_BCM: 216 return "Broadcom"; 217 case BHND_MFGID_MIPS: 218 return "MIPS"; 219 default: 220 return "unknown"; 221 } 222 } 223 224 /** 225 * Return the name of a port type. 226 * 227 * @param port_type The port type to look up. 228 */ 229 const char * 230 bhnd_port_type_name(bhnd_port_type port_type) 231 { 232 switch (port_type) { 233 case BHND_PORT_DEVICE: 234 return ("device"); 235 case BHND_PORT_BRIDGE: 236 return ("bridge"); 237 case BHND_PORT_AGENT: 238 return ("agent"); 239 default: 240 return "unknown"; 241 } 242 } 243 244 /** 245 * Return the name of an NVRAM source. 246 * 247 * @param nvram_src The NVRAM source type to look up. 248 */ 249 const char * 250 bhnd_nvram_src_name(bhnd_nvram_src nvram_src) 251 { 252 switch (nvram_src) { 253 case BHND_NVRAM_SRC_FLASH: 254 return ("flash"); 255 case BHND_NVRAM_SRC_OTP: 256 return ("OTP"); 257 case BHND_NVRAM_SRC_SPROM: 258 return ("SPROM"); 259 case BHND_NVRAM_SRC_UNKNOWN: 260 return ("none"); 261 default: 262 return ("unknown"); 263 } 264 } 265 266 static const struct bhnd_core_desc * 267 bhnd_find_core_desc(uint16_t vendor, uint16_t device) 268 { 269 for (u_int i = 0; bhnd_core_descs[i].desc != NULL; i++) { 270 if (bhnd_core_descs[i].vendor != vendor) 271 continue; 272 273 if (bhnd_core_descs[i].device != device) 274 continue; 275 276 return (&bhnd_core_descs[i]); 277 } 278 279 return (NULL); 280 } 281 282 /** 283 * Return a human-readable name for a BHND core. 284 * 285 * @param vendor The core designer's JEDEC-106 Manufacturer ID. 286 * @param device The core identifier. 287 */ 288 const char * 289 bhnd_find_core_name(uint16_t vendor, uint16_t device) 290 { 291 const struct bhnd_core_desc *desc; 292 293 if ((desc = bhnd_find_core_desc(vendor, device)) == NULL) 294 return ("unknown"); 295 296 return desc->desc; 297 } 298 299 /** 300 * Return the device class for a BHND core. 301 * 302 * @param vendor The core designer's JEDEC-106 Manufacturer ID. 303 * @param device The core identifier. 304 */ 305 bhnd_devclass_t 306 bhnd_find_core_class(uint16_t vendor, uint16_t device) 307 { 308 const struct bhnd_core_desc *desc; 309 310 if ((desc = bhnd_find_core_desc(vendor, device)) == NULL) 311 return (BHND_DEVCLASS_OTHER); 312 313 return desc->class; 314 } 315 316 /** 317 * Return a human-readable name for a BHND core. 318 * 319 * @param ci The core's info record. 320 */ 321 const char * 322 bhnd_core_name(const struct bhnd_core_info *ci) 323 { 324 return bhnd_find_core_name(ci->vendor, ci->device); 325 } 326 327 /** 328 * Return the device class for a BHND core. 329 * 330 * @param ci The core's info record. 331 */ 332 bhnd_devclass_t 333 bhnd_core_class(const struct bhnd_core_info *ci) 334 { 335 return bhnd_find_core_class(ci->vendor, ci->device); 336 } 337 338 /** 339 * Write a human readable name representation of the given 340 * BHND_CHIPID_* constant to @p buffer. 341 * 342 * @param buffer Output buffer, or NULL to compute the required size. 343 * @param size Capacity of @p buffer, in bytes. 344 * @param chip_id Chip ID to be formatted. 345 * 346 * @return The required number of bytes on success, or a negative integer on 347 * failure. No more than @p size-1 characters be written, with the @p size'th 348 * set to '\0'. 349 * 350 * @sa BHND_CHIPID_MAX_NAMELEN 351 */ 352 int 353 bhnd_format_chip_id(char *buffer, size_t size, uint16_t chip_id) 354 { 355 /* All hex formatted IDs are within the range of 0x4000-0x9C3F (40000-1) */ 356 if (chip_id >= 0x4000 && chip_id <= 0x9C3F) 357 return (snprintf(buffer, size, "BCM%hX", chip_id)); 358 else 359 return (snprintf(buffer, size, "BCM%hu", chip_id)); 360 } 361 362 /** 363 * Return a core info record populated from a bhnd-attached @p dev. 364 * 365 * @param dev A bhnd device. 366 * 367 * @return A core info record for @p dev. 368 */ 369 struct bhnd_core_info 370 bhnd_get_core_info(device_t dev) { 371 return (struct bhnd_core_info) { 372 .vendor = bhnd_get_vendor(dev), 373 .device = bhnd_get_device(dev), 374 .hwrev = bhnd_get_hwrev(dev), 375 .core_idx = bhnd_get_core_index(dev), 376 .unit = bhnd_get_core_unit(dev) 377 }; 378 } 379 380 /** 381 * Find a @p class child device with @p unit on @p bus. 382 * 383 * @param bus The bhnd-compatible bus to be searched. 384 * @param class The device class to match on. 385 * @param unit The core unit number; specify -1 to return the first match 386 * regardless of unit number. 387 * 388 * @retval device_t if a matching child device is found. 389 * @retval NULL if no matching child device is found. 390 */ 391 device_t 392 bhnd_bus_find_child(device_t bus, bhnd_devclass_t class, int unit) 393 { 394 struct bhnd_core_match md = { 395 BHND_MATCH_CORE_CLASS(class), 396 BHND_MATCH_CORE_UNIT(unit) 397 }; 398 399 if (unit == -1) 400 md.m.match.core_unit = 0; 401 402 return bhnd_bus_match_child(bus, &md); 403 } 404 405 /** 406 * Find the first child device on @p bus that matches @p desc. 407 * 408 * @param bus The bhnd-compatible bus to be searched. 409 * @param desc A match descriptor. 410 * 411 * @retval device_t if a matching child device is found. 412 * @retval NULL if no matching child device is found. 413 */ 414 device_t 415 bhnd_bus_match_child(device_t bus, const struct bhnd_core_match *desc) 416 { 417 device_t *devlistp; 418 device_t match; 419 int devcnt; 420 int error; 421 422 error = device_get_children(bus, &devlistp, &devcnt); 423 if (error != 0) 424 return (NULL); 425 426 match = NULL; 427 for (int i = 0; i < devcnt; i++) { 428 struct bhnd_core_info ci = bhnd_get_core_info(devlistp[i]); 429 430 if (bhnd_core_matches(&ci, desc)) { 431 match = devlistp[i]; 432 goto done; 433 } 434 } 435 436 done: 437 free(devlistp, M_TEMP); 438 return match; 439 } 440 441 /** 442 * Retrieve an ordered list of all device instances currently connected to 443 * @p bus, returning a pointer to the array in @p devlistp and the count 444 * in @p ndevs. 445 * 446 * The memory allocated for the table must be freed via 447 * bhnd_bus_free_children(). 448 * 449 * @param bus The bhnd-compatible bus to be queried. 450 * @param[out] devlist The array of devices. 451 * @param[out] devcount The number of devices in @p devlistp 452 * @param order The order in which devices will be returned 453 * in @p devlist. 454 * 455 * @retval 0 success 456 * @retval non-zero if an error occurs, a regular unix error code will 457 * be returned. 458 */ 459 int 460 bhnd_bus_get_children(device_t bus, device_t **devlist, int *devcount, 461 bhnd_device_order order) 462 { 463 int error; 464 465 /* Fetch device array */ 466 if ((error = device_get_children(bus, devlist, devcount))) 467 return (error); 468 469 /* Perform requested sorting */ 470 if ((error = bhnd_sort_devices(*devlist, *devcount, order))) { 471 bhnd_bus_free_children(*devlist); 472 return (error); 473 } 474 475 return (0); 476 } 477 478 /** 479 * Free any memory allocated in a previous call to bhnd_bus_get_children(). 480 * 481 * @param devlist The device array returned by bhnd_bus_get_children(). 482 */ 483 void 484 bhnd_bus_free_children(device_t *devlist) 485 { 486 free(devlist, M_TEMP); 487 } 488 489 /** 490 * Perform in-place sorting of an array of bhnd device instances. 491 * 492 * @param devlist An array of bhnd devices. 493 * @param devcount The number of devices in @p devs. 494 * @param order The sort order to be used. 495 * 496 * @retval 0 success 497 * @retval EINVAL if the sort order is unknown. 498 */ 499 int 500 bhnd_sort_devices(device_t *devlist, size_t devcount, bhnd_device_order order) 501 { 502 int (*compare)(const void *, const void *); 503 504 switch (order) { 505 case BHND_DEVICE_ORDER_ATTACH: 506 compare = compare_ascending_probe_order; 507 break; 508 case BHND_DEVICE_ORDER_DETACH: 509 compare = compare_descending_probe_order; 510 break; 511 default: 512 printf("unknown sort order: %d\n", order); 513 return (EINVAL); 514 } 515 516 qsort(devlist, devcount, sizeof(*devlist), compare); 517 return (0); 518 } 519 520 /* 521 * Ascending comparison of bhnd device's probe order. 522 */ 523 static int 524 compare_ascending_probe_order(const void *lhs, const void *rhs) 525 { 526 device_t ldev, rdev; 527 int lorder, rorder; 528 529 ldev = (*(const device_t *) lhs); 530 rdev = (*(const device_t *) rhs); 531 532 lorder = BHND_BUS_GET_PROBE_ORDER(device_get_parent(ldev), ldev); 533 rorder = BHND_BUS_GET_PROBE_ORDER(device_get_parent(rdev), rdev); 534 535 if (lorder < rorder) { 536 return (-1); 537 } else if (lorder > rorder) { 538 return (1); 539 } else { 540 return (0); 541 } 542 } 543 544 /* 545 * Descending comparison of bhnd device's probe order. 546 */ 547 static int 548 compare_descending_probe_order(const void *lhs, const void *rhs) 549 { 550 return (compare_ascending_probe_order(rhs, lhs)); 551 } 552 553 /** 554 * Call device_probe_and_attach() for each of the bhnd bus device's 555 * children, in bhnd attach order. 556 * 557 * @param bus The bhnd-compatible bus for which all children should be probed 558 * and attached. 559 */ 560 int 561 bhnd_bus_probe_children(device_t bus) 562 { 563 device_t *devs; 564 int ndevs; 565 int error; 566 567 /* Fetch children in attach order */ 568 error = bhnd_bus_get_children(bus, &devs, &ndevs, 569 BHND_DEVICE_ORDER_ATTACH); 570 if (error) 571 return (error); 572 573 /* Probe and attach all children */ 574 for (int i = 0; i < ndevs; i++) { 575 device_t child = devs[i]; 576 device_probe_and_attach(child); 577 } 578 579 bhnd_bus_free_children(devs); 580 581 return (0); 582 } 583 584 /** 585 * Walk up the bhnd device hierarchy to locate the root device 586 * to which the bhndb bridge is attached. 587 * 588 * This can be used from within bhnd host bridge drivers to locate the 589 * actual upstream host device. 590 * 591 * @param dev A bhnd device. 592 * @param bus_class The expected bus (e.g. "pci") to which the bridge root 593 * should be attached. 594 * 595 * @retval device_t if a matching parent device is found. 596 * @retval NULL if @p dev is not attached via a bhndb bus. 597 * @retval NULL if no parent device is attached via @p bus_class. 598 */ 599 device_t 600 bhnd_find_bridge_root(device_t dev, devclass_t bus_class) 601 { 602 devclass_t bhndb_class; 603 device_t parent; 604 605 KASSERT(device_get_devclass(device_get_parent(dev)) == 606 devclass_find("bhnd"), 607 ("%s not a bhnd device", device_get_nameunit(dev))); 608 609 bhndb_class = devclass_find("bhndb"); 610 611 /* Walk the device tree until we hit a bridge */ 612 parent = dev; 613 while ((parent = device_get_parent(parent)) != NULL) { 614 if (device_get_devclass(parent) == bhndb_class) 615 break; 616 } 617 618 /* No bridge? */ 619 if (parent == NULL) 620 return (NULL); 621 622 /* Search for a parent attached to the expected bus class */ 623 while ((parent = device_get_parent(parent)) != NULL) { 624 device_t bus; 625 626 bus = device_get_parent(parent); 627 if (bus != NULL && device_get_devclass(bus) == bus_class) 628 return (parent); 629 } 630 631 /* Not found */ 632 return (NULL); 633 } 634 635 /** 636 * Find the first core in @p cores that matches @p desc. 637 * 638 * @param cores The table to search. 639 * @param num_cores The length of @p cores. 640 * @param desc A match descriptor. 641 * 642 * @retval bhnd_core_info if a matching core is found. 643 * @retval NULL if no matching core is found. 644 */ 645 const struct bhnd_core_info * 646 bhnd_match_core(const struct bhnd_core_info *cores, u_int num_cores, 647 const struct bhnd_core_match *desc) 648 { 649 for (u_int i = 0; i < num_cores; i++) { 650 if (bhnd_core_matches(&cores[i], desc)) 651 return &cores[i]; 652 } 653 654 return (NULL); 655 } 656 657 /** 658 * Find the first core in @p cores with the given @p class. 659 * 660 * @param cores The table to search. 661 * @param num_cores The length of @p cores. 662 * @param class The device class to match on. 663 * 664 * @retval non-NULL if a matching core is found. 665 * @retval NULL if no matching core is found. 666 */ 667 const struct bhnd_core_info * 668 bhnd_find_core(const struct bhnd_core_info *cores, u_int num_cores, 669 bhnd_devclass_t class) 670 { 671 struct bhnd_core_match md = { 672 BHND_MATCH_CORE_CLASS(class) 673 }; 674 675 return bhnd_match_core(cores, num_cores, &md); 676 } 677 678 /** 679 * Create an equality match descriptor for @p core. 680 * 681 * @param core The core info to be matched on. 682 * 683 * @return an equality match descriptor for @p core. 684 */ 685 struct bhnd_core_match 686 bhnd_core_get_match_desc(const struct bhnd_core_info *core) 687 { 688 return ((struct bhnd_core_match) { 689 BHND_MATCH_CORE_VENDOR(core->vendor), 690 BHND_MATCH_CORE_ID(core->device), 691 BHND_MATCH_CORE_REV(HWREV_EQ(core->hwrev)), 692 BHND_MATCH_CORE_CLASS(bhnd_core_class(core)), 693 BHND_MATCH_CORE_IDX(core->core_idx), 694 BHND_MATCH_CORE_UNIT(core->unit) 695 }); 696 } 697 698 /** 699 * Return true if the @p lhs is equal to @p rhs. 700 * 701 * @param lhs The first bhnd core descriptor to compare. 702 * @param rhs The second bhnd core descriptor to compare. 703 * 704 * @retval true if @p lhs is equal to @p rhs 705 * @retval false if @p lhs is not equal to @p rhs 706 */ 707 bool 708 bhnd_cores_equal(const struct bhnd_core_info *lhs, 709 const struct bhnd_core_info *rhs) 710 { 711 struct bhnd_core_match md; 712 713 /* Use an equality match descriptor to perform the comparison */ 714 md = bhnd_core_get_match_desc(rhs); 715 return (bhnd_core_matches(lhs, &md)); 716 } 717 718 /** 719 * Return true if the @p core matches @p desc. 720 * 721 * @param core A bhnd core descriptor. 722 * @param desc A match descriptor to compare against @p core. 723 * 724 * @retval true if @p core matches @p match. 725 * @retval false if @p core does not match @p match. 726 */ 727 bool 728 bhnd_core_matches(const struct bhnd_core_info *core, 729 const struct bhnd_core_match *desc) 730 { 731 if (desc->m.match.core_vendor && desc->core_vendor != core->vendor) 732 return (false); 733 734 if (desc->m.match.core_id && desc->core_id != core->device) 735 return (false); 736 737 if (desc->m.match.core_unit && desc->core_unit != core->unit) 738 return (false); 739 740 if (desc->m.match.core_rev && 741 !bhnd_hwrev_matches(core->hwrev, &desc->core_rev)) 742 return (false); 743 744 if (desc->m.match.core_idx && desc->core_idx != core->core_idx) 745 return (false); 746 747 if (desc->m.match.core_class && 748 desc->core_class != bhnd_core_class(core)) 749 return (false); 750 751 return true; 752 } 753 754 /** 755 * Return true if the @p chip matches @p desc. 756 * 757 * @param chip A bhnd chip identifier. 758 * @param desc A match descriptor to compare against @p chip. 759 * 760 * @retval true if @p chip matches @p match. 761 * @retval false if @p chip does not match @p match. 762 */ 763 bool 764 bhnd_chip_matches(const struct bhnd_chipid *chip, 765 const struct bhnd_chip_match *desc) 766 { 767 if (desc->m.match.chip_id && chip->chip_id != desc->chip_id) 768 return (false); 769 770 if (desc->m.match.chip_pkg && chip->chip_pkg != desc->chip_pkg) 771 return (false); 772 773 if (desc->m.match.chip_rev && 774 !bhnd_hwrev_matches(chip->chip_rev, &desc->chip_rev)) 775 return (false); 776 777 if (desc->m.match.chip_type && chip->chip_type != desc->chip_type) 778 return (false); 779 780 return (true); 781 } 782 783 /** 784 * Return true if the @p board matches @p desc. 785 * 786 * @param board The bhnd board info. 787 * @param desc A match descriptor to compare against @p board. 788 * 789 * @retval true if @p chip matches @p match. 790 * @retval false if @p chip does not match @p match. 791 */ 792 bool 793 bhnd_board_matches(const struct bhnd_board_info *board, 794 const struct bhnd_board_match *desc) 795 { 796 if (desc->m.match.board_srom_rev && 797 !bhnd_hwrev_matches(board->board_srom_rev, &desc->board_srom_rev)) 798 return (false); 799 800 if (desc->m.match.board_vendor && 801 board->board_vendor != desc->board_vendor) 802 return (false); 803 804 if (desc->m.match.board_type && board->board_type != desc->board_type) 805 return (false); 806 807 if (desc->m.match.board_devid && 808 board->board_devid != desc->board_devid) 809 return (false); 810 811 if (desc->m.match.board_rev && 812 !bhnd_hwrev_matches(board->board_rev, &desc->board_rev)) 813 return (false); 814 815 return (true); 816 } 817 818 /** 819 * Return true if the @p hwrev matches @p desc. 820 * 821 * @param hwrev A bhnd hardware revision. 822 * @param desc A match descriptor to compare against @p core. 823 * 824 * @retval true if @p hwrev matches @p match. 825 * @retval false if @p hwrev does not match @p match. 826 */ 827 bool 828 bhnd_hwrev_matches(uint16_t hwrev, const struct bhnd_hwrev_match *desc) 829 { 830 if (desc->start != BHND_HWREV_INVALID && 831 desc->start > hwrev) 832 return false; 833 834 if (desc->end != BHND_HWREV_INVALID && 835 desc->end < hwrev) 836 return false; 837 838 return true; 839 } 840 841 /** 842 * Return true if the @p dev matches @p desc. 843 * 844 * @param dev A bhnd device. 845 * @param desc A match descriptor to compare against @p dev. 846 * 847 * @retval true if @p dev matches @p match. 848 * @retval false if @p dev does not match @p match. 849 */ 850 bool 851 bhnd_device_matches(device_t dev, const struct bhnd_device_match *desc) 852 { 853 struct bhnd_core_info core; 854 const struct bhnd_chipid *chip; 855 struct bhnd_board_info board; 856 device_t parent; 857 int error; 858 859 /* Construct individual match descriptors */ 860 struct bhnd_core_match m_core = { _BHND_CORE_MATCH_COPY(desc) }; 861 struct bhnd_chip_match m_chip = { _BHND_CHIP_MATCH_COPY(desc) }; 862 struct bhnd_board_match m_board = { _BHND_BOARD_MATCH_COPY(desc) }; 863 864 /* Fetch and match core info */ 865 if (m_core.m.match_flags) { 866 /* Only applicable to bhnd-attached cores */ 867 parent = device_get_parent(dev); 868 if (device_get_devclass(parent) != devclass_find("bhnd")) { 869 device_printf(dev, "attempting to match core " 870 "attributes against non-core device\n"); 871 return (false); 872 } 873 874 core = bhnd_get_core_info(dev); 875 if (!bhnd_core_matches(&core, &m_core)) 876 return (false); 877 } 878 879 /* Fetch and match chip info */ 880 if (m_chip.m.match_flags) { 881 chip = bhnd_get_chipid(dev); 882 883 if (!bhnd_chip_matches(chip, &m_chip)) 884 return (false); 885 } 886 887 /* Fetch and match board info. 888 * 889 * This is not available until after NVRAM is up; earlier device 890 * matches should not include board requirements */ 891 if (m_board.m.match_flags) { 892 if ((error = bhnd_read_board_info(dev, &board))) { 893 device_printf(dev, "failed to read required board info " 894 "during device matching: %d\n", error); 895 return (false); 896 } 897 898 if (!bhnd_board_matches(&board, &m_board)) 899 return (false); 900 } 901 902 /* All matched */ 903 return (true); 904 } 905 906 /** 907 * Search @p table for an entry matching @p dev. 908 * 909 * @param dev A bhnd device to match against @p table. 910 * @param table The device table to search. 911 * @param entry_size The @p table entry size, in bytes. 912 * 913 * @retval non-NULL the first matching device, if any. 914 * @retval NULL if no matching device is found in @p table. 915 */ 916 const struct bhnd_device * 917 bhnd_device_lookup(device_t dev, const struct bhnd_device *table, 918 size_t entry_size) 919 { 920 const struct bhnd_device *entry; 921 device_t hostb, parent; 922 bhnd_attach_type attach_type; 923 uint32_t dflags; 924 925 parent = device_get_parent(dev); 926 hostb = bhnd_bus_find_hostb_device(parent); 927 attach_type = bhnd_get_attach_type(dev); 928 929 for (entry = table; !BHND_DEVICE_IS_END(entry); entry = 930 (const struct bhnd_device *) ((const char *) entry + entry_size)) 931 { 932 /* match core info */ 933 if (!bhnd_device_matches(dev, &entry->core)) 934 continue; 935 936 /* match device flags */ 937 dflags = entry->device_flags; 938 939 /* hostb implies BHND_ATTACH_ADAPTER requirement */ 940 if (dflags & BHND_DF_HOSTB) 941 dflags |= BHND_DF_ADAPTER; 942 943 if (dflags & BHND_DF_ADAPTER) 944 if (attach_type != BHND_ATTACH_ADAPTER) 945 continue; 946 947 if (dflags & BHND_DF_HOSTB) 948 if (dev != hostb) 949 continue; 950 951 if (dflags & BHND_DF_SOC) 952 if (attach_type != BHND_ATTACH_NATIVE) 953 continue; 954 955 /* device found */ 956 return (entry); 957 } 958 959 /* not found */ 960 return (NULL); 961 } 962 963 /** 964 * Scan the device @p table for all quirk flags applicable to @p dev. 965 * 966 * @param dev A bhnd device to match against @p table. 967 * @param table The device table to search. 968 * @param entry_size The @p table entry size, in bytes. 969 * 970 * @return all matching quirk flags. 971 */ 972 uint32_t 973 bhnd_device_quirks(device_t dev, const struct bhnd_device *table, 974 size_t entry_size) 975 { 976 const struct bhnd_device *dent; 977 const struct bhnd_device_quirk *qent, *qtable; 978 uint32_t quirks; 979 980 /* Locate the device entry */ 981 if ((dent = bhnd_device_lookup(dev, table, entry_size)) == NULL) 982 return (0); 983 984 /* Quirks table is optional */ 985 qtable = dent->quirks_table; 986 if (qtable == NULL) 987 return (0); 988 989 /* Collect matching device quirk entries */ 990 quirks = 0; 991 for (qent = qtable; !BHND_DEVICE_QUIRK_IS_END(qent); qent++) { 992 if (bhnd_device_matches(dev, &qent->desc)) 993 quirks |= qent->quirks; 994 } 995 996 return (quirks); 997 } 998 999 /** 1000 * Allocate bhnd(4) resources defined in @p rs from a parent bus. 1001 * 1002 * @param dev The device requesting ownership of the resources. 1003 * @param rs A standard bus resource specification. This will be updated 1004 * with the allocated resource's RIDs. 1005 * @param res On success, the allocated bhnd resources. 1006 * 1007 * @retval 0 success 1008 * @retval non-zero if allocation of any non-RF_OPTIONAL resource fails, 1009 * all allocated resources will be released and a regular 1010 * unix error code will be returned. 1011 */ 1012 int 1013 bhnd_alloc_resources(device_t dev, struct resource_spec *rs, 1014 struct bhnd_resource **res) 1015 { 1016 /* Initialize output array */ 1017 for (u_int i = 0; rs[i].type != -1; i++) 1018 res[i] = NULL; 1019 1020 for (u_int i = 0; rs[i].type != -1; i++) { 1021 res[i] = bhnd_alloc_resource_any(dev, rs[i].type, &rs[i].rid, 1022 rs[i].flags); 1023 1024 /* Clean up all allocations on failure */ 1025 if (res[i] == NULL && !(rs[i].flags & RF_OPTIONAL)) { 1026 bhnd_release_resources(dev, rs, res); 1027 return (ENXIO); 1028 } 1029 } 1030 1031 return (0); 1032 } 1033 1034 /** 1035 * Release bhnd(4) resources defined in @p rs from a parent bus. 1036 * 1037 * @param dev The device that owns the resources. 1038 * @param rs A standard bus resource specification previously initialized 1039 * by @p bhnd_alloc_resources. 1040 * @param res The bhnd resources to be released. 1041 */ 1042 void 1043 bhnd_release_resources(device_t dev, const struct resource_spec *rs, 1044 struct bhnd_resource **res) 1045 { 1046 for (u_int i = 0; rs[i].type != -1; i++) { 1047 if (res[i] == NULL) 1048 continue; 1049 1050 bhnd_release_resource(dev, rs[i].type, rs[i].rid, res[i]); 1051 res[i] = NULL; 1052 } 1053 } 1054 1055 /** 1056 * Allocate and return a new per-core PMU clock control/status (clkctl) 1057 * instance for @p dev. 1058 * 1059 * @param dev The bhnd(4) core device mapped by @p r. 1060 * @param pmu_dev The bhnd(4) PMU device, implmenting the bhnd_pmu_if 1061 * interface. The caller is responsible for ensuring that 1062 * this reference remains valid for the lifetime of the 1063 * returned clkctl instance. 1064 * @param r A resource mapping the core's clock control register 1065 * (see BHND_CLK_CTL_ST). The caller is responsible for 1066 * ensuring that this resource remains valid for the 1067 * lifetime of the returned clkctl instance. 1068 * @param offset The offset to the clock control register within @p r. 1069 * @param max_latency The PMU's maximum state transition latency in 1070 * microseconds; this upper bound will be used to busy-wait 1071 * on PMU state transitions. 1072 * 1073 * @retval non-NULL success 1074 * @retval NULL if allocation fails. 1075 * 1076 */ 1077 struct bhnd_core_clkctl * 1078 bhnd_alloc_core_clkctl(device_t dev, device_t pmu_dev, struct bhnd_resource *r, 1079 bus_size_t offset, u_int max_latency) 1080 { 1081 struct bhnd_core_clkctl *clkctl; 1082 1083 clkctl = malloc(sizeof(*clkctl), M_BHND, M_ZERO | M_NOWAIT); 1084 if (clkctl == NULL) 1085 return (NULL); 1086 1087 clkctl->cc_dev = dev; 1088 clkctl->cc_pmu_dev = pmu_dev; 1089 clkctl->cc_res = r; 1090 clkctl->cc_res_offset = offset; 1091 clkctl->cc_max_latency = max_latency; 1092 clkctl->cc_quirks = bhnd_device_quirks(dev, bhnd_clkctl_devices, 1093 sizeof(bhnd_clkctl_devices[0])); 1094 1095 BHND_CLKCTL_LOCK_INIT(clkctl); 1096 1097 return (clkctl); 1098 } 1099 1100 /** 1101 * Free a clkctl instance previously allocated via bhnd_alloc_core_clkctl(). 1102 * 1103 * @param clkctl The clkctl instance to be freed. 1104 */ 1105 void 1106 bhnd_free_core_clkctl(struct bhnd_core_clkctl *clkctl) 1107 { 1108 BHND_CLKCTL_LOCK_DESTROY(clkctl); 1109 1110 free(clkctl, M_BHND); 1111 } 1112 1113 /** 1114 * Wait for the per-core clock status to be equal to @p value after 1115 * applying @p mask, timing out after the maximum transition latency is reached. 1116 * 1117 * @param clkctl Per-core clkctl state to be queryied. 1118 * @param value Value to wait for. 1119 * @param mask Mask to apply prior to value comparison. 1120 * 1121 * @retval 0 success 1122 * @retval ETIMEDOUT if the PMU's maximum transition delay is reached before 1123 * the clock status matches @p value and @p mask. 1124 */ 1125 int 1126 bhnd_core_clkctl_wait(struct bhnd_core_clkctl *clkctl, uint32_t value, 1127 uint32_t mask) 1128 { 1129 uint32_t clkst; 1130 1131 BHND_CLKCTL_LOCK_ASSERT(clkctl, MA_OWNED); 1132 1133 /* Bitswapped HTAVAIL/ALPAVAIL work-around */ 1134 if (clkctl->cc_quirks & BHND_CLKCTL_QUIRK_CCS0) { 1135 uint32_t fmask, fval; 1136 1137 fmask = mask & ~(BHND_CCS_HTAVAIL | BHND_CCS_ALPAVAIL); 1138 fval = value & ~(BHND_CCS_HTAVAIL | BHND_CCS_ALPAVAIL); 1139 1140 if (mask & BHND_CCS_HTAVAIL) 1141 fmask |= BHND_CCS0_HTAVAIL; 1142 if (value & BHND_CCS_HTAVAIL) 1143 fval |= BHND_CCS0_HTAVAIL; 1144 1145 if (mask & BHND_CCS_ALPAVAIL) 1146 fmask |= BHND_CCS0_ALPAVAIL; 1147 if (value & BHND_CCS_ALPAVAIL) 1148 fval |= BHND_CCS0_ALPAVAIL; 1149 1150 mask = fmask; 1151 value = fval; 1152 } 1153 1154 for (u_int i = 0; i < clkctl->cc_max_latency; i += 10) { 1155 clkst = bhnd_bus_read_4(clkctl->cc_res, clkctl->cc_res_offset); 1156 if ((clkst & mask) == (value & mask)) 1157 return (0); 1158 1159 DELAY(10); 1160 } 1161 1162 device_printf(clkctl->cc_dev, "clkst wait timeout (value=%#x, " 1163 "mask=%#x)\n", value, mask); 1164 1165 return (ETIMEDOUT); 1166 } 1167 1168 /** 1169 * Read an NVRAM variable's NUL-terminated string value. 1170 * 1171 * @param dev A bhnd bus child device. 1172 * @param name The NVRAM variable name. 1173 * @param[out] buf A buffer large enough to hold @p len bytes. On 1174 * success, the NUL-terminated string value will be 1175 * written to this buffer. This argment may be NULL if 1176 * the value is not desired. 1177 * @param len The maximum capacity of @p buf. 1178 * @param[out] rlen On success, will be set to the actual size of 1179 * the requested value (including NUL termination). This 1180 * argment may be NULL if the size is not desired. 1181 * 1182 * @retval 0 success 1183 * @retval ENOENT The requested variable was not found. 1184 * @retval ENODEV No valid NVRAM source could be found. 1185 * @retval ENOMEM If @p buf is non-NULL and a buffer of @p len is too 1186 * small to hold the requested value. 1187 * @retval EFTYPE If the variable data cannot be coerced to a valid 1188 * string representation. 1189 * @retval ERANGE If value coercion would overflow @p type. 1190 * @retval non-zero If reading @p name otherwise fails, a regular unix 1191 * error code will be returned. 1192 */ 1193 int 1194 bhnd_nvram_getvar_str(device_t dev, const char *name, char *buf, size_t len, 1195 size_t *rlen) 1196 { 1197 size_t larg; 1198 int error; 1199 1200 larg = len; 1201 error = bhnd_nvram_getvar(dev, name, buf, &larg, 1202 BHND_NVRAM_TYPE_STRING); 1203 if (rlen != NULL) 1204 *rlen = larg; 1205 1206 return (error); 1207 } 1208 1209 /** 1210 * Read an NVRAM variable's unsigned integer value. 1211 * 1212 * @param dev A bhnd bus child device. 1213 * @param name The NVRAM variable name. 1214 * @param[out] value On success, the requested value will be written 1215 * to this pointer. 1216 * @param width The output integer type width (1, 2, or 1217 * 4 bytes). 1218 * 1219 * @retval 0 success 1220 * @retval ENOENT The requested variable was not found. 1221 * @retval ENODEV No valid NVRAM source could be found. 1222 * @retval EFTYPE If the variable data cannot be coerced to a 1223 * a valid unsigned integer representation. 1224 * @retval ERANGE If value coercion would overflow (or underflow) an 1225 * unsigned representation of the given @p width. 1226 * @retval non-zero If reading @p name otherwise fails, a regular unix 1227 * error code will be returned. 1228 */ 1229 int 1230 bhnd_nvram_getvar_uint(device_t dev, const char *name, void *value, int width) 1231 { 1232 bhnd_nvram_type type; 1233 size_t len; 1234 1235 switch (width) { 1236 case 1: 1237 type = BHND_NVRAM_TYPE_UINT8; 1238 break; 1239 case 2: 1240 type = BHND_NVRAM_TYPE_UINT16; 1241 break; 1242 case 4: 1243 type = BHND_NVRAM_TYPE_UINT32; 1244 break; 1245 default: 1246 device_printf(dev, "unsupported NVRAM integer width: %d\n", 1247 width); 1248 return (EINVAL); 1249 } 1250 1251 len = width; 1252 return (bhnd_nvram_getvar(dev, name, value, &len, type)); 1253 } 1254 1255 /** 1256 * Read an NVRAM variable's unsigned 8-bit integer value. 1257 * 1258 * @param dev A bhnd bus child device. 1259 * @param name The NVRAM variable name. 1260 * @param[out] value On success, the requested value will be written 1261 * to this pointer. 1262 * 1263 * @retval 0 success 1264 * @retval ENOENT The requested variable was not found. 1265 * @retval ENODEV No valid NVRAM source could be found. 1266 * @retval EFTYPE If the variable data cannot be coerced to a 1267 * a valid unsigned integer representation. 1268 * @retval ERANGE If value coercion would overflow (or underflow) uint8_t. 1269 * @retval non-zero If reading @p name otherwise fails, a regular unix 1270 * error code will be returned. 1271 */ 1272 int 1273 bhnd_nvram_getvar_uint8(device_t dev, const char *name, uint8_t *value) 1274 { 1275 return (bhnd_nvram_getvar_uint(dev, name, value, sizeof(*value))); 1276 } 1277 1278 /** 1279 * Read an NVRAM variable's unsigned 16-bit integer value. 1280 * 1281 * @param dev A bhnd bus child device. 1282 * @param name The NVRAM variable name. 1283 * @param[out] value On success, the requested value will be written 1284 * to this pointer. 1285 * 1286 * @retval 0 success 1287 * @retval ENOENT The requested variable was not found. 1288 * @retval ENODEV No valid NVRAM source could be found. 1289 * @retval EFTYPE If the variable data cannot be coerced to a 1290 * a valid unsigned integer representation. 1291 * @retval ERANGE If value coercion would overflow (or underflow) 1292 * uint16_t. 1293 * @retval non-zero If reading @p name otherwise fails, a regular unix 1294 * error code will be returned. 1295 */ 1296 int 1297 bhnd_nvram_getvar_uint16(device_t dev, const char *name, uint16_t *value) 1298 { 1299 return (bhnd_nvram_getvar_uint(dev, name, value, sizeof(*value))); 1300 } 1301 1302 /** 1303 * Read an NVRAM variable's unsigned 32-bit integer value. 1304 * 1305 * @param dev A bhnd bus child device. 1306 * @param name The NVRAM variable name. 1307 * @param[out] value On success, the requested value will be written 1308 * to this pointer. 1309 * 1310 * @retval 0 success 1311 * @retval ENOENT The requested variable was not found. 1312 * @retval ENODEV No valid NVRAM source could be found. 1313 * @retval EFTYPE If the variable data cannot be coerced to a 1314 * a valid unsigned integer representation. 1315 * @retval ERANGE If value coercion would overflow (or underflow) 1316 * uint32_t. 1317 * @retval non-zero If reading @p name otherwise fails, a regular unix 1318 * error code will be returned. 1319 */ 1320 int 1321 bhnd_nvram_getvar_uint32(device_t dev, const char *name, uint32_t *value) 1322 { 1323 return (bhnd_nvram_getvar_uint(dev, name, value, sizeof(*value))); 1324 } 1325 1326 /** 1327 * Read an NVRAM variable's signed integer value. 1328 * 1329 * @param dev A bhnd bus child device. 1330 * @param name The NVRAM variable name. 1331 * @param[out] value On success, the requested value will be written 1332 * to this pointer. 1333 * @param width The output integer type width (1, 2, or 1334 * 4 bytes). 1335 * 1336 * @retval 0 success 1337 * @retval ENOENT The requested variable was not found. 1338 * @retval ENODEV No valid NVRAM source could be found. 1339 * @retval EFTYPE If the variable data cannot be coerced to a 1340 * a valid integer representation. 1341 * @retval ERANGE If value coercion would overflow (or underflow) an 1342 * signed representation of the given @p width. 1343 * @retval non-zero If reading @p name otherwise fails, a regular unix 1344 * error code will be returned. 1345 */ 1346 int 1347 bhnd_nvram_getvar_int(device_t dev, const char *name, void *value, int width) 1348 { 1349 bhnd_nvram_type type; 1350 size_t len; 1351 1352 switch (width) { 1353 case 1: 1354 type = BHND_NVRAM_TYPE_INT8; 1355 break; 1356 case 2: 1357 type = BHND_NVRAM_TYPE_INT16; 1358 break; 1359 case 4: 1360 type = BHND_NVRAM_TYPE_INT32; 1361 break; 1362 default: 1363 device_printf(dev, "unsupported NVRAM integer width: %d\n", 1364 width); 1365 return (EINVAL); 1366 } 1367 1368 len = width; 1369 return (bhnd_nvram_getvar(dev, name, value, &len, type)); 1370 } 1371 1372 /** 1373 * Read an NVRAM variable's signed 8-bit integer value. 1374 * 1375 * @param dev A bhnd bus child device. 1376 * @param name The NVRAM variable name. 1377 * @param[out] value On success, the requested value will be written 1378 * to this pointer. 1379 * 1380 * @retval 0 success 1381 * @retval ENOENT The requested variable was not found. 1382 * @retval ENODEV No valid NVRAM source could be found. 1383 * @retval EFTYPE If the variable data cannot be coerced to a 1384 * a valid integer representation. 1385 * @retval ERANGE If value coercion would overflow (or underflow) int8_t. 1386 * @retval non-zero If reading @p name otherwise fails, a regular unix 1387 * error code will be returned. 1388 */ 1389 int 1390 bhnd_nvram_getvar_int8(device_t dev, const char *name, int8_t *value) 1391 { 1392 return (bhnd_nvram_getvar_int(dev, name, value, sizeof(*value))); 1393 } 1394 1395 /** 1396 * Read an NVRAM variable's signed 16-bit integer value. 1397 * 1398 * @param dev A bhnd bus child device. 1399 * @param name The NVRAM variable name. 1400 * @param[out] value On success, the requested value will be written 1401 * to this pointer. 1402 * 1403 * @retval 0 success 1404 * @retval ENOENT The requested variable was not found. 1405 * @retval ENODEV No valid NVRAM source could be found. 1406 * @retval EFTYPE If the variable data cannot be coerced to a 1407 * a valid integer representation. 1408 * @retval ERANGE If value coercion would overflow (or underflow) 1409 * int16_t. 1410 * @retval non-zero If reading @p name otherwise fails, a regular unix 1411 * error code will be returned. 1412 */ 1413 int 1414 bhnd_nvram_getvar_int16(device_t dev, const char *name, int16_t *value) 1415 { 1416 return (bhnd_nvram_getvar_int(dev, name, value, sizeof(*value))); 1417 } 1418 1419 /** 1420 * Read an NVRAM variable's signed 32-bit integer value. 1421 * 1422 * @param dev A bhnd bus child device. 1423 * @param name The NVRAM variable name. 1424 * @param[out] value On success, the requested value will be written 1425 * to this pointer. 1426 * 1427 * @retval 0 success 1428 * @retval ENOENT The requested variable was not found. 1429 * @retval ENODEV No valid NVRAM source could be found. 1430 * @retval EFTYPE If the variable data cannot be coerced to a 1431 * a valid integer representation. 1432 * @retval ERANGE If value coercion would overflow (or underflow) 1433 * int32_t. 1434 * @retval non-zero If reading @p name otherwise fails, a regular unix 1435 * error code will be returned. 1436 */ 1437 int 1438 bhnd_nvram_getvar_int32(device_t dev, const char *name, int32_t *value) 1439 { 1440 return (bhnd_nvram_getvar_int(dev, name, value, sizeof(*value))); 1441 } 1442 1443 /** 1444 * Read an NVRAM variable's array value. 1445 * 1446 * @param dev A bhnd bus child device. 1447 * @param name The NVRAM variable name. 1448 * @param[out] buf A buffer large enough to hold @p size bytes. 1449 * On success, the requested value will be written 1450 * to this buffer. 1451 * @param[in,out] size The required number of bytes to write to 1452 * @p buf. 1453 * @param type The desired array element data representation. 1454 * 1455 * @retval 0 success 1456 * @retval ENOENT The requested variable was not found. 1457 * @retval ENODEV No valid NVRAM source could be found. 1458 * @retval ENXIO If less than @p size bytes are available. 1459 * @retval ENOMEM If a buffer of @p size is too small to hold the 1460 * requested value. 1461 * @retval EFTYPE If the variable data cannot be coerced to a 1462 * a valid instance of @p type. 1463 * @retval ERANGE If value coercion would overflow (or underflow) a 1464 * representation of @p type. 1465 * @retval non-zero If reading @p name otherwise fails, a regular unix 1466 * error code will be returned. 1467 */ 1468 int 1469 bhnd_nvram_getvar_array(device_t dev, const char *name, void *buf, size_t size, 1470 bhnd_nvram_type type) 1471 { 1472 size_t nbytes; 1473 int error; 1474 1475 /* Attempt read */ 1476 nbytes = size; 1477 if ((error = bhnd_nvram_getvar(dev, name, buf, &nbytes, type))) 1478 return (error); 1479 1480 /* Verify that the expected number of bytes were fetched */ 1481 if (nbytes < size) 1482 return (ENXIO); 1483 1484 return (0); 1485 } 1486 1487 /** 1488 * Initialize a service provider registry. 1489 * 1490 * @param bsr The service registry to initialize. 1491 * 1492 * @retval 0 success 1493 * @retval non-zero if an error occurs initializing the service registry, 1494 * a regular unix error code will be returned. 1495 1496 */ 1497 int 1498 bhnd_service_registry_init(struct bhnd_service_registry *bsr) 1499 { 1500 STAILQ_INIT(&bsr->entries); 1501 mtx_init(&bsr->lock, "bhnd_service_registry lock", NULL, MTX_DEF); 1502 1503 return (0); 1504 } 1505 1506 /** 1507 * Release all resources held by @p bsr. 1508 * 1509 * @param bsr A service registry instance previously successfully 1510 * initialized via bhnd_service_registry_init(). 1511 * 1512 * @retval 0 success 1513 * @retval EBUSY if active references to service providers registered 1514 * with @p bsr exist. 1515 */ 1516 int 1517 bhnd_service_registry_fini(struct bhnd_service_registry *bsr) 1518 { 1519 struct bhnd_service_entry *entry, *enext; 1520 1521 /* Remove everthing we can */ 1522 mtx_lock(&bsr->lock); 1523 STAILQ_FOREACH_SAFE(entry, &bsr->entries, link, enext) { 1524 if (entry->refs > 0) 1525 continue; 1526 1527 STAILQ_REMOVE(&bsr->entries, entry, bhnd_service_entry, link); 1528 free(entry, M_BHND); 1529 } 1530 1531 if (!STAILQ_EMPTY(&bsr->entries)) { 1532 mtx_unlock(&bsr->lock); 1533 return (EBUSY); 1534 } 1535 mtx_unlock(&bsr->lock); 1536 1537 mtx_destroy(&bsr->lock); 1538 return (0); 1539 } 1540 1541 /** 1542 * Register a @p provider for the given @p service. 1543 * 1544 * @param bsr Service registry to be modified. 1545 * @param provider Service provider to register. 1546 * @param service Service for which @p provider will be registered. 1547 * @param flags Service provider flags (see BHND_SPF_*). 1548 * 1549 * @retval 0 success 1550 * @retval EEXIST if an entry for @p service already exists. 1551 * @retval EINVAL if @p service is BHND_SERVICE_ANY. 1552 * @retval non-zero if registering @p provider otherwise fails, a regular 1553 * unix error code will be returned. 1554 */ 1555 int 1556 bhnd_service_registry_add(struct bhnd_service_registry *bsr, device_t provider, 1557 bhnd_service_t service, uint32_t flags) 1558 { 1559 struct bhnd_service_entry *entry; 1560 1561 if (service == BHND_SERVICE_ANY) 1562 return (EINVAL); 1563 1564 mtx_lock(&bsr->lock); 1565 1566 /* Is a service provider already registered? */ 1567 STAILQ_FOREACH(entry, &bsr->entries, link) { 1568 if (entry->service == service) { 1569 mtx_unlock(&bsr->lock); 1570 return (EEXIST); 1571 } 1572 } 1573 1574 /* Initialize and insert our new entry */ 1575 entry = malloc(sizeof(*entry), M_BHND, M_NOWAIT); 1576 if (entry == NULL) { 1577 mtx_unlock(&bsr->lock); 1578 return (ENOMEM); 1579 } 1580 1581 entry->provider = provider; 1582 entry->service = service; 1583 entry->flags = flags; 1584 refcount_init(&entry->refs, 0); 1585 1586 STAILQ_INSERT_HEAD(&bsr->entries, entry, link); 1587 1588 mtx_unlock(&bsr->lock); 1589 return (0); 1590 } 1591 1592 /** 1593 * Free an unreferenced registry entry. 1594 * 1595 * @param entry The entry to be deallocated. 1596 */ 1597 static void 1598 bhnd_service_registry_free_entry(struct bhnd_service_entry *entry) 1599 { 1600 KASSERT(entry->refs == 0, ("provider has active references")); 1601 free(entry, M_BHND); 1602 } 1603 1604 /** 1605 * Attempt to remove the @p service provider registration for @p provider. 1606 * 1607 * @param bsr The service registry to be modified. 1608 * @param provider The service provider to be deregistered. 1609 * @param service The service for which @p provider will be deregistered, 1610 * or BHND_SERVICE_ANY to remove all service 1611 * registrations for @p provider. 1612 * 1613 * @retval 0 success 1614 * @retval EBUSY if active references to @p provider exist; see 1615 * bhnd_service_registry_retain() and 1616 * bhnd_service_registry_release(). 1617 */ 1618 int 1619 bhnd_service_registry_remove(struct bhnd_service_registry *bsr, 1620 device_t provider, bhnd_service_t service) 1621 { 1622 struct bhnd_service_entry *entry, *enext; 1623 1624 mtx_lock(&bsr->lock); 1625 1626 #define BHND_PROV_MATCH(_e) \ 1627 ((_e)->provider == provider && \ 1628 (service == BHND_SERVICE_ANY || (_e)->service == service)) 1629 1630 /* Validate matching provider entries before making any 1631 * modifications */ 1632 STAILQ_FOREACH(entry, &bsr->entries, link) { 1633 /* Skip non-matching entries */ 1634 if (!BHND_PROV_MATCH(entry)) 1635 continue; 1636 1637 /* Entry is in use? */ 1638 if (entry->refs > 0) { 1639 mtx_unlock(&bsr->lock); 1640 return (EBUSY); 1641 } 1642 } 1643 1644 /* We can now safely remove matching entries */ 1645 STAILQ_FOREACH_SAFE(entry, &bsr->entries, link, enext) { 1646 /* Skip non-matching entries */ 1647 if (!BHND_PROV_MATCH(entry)) 1648 continue; 1649 1650 /* Remove from list */ 1651 STAILQ_REMOVE(&bsr->entries, entry, bhnd_service_entry, link); 1652 1653 /* Free provider entry */ 1654 bhnd_service_registry_free_entry(entry); 1655 } 1656 #undef BHND_PROV_MATCH 1657 1658 mtx_unlock(&bsr->lock); 1659 return (0); 1660 } 1661 1662 /** 1663 * Retain and return a reference to a registered @p service provider, if any. 1664 * 1665 * @param bsr The service registry to be queried. 1666 * @param service The service for which a provider should be returned. 1667 * 1668 * On success, the caller assumes ownership the returned provider, and 1669 * is responsible for releasing this reference via 1670 * bhnd_service_registry_release(). 1671 * 1672 * @retval device_t success 1673 * @retval NULL if no provider is registered for @p service. 1674 */ 1675 device_t 1676 bhnd_service_registry_retain(struct bhnd_service_registry *bsr, 1677 bhnd_service_t service) 1678 { 1679 struct bhnd_service_entry *entry; 1680 1681 mtx_lock(&bsr->lock); 1682 STAILQ_FOREACH(entry, &bsr->entries, link) { 1683 if (entry->service != service) 1684 continue; 1685 1686 /* With a live refcount, entry is gauranteed to remain alive 1687 * after we release our lock */ 1688 refcount_acquire(&entry->refs); 1689 1690 mtx_unlock(&bsr->lock); 1691 return (entry->provider); 1692 } 1693 mtx_unlock(&bsr->lock); 1694 1695 /* Not found */ 1696 return (NULL); 1697 } 1698 1699 /** 1700 * Release a reference to a service provider previously returned by 1701 * bhnd_service_registry_retain(). 1702 * 1703 * If this is the last reference to an inherited service provider registration 1704 * (see BHND_SPF_INHERITED), the registration will also be removed, and 1705 * true will be returned. 1706 * 1707 * @param bsr The service registry from which @p provider 1708 * was returned. 1709 * @param provider The provider to be released. 1710 * @param service The service for which @p provider was previously 1711 * retained. 1712 * @retval true The inherited service provider registration was removed; 1713 * the caller should release its own reference to the 1714 * provider. 1715 * @retval false The service provider was not inherited, or active 1716 * references to the provider remain. 1717 * 1718 * @see BHND_SPF_INHERITED 1719 */ 1720 bool 1721 bhnd_service_registry_release(struct bhnd_service_registry *bsr, 1722 device_t provider, bhnd_service_t service) 1723 { 1724 struct bhnd_service_entry *entry; 1725 1726 /* Exclusive lock, as we need to prevent any new references to the 1727 * entry from being taken if it's to be removed */ 1728 mtx_lock(&bsr->lock); 1729 STAILQ_FOREACH(entry, &bsr->entries, link) { 1730 bool removed; 1731 1732 if (entry->provider != provider) 1733 continue; 1734 1735 if (entry->service != service) 1736 continue; 1737 1738 if (refcount_release(&entry->refs) && 1739 (entry->flags & BHND_SPF_INHERITED)) 1740 { 1741 /* If an inherited entry is no longer actively 1742 * referenced, remove the local registration and inform 1743 * the caller. */ 1744 STAILQ_REMOVE(&bsr->entries, entry, bhnd_service_entry, 1745 link); 1746 bhnd_service_registry_free_entry(entry); 1747 removed = true; 1748 } else { 1749 removed = false; 1750 } 1751 1752 mtx_unlock(&bsr->lock); 1753 return (removed); 1754 } 1755 1756 /* Caller owns a reference, but no such provider is registered? */ 1757 panic("invalid service provider reference"); 1758 } 1759 1760 /** 1761 * Using the bhnd(4) bus-level core information and a custom core name, 1762 * populate @p dev's device description. 1763 * 1764 * @param dev A bhnd-bus attached device. 1765 * @param dev_name The core's name (e.g. "SDIO Device Core"). 1766 */ 1767 void 1768 bhnd_set_custom_core_desc(device_t dev, const char *dev_name) 1769 { 1770 const char *vendor_name; 1771 char *desc; 1772 1773 vendor_name = bhnd_get_vendor_name(dev); 1774 asprintf(&desc, M_BHND, "%s %s, rev %hhu", vendor_name, dev_name, 1775 bhnd_get_hwrev(dev)); 1776 1777 if (desc != NULL) { 1778 device_set_desc_copy(dev, desc); 1779 free(desc, M_BHND); 1780 } else { 1781 device_set_desc(dev, dev_name); 1782 } 1783 } 1784 1785 /** 1786 * Using the bhnd(4) bus-level core information, populate @p dev's device 1787 * description. 1788 * 1789 * @param dev A bhnd-bus attached device. 1790 */ 1791 void 1792 bhnd_set_default_core_desc(device_t dev) 1793 { 1794 bhnd_set_custom_core_desc(dev, bhnd_get_device_name(dev)); 1795 } 1796 1797 /** 1798 * Using the bhnd @p chip_id, populate the bhnd(4) bus @p dev's device 1799 * description. 1800 * 1801 * @param dev A bhnd-bus attached device. 1802 * @param chip_id The chip identification. 1803 */ 1804 void 1805 bhnd_set_default_bus_desc(device_t dev, const struct bhnd_chipid *chip_id) 1806 { 1807 const char *bus_name; 1808 char *desc; 1809 char chip_name[BHND_CHIPID_MAX_NAMELEN]; 1810 1811 /* Determine chip type's bus name */ 1812 switch (chip_id->chip_type) { 1813 case BHND_CHIPTYPE_SIBA: 1814 bus_name = "SIBA bus"; 1815 break; 1816 case BHND_CHIPTYPE_BCMA: 1817 case BHND_CHIPTYPE_BCMA_ALT: 1818 bus_name = "BCMA bus"; 1819 break; 1820 case BHND_CHIPTYPE_UBUS: 1821 bus_name = "UBUS bus"; 1822 break; 1823 default: 1824 bus_name = "Unknown Type"; 1825 break; 1826 } 1827 1828 /* Format chip name */ 1829 bhnd_format_chip_id(chip_name, sizeof(chip_name), 1830 chip_id->chip_id); 1831 1832 /* Format and set device description */ 1833 asprintf(&desc, M_BHND, "%s %s", chip_name, bus_name); 1834 if (desc != NULL) { 1835 device_set_desc_copy(dev, desc); 1836 free(desc, M_BHND); 1837 } else { 1838 device_set_desc(dev, bus_name); 1839 } 1840 1841 } 1842 1843 /** 1844 * Helper function for implementing BHND_BUS_REGISTER_PROVIDER(). 1845 * 1846 * This implementation delegates the request to the BHND_BUS_REGISTER_PROVIDER() 1847 * method on the parent of @p dev. If no parent exists, the implementation 1848 * will return an error. 1849 */ 1850 int 1851 bhnd_bus_generic_register_provider(device_t dev, device_t child, 1852 device_t provider, bhnd_service_t service) 1853 { 1854 device_t parent = device_get_parent(dev); 1855 1856 if (parent != NULL) { 1857 return (BHND_BUS_REGISTER_PROVIDER(parent, child, 1858 provider, service)); 1859 } 1860 1861 return (ENXIO); 1862 } 1863 1864 /** 1865 * Helper function for implementing BHND_BUS_DEREGISTER_PROVIDER(). 1866 * 1867 * This implementation delegates the request to the 1868 * BHND_BUS_DEREGISTER_PROVIDER() method on the parent of @p dev. If no parent 1869 * exists, the implementation will panic. 1870 */ 1871 int 1872 bhnd_bus_generic_deregister_provider(device_t dev, device_t child, 1873 device_t provider, bhnd_service_t service) 1874 { 1875 device_t parent = device_get_parent(dev); 1876 1877 if (parent != NULL) { 1878 return (BHND_BUS_DEREGISTER_PROVIDER(parent, child, 1879 provider, service)); 1880 } 1881 1882 panic("missing BHND_BUS_DEREGISTER_PROVIDER()"); 1883 } 1884 1885 /** 1886 * Helper function for implementing BHND_BUS_RETAIN_PROVIDER(). 1887 * 1888 * This implementation delegates the request to the 1889 * BHND_BUS_DEREGISTER_PROVIDER() method on the parent of @p dev. If no parent 1890 * exists, the implementation will return NULL. 1891 */ 1892 device_t 1893 bhnd_bus_generic_retain_provider(device_t dev, device_t child, 1894 bhnd_service_t service) 1895 { 1896 device_t parent = device_get_parent(dev); 1897 1898 if (parent != NULL) { 1899 return (BHND_BUS_RETAIN_PROVIDER(parent, child, 1900 service)); 1901 } 1902 1903 return (NULL); 1904 } 1905 1906 /** 1907 * Helper function for implementing BHND_BUS_RELEASE_PROVIDER(). 1908 * 1909 * This implementation delegates the request to the 1910 * BHND_BUS_DEREGISTER_PROVIDER() method on the parent of @p dev. If no parent 1911 * exists, the implementation will panic. 1912 */ 1913 void 1914 bhnd_bus_generic_release_provider(device_t dev, device_t child, 1915 device_t provider, bhnd_service_t service) 1916 { 1917 device_t parent = device_get_parent(dev); 1918 1919 if (parent != NULL) { 1920 return (BHND_BUS_RELEASE_PROVIDER(parent, child, 1921 provider, service)); 1922 } 1923 1924 panic("missing BHND_BUS_RELEASE_PROVIDER()"); 1925 } 1926 1927 /** 1928 * Helper function for implementing BHND_BUS_REGISTER_PROVIDER(). 1929 * 1930 * This implementation uses the bhnd_service_registry_add() function to 1931 * do most of the work. It calls BHND_BUS_GET_SERVICE_REGISTRY() to find 1932 * a suitable service registry to edit. 1933 */ 1934 int 1935 bhnd_bus_generic_sr_register_provider(device_t dev, device_t child, 1936 device_t provider, bhnd_service_t service) 1937 { 1938 struct bhnd_service_registry *bsr; 1939 1940 bsr = BHND_BUS_GET_SERVICE_REGISTRY(dev, child); 1941 1942 KASSERT(bsr != NULL, ("NULL service registry")); 1943 1944 return (bhnd_service_registry_add(bsr, provider, service, 0)); 1945 } 1946 1947 /** 1948 * Helper function for implementing BHND_BUS_DEREGISTER_PROVIDER(). 1949 * 1950 * This implementation uses the bhnd_service_registry_remove() function to 1951 * do most of the work. It calls BHND_BUS_GET_SERVICE_REGISTRY() to find 1952 * a suitable service registry to edit. 1953 */ 1954 int 1955 bhnd_bus_generic_sr_deregister_provider(device_t dev, device_t child, 1956 device_t provider, bhnd_service_t service) 1957 { 1958 struct bhnd_service_registry *bsr; 1959 1960 bsr = BHND_BUS_GET_SERVICE_REGISTRY(dev, child); 1961 1962 KASSERT(bsr != NULL, ("NULL service registry")); 1963 1964 return (bhnd_service_registry_remove(bsr, provider, service)); 1965 } 1966 1967 /** 1968 * Helper function for implementing BHND_BUS_RETAIN_PROVIDER(). 1969 * 1970 * This implementation uses the bhnd_service_registry_retain() function to 1971 * do most of the work. It calls BHND_BUS_GET_SERVICE_REGISTRY() to find 1972 * a suitable service registry. 1973 * 1974 * If a local provider for the service is not available, and a parent device is 1975 * available, this implementation will attempt to fetch and locally register 1976 * a service provider reference from the parent of @p dev. 1977 */ 1978 device_t 1979 bhnd_bus_generic_sr_retain_provider(device_t dev, device_t child, 1980 bhnd_service_t service) 1981 { 1982 struct bhnd_service_registry *bsr; 1983 device_t parent, provider; 1984 int error; 1985 1986 bsr = BHND_BUS_GET_SERVICE_REGISTRY(dev, child); 1987 KASSERT(bsr != NULL, ("NULL service registry")); 1988 1989 /* 1990 * Attempt to fetch a service provider reference from either the local 1991 * service registry, or if not found, from our parent. 1992 * 1993 * If we fetch a provider from our parent, we register the provider 1994 * with the local service registry to prevent conflicting local 1995 * registrations from being added. 1996 */ 1997 while (1) { 1998 /* Check the local service registry first */ 1999 provider = bhnd_service_registry_retain(bsr, service); 2000 if (provider != NULL) 2001 return (provider); 2002 2003 /* Otherwise, try to delegate to our parent (if any) */ 2004 if ((parent = device_get_parent(dev)) == NULL) 2005 return (NULL); 2006 2007 provider = BHND_BUS_RETAIN_PROVIDER(parent, dev, service); 2008 if (provider == NULL) 2009 return (NULL); 2010 2011 /* Register the inherited service registration with the local 2012 * registry */ 2013 error = bhnd_service_registry_add(bsr, provider, service, 2014 BHND_SPF_INHERITED); 2015 if (error) { 2016 BHND_BUS_RELEASE_PROVIDER(parent, dev, provider, 2017 service); 2018 if (error == EEXIST) { 2019 /* A valid service provider was registered 2020 * concurrently; retry fetching from the local 2021 * registry */ 2022 continue; 2023 } 2024 2025 device_printf(dev, "failed to register service " 2026 "provider: %d\n", error); 2027 return (NULL); 2028 } 2029 } 2030 } 2031 2032 /** 2033 * Helper function for implementing BHND_BUS_RELEASE_PROVIDER(). 2034 * 2035 * This implementation uses the bhnd_service_registry_release() function to 2036 * do most of the work. It calls BHND_BUS_GET_SERVICE_REGISTRY() to find 2037 * a suitable service registry. 2038 */ 2039 void 2040 bhnd_bus_generic_sr_release_provider(device_t dev, device_t child, 2041 device_t provider, bhnd_service_t service) 2042 { 2043 struct bhnd_service_registry *bsr; 2044 2045 bsr = BHND_BUS_GET_SERVICE_REGISTRY(dev, child); 2046 KASSERT(bsr != NULL, ("NULL service registry")); 2047 2048 /* Release the provider reference; if the refcount hits zero on an 2049 * inherited reference, true will be returned, and we need to drop 2050 * our own bus reference to the provider */ 2051 if (!bhnd_service_registry_release(bsr, provider, service)) 2052 return; 2053 2054 /* Drop our reference to the borrowed provider */ 2055 BHND_BUS_RELEASE_PROVIDER(device_get_parent(dev), dev, provider, 2056 service); 2057 } 2058 2059 /** 2060 * Helper function for implementing BHND_BUS_IS_HW_DISABLED(). 2061 * 2062 * If a parent device is available, this implementation delegates the 2063 * request to the BHND_BUS_IS_HW_DISABLED() method on the parent of @p dev. 2064 * 2065 * If no parent device is available (i.e. on a the bus root), the hardware 2066 * is assumed to be usable and false is returned. 2067 */ 2068 bool 2069 bhnd_bus_generic_is_hw_disabled(device_t dev, device_t child) 2070 { 2071 if (device_get_parent(dev) != NULL) 2072 return (BHND_BUS_IS_HW_DISABLED(device_get_parent(dev), child)); 2073 2074 return (false); 2075 } 2076 2077 /** 2078 * Helper function for implementing BHND_BUS_GET_CHIPID(). 2079 * 2080 * This implementation delegates the request to the BHND_BUS_GET_CHIPID() 2081 * method on the parent of @p dev. If no parent exists, the implementation 2082 * will panic. 2083 */ 2084 const struct bhnd_chipid * 2085 bhnd_bus_generic_get_chipid(device_t dev, device_t child) 2086 { 2087 if (device_get_parent(dev) != NULL) 2088 return (BHND_BUS_GET_CHIPID(device_get_parent(dev), child)); 2089 2090 panic("missing BHND_BUS_GET_CHIPID()"); 2091 } 2092 2093 /** 2094 * Helper function for implementing BHND_BUS_GET_DMA_TRANSLATION(). 2095 * 2096 * If a parent device is available, this implementation delegates the 2097 * request to the BHND_BUS_GET_DMA_TRANSLATION() method on the parent of @p dev. 2098 * 2099 * If no parent device is available, this implementation will panic. 2100 */ 2101 int 2102 bhnd_bus_generic_get_dma_translation(device_t dev, device_t child, u_int width, 2103 uint32_t flags, bus_dma_tag_t *dmat, 2104 struct bhnd_dma_translation *translation) 2105 { 2106 if (device_get_parent(dev) != NULL) { 2107 return (BHND_BUS_GET_DMA_TRANSLATION(device_get_parent(dev), 2108 child, width, flags, dmat, translation)); 2109 } 2110 2111 panic("missing BHND_BUS_GET_DMA_TRANSLATION()"); 2112 } 2113 2114 /* nvram board_info population macros for bhnd_bus_generic_read_board_info() */ 2115 #define BHND_GV(_dest, _name) \ 2116 bhnd_nvram_getvar_uint(child, BHND_NVAR_ ## _name, &_dest, \ 2117 sizeof(_dest)) 2118 2119 #define REQ_BHND_GV(_dest, _name) do { \ 2120 if ((error = BHND_GV(_dest, _name))) { \ 2121 device_printf(dev, \ 2122 "error reading " __STRING(_name) ": %d\n", error); \ 2123 return (error); \ 2124 } \ 2125 } while(0) 2126 2127 #define OPT_BHND_GV(_dest, _name, _default) do { \ 2128 if ((error = BHND_GV(_dest, _name))) { \ 2129 if (error != ENOENT) { \ 2130 device_printf(dev, \ 2131 "error reading " \ 2132 __STRING(_name) ": %d\n", error); \ 2133 return (error); \ 2134 } \ 2135 _dest = _default; \ 2136 } \ 2137 } while(0) 2138 2139 /** 2140 * Helper function for implementing BHND_BUS_READ_BOARDINFO(). 2141 * 2142 * This implementation populates @p info with information from NVRAM, 2143 * defaulting board_vendor and board_type fields to 0 if the 2144 * requested variables cannot be found. 2145 * 2146 * This behavior is correct for most SoCs, but must be overridden on 2147 * bridged (PCI, PCMCIA, etc) devices to produce a complete bhnd_board_info 2148 * result. 2149 */ 2150 int 2151 bhnd_bus_generic_read_board_info(device_t dev, device_t child, 2152 struct bhnd_board_info *info) 2153 { 2154 int error; 2155 2156 OPT_BHND_GV(info->board_vendor, BOARDVENDOR, 0); 2157 OPT_BHND_GV(info->board_type, BOARDTYPE, 0); /* srom >= 2 */ 2158 OPT_BHND_GV(info->board_devid, DEVID, 0); /* srom >= 8 */ 2159 REQ_BHND_GV(info->board_rev, BOARDREV); 2160 OPT_BHND_GV(info->board_srom_rev,SROMREV, 0); /* missing in 2161 some SoC 2162 NVRAM */ 2163 REQ_BHND_GV(info->board_flags, BOARDFLAGS); 2164 OPT_BHND_GV(info->board_flags2, BOARDFLAGS2, 0); /* srom >= 4 */ 2165 OPT_BHND_GV(info->board_flags3, BOARDFLAGS3, 0); /* srom >= 11 */ 2166 2167 return (0); 2168 } 2169 2170 #undef BHND_GV 2171 #undef BHND_GV_REQ 2172 #undef BHND_GV_OPT 2173 2174 /** 2175 * Helper function for implementing BHND_BUS_GET_NVRAM_VAR(). 2176 * 2177 * This implementation searches @p dev for a usable NVRAM child device. 2178 * 2179 * If no usable child device is found on @p dev, the request is delegated to 2180 * the BHND_BUS_GET_NVRAM_VAR() method on the parent of @p dev. 2181 */ 2182 int 2183 bhnd_bus_generic_get_nvram_var(device_t dev, device_t child, const char *name, 2184 void *buf, size_t *size, bhnd_nvram_type type) 2185 { 2186 device_t nvram; 2187 device_t parent; 2188 2189 bus_topo_assert(); 2190 2191 /* Look for a directly-attached NVRAM child */ 2192 if ((nvram = device_find_child(dev, "bhnd_nvram", -1)) != NULL) 2193 return BHND_NVRAM_GETVAR(nvram, name, buf, size, type); 2194 2195 /* Try to delegate to parent */ 2196 if ((parent = device_get_parent(dev)) == NULL) 2197 return (ENODEV); 2198 2199 return (BHND_BUS_GET_NVRAM_VAR(device_get_parent(dev), child, 2200 name, buf, size, type)); 2201 } 2202 2203 /** 2204 * Helper function for implementing BHND_BUS_ALLOC_RESOURCE(). 2205 * 2206 * This implementation of BHND_BUS_ALLOC_RESOURCE() delegates allocation 2207 * of the underlying resource to BUS_ALLOC_RESOURCE(), and activation 2208 * to @p dev's BHND_BUS_ACTIVATE_RESOURCE(). 2209 */ 2210 struct bhnd_resource * 2211 bhnd_bus_generic_alloc_resource(device_t dev, device_t child, int type, 2212 int *rid, rman_res_t start, rman_res_t end, rman_res_t count, 2213 u_int flags) 2214 { 2215 struct bhnd_resource *br; 2216 struct resource *res; 2217 int error; 2218 2219 br = NULL; 2220 res = NULL; 2221 2222 /* Allocate the real bus resource (without activating it) */ 2223 res = BUS_ALLOC_RESOURCE(dev, child, type, rid, start, end, count, 2224 (flags & ~RF_ACTIVE)); 2225 if (res == NULL) 2226 return (NULL); 2227 2228 /* Allocate our bhnd resource wrapper. */ 2229 br = malloc(sizeof(struct bhnd_resource), M_BHND, M_NOWAIT); 2230 if (br == NULL) 2231 goto failed; 2232 2233 br->direct = false; 2234 br->res = res; 2235 2236 /* Attempt activation */ 2237 if (flags & RF_ACTIVE) { 2238 error = BHND_BUS_ACTIVATE_RESOURCE(dev, child, type, *rid, br); 2239 if (error) 2240 goto failed; 2241 } 2242 2243 return (br); 2244 2245 failed: 2246 if (res != NULL) 2247 BUS_RELEASE_RESOURCE(dev, child, type, *rid, res); 2248 2249 free(br, M_BHND); 2250 return (NULL); 2251 } 2252 2253 /** 2254 * Helper function for implementing BHND_BUS_RELEASE_RESOURCE(). 2255 * 2256 * This implementation of BHND_BUS_RELEASE_RESOURCE() delegates release of 2257 * the backing resource to BUS_RELEASE_RESOURCE(). 2258 */ 2259 int 2260 bhnd_bus_generic_release_resource(device_t dev, device_t child, int type, 2261 int rid, struct bhnd_resource *r) 2262 { 2263 int error; 2264 2265 if ((error = BUS_RELEASE_RESOURCE(dev, child, type, rid, r->res))) 2266 return (error); 2267 2268 free(r, M_BHND); 2269 return (0); 2270 } 2271 2272 /** 2273 * Helper function for implementing BHND_BUS_ACTIVATE_RESOURCE(). 2274 * 2275 * This implementation of BHND_BUS_ACTIVATE_RESOURCE() first calls the 2276 * BHND_BUS_ACTIVATE_RESOURCE() method of the parent of @p dev. 2277 * 2278 * If this fails, and if @p dev is the direct parent of @p child, standard 2279 * resource activation is attempted via bus_activate_resource(). This enables 2280 * direct use of the bhnd(4) resource APIs on devices that may not be attached 2281 * to a parent bhnd bus or bridge. 2282 */ 2283 int 2284 bhnd_bus_generic_activate_resource(device_t dev, device_t child, int type, 2285 int rid, struct bhnd_resource *r) 2286 { 2287 int error; 2288 bool passthrough; 2289 2290 passthrough = (device_get_parent(child) != dev); 2291 2292 /* Try to delegate to the parent */ 2293 if (device_get_parent(dev) != NULL) { 2294 error = BHND_BUS_ACTIVATE_RESOURCE(device_get_parent(dev), 2295 child, type, rid, r); 2296 } else { 2297 error = ENODEV; 2298 } 2299 2300 /* If bhnd(4) activation has failed and we're the child's direct 2301 * parent, try falling back on standard resource activation. 2302 */ 2303 if (error && !passthrough) { 2304 error = bus_activate_resource(child, type, rid, r->res); 2305 if (!error) 2306 r->direct = true; 2307 } 2308 2309 return (error); 2310 } 2311 2312 /** 2313 * Helper function for implementing BHND_BUS_DEACTIVATE_RESOURCE(). 2314 * 2315 * This implementation of BHND_BUS_ACTIVATE_RESOURCE() simply calls the 2316 * BHND_BUS_ACTIVATE_RESOURCE() method of the parent of @p dev. 2317 */ 2318 int 2319 bhnd_bus_generic_deactivate_resource(device_t dev, device_t child, 2320 int type, int rid, struct bhnd_resource *r) 2321 { 2322 if (device_get_parent(dev) != NULL) 2323 return (BHND_BUS_DEACTIVATE_RESOURCE(device_get_parent(dev), 2324 child, type, rid, r)); 2325 2326 return (EINVAL); 2327 } 2328 2329 /** 2330 * Helper function for implementing BHND_BUS_GET_INTR_DOMAIN(). 2331 * 2332 * This implementation simply returns the address of nearest bhnd(4) bus, 2333 * which may be @p dev; this behavior may be incompatible with FDT/OFW targets. 2334 */ 2335 uintptr_t 2336 bhnd_bus_generic_get_intr_domain(device_t dev, device_t child, bool self) 2337 { 2338 return ((uintptr_t)dev); 2339 } 2340