1 /*- 2 * SPDX-License-Identifier: BSD-2-Clause 3 * 4 * Copyright (c) 1997,1998,2003 Doug Rabson 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 * SUCH DAMAGE. 27 */ 28 29 #include <sys/cdefs.h> 30 #include "opt_bus.h" 31 #include "opt_ddb.h" 32 #include "opt_iommu.h" 33 34 #include <sys/param.h> 35 #include <sys/conf.h> 36 #include <sys/domainset.h> 37 #include <sys/eventhandler.h> 38 #include <sys/jail.h> 39 #include <sys/lock.h> 40 #include <sys/kernel.h> 41 #include <sys/limits.h> 42 #include <sys/malloc.h> 43 #include <sys/module.h> 44 #include <sys/mutex.h> 45 #include <sys/priv.h> 46 #include <machine/bus.h> 47 #include <sys/random.h> 48 #include <sys/refcount.h> 49 #include <sys/rman.h> 50 #include <sys/sbuf.h> 51 #include <sys/smp.h> 52 #include <sys/sysctl.h> 53 #include <sys/systm.h> 54 #include <sys/bus.h> 55 #include <sys/cpuset.h> 56 #ifdef INTRNG 57 #include <sys/intr.h> 58 #endif 59 60 #include <net/vnet.h> 61 62 #include <machine/cpu.h> 63 #include <machine/stdarg.h> 64 65 #include <vm/uma.h> 66 #include <vm/vm.h> 67 68 #include <dev/iommu/iommu.h> 69 70 #include <ddb/ddb.h> 71 72 SYSCTL_NODE(_hw, OID_AUTO, bus, CTLFLAG_RW | CTLFLAG_MPSAFE, NULL, 73 NULL); 74 SYSCTL_ROOT_NODE(OID_AUTO, dev, CTLFLAG_RW | CTLFLAG_MPSAFE, NULL, 75 NULL); 76 77 static bool disable_failed_devs = false; 78 SYSCTL_BOOL(_hw_bus, OID_AUTO, disable_failed_devices, CTLFLAG_RWTUN, &disable_failed_devs, 79 0, "Do not retry attaching devices that return an error from DEVICE_ATTACH the first time"); 80 81 /* 82 * Used to attach drivers to devclasses. 83 */ 84 typedef struct driverlink *driverlink_t; 85 struct driverlink { 86 kobj_class_t driver; 87 TAILQ_ENTRY(driverlink) link; /* list of drivers in devclass */ 88 int pass; 89 int flags; 90 #define DL_DEFERRED_PROBE 1 /* Probe deferred on this */ 91 TAILQ_ENTRY(driverlink) passlink; 92 }; 93 94 /* 95 * Forward declarations 96 */ 97 typedef TAILQ_HEAD(devclass_list, devclass) devclass_list_t; 98 typedef TAILQ_HEAD(driver_list, driverlink) driver_list_t; 99 typedef TAILQ_HEAD(device_list, _device) device_list_t; 100 101 struct devclass { 102 TAILQ_ENTRY(devclass) link; 103 devclass_t parent; /* parent in devclass hierarchy */ 104 driver_list_t drivers; /* bus devclasses store drivers for bus */ 105 char *name; 106 device_t *devices; /* array of devices indexed by unit */ 107 int maxunit; /* size of devices array */ 108 int flags; 109 #define DC_HAS_CHILDREN 1 110 111 struct sysctl_ctx_list sysctl_ctx; 112 struct sysctl_oid *sysctl_tree; 113 }; 114 115 struct device_prop_elm { 116 const char *name; 117 void *val; 118 void *dtr_ctx; 119 device_prop_dtr_t dtr; 120 LIST_ENTRY(device_prop_elm) link; 121 }; 122 123 static void device_destroy_props(device_t dev); 124 125 /** 126 * @brief Implementation of _device. 127 * 128 * The structure is named "_device" instead of "device" to avoid type confusion 129 * caused by other subsystems defining a (struct device). 130 */ 131 struct _device { 132 /* 133 * A device is a kernel object. The first field must be the 134 * current ops table for the object. 135 */ 136 KOBJ_FIELDS; 137 138 /* 139 * Device hierarchy. 140 */ 141 TAILQ_ENTRY(_device) link; /**< list of devices in parent */ 142 TAILQ_ENTRY(_device) devlink; /**< global device list membership */ 143 device_t parent; /**< parent of this device */ 144 device_list_t children; /**< list of child devices */ 145 146 /* 147 * Details of this device. 148 */ 149 driver_t *driver; /**< current driver */ 150 devclass_t devclass; /**< current device class */ 151 int unit; /**< current unit number */ 152 char* nameunit; /**< name+unit e.g. foodev0 */ 153 char* desc; /**< driver specific description */ 154 u_int busy; /**< count of calls to device_busy() */ 155 device_state_t state; /**< current device state */ 156 uint32_t devflags; /**< api level flags for device_get_flags() */ 157 u_int flags; /**< internal device flags */ 158 u_int order; /**< order from device_add_child_ordered() */ 159 void *ivars; /**< instance variables */ 160 void *softc; /**< current driver's variables */ 161 LIST_HEAD(, device_prop_elm) props; 162 163 struct sysctl_ctx_list sysctl_ctx; /**< state for sysctl variables */ 164 struct sysctl_oid *sysctl_tree; /**< state for sysctl variables */ 165 }; 166 167 static MALLOC_DEFINE(M_BUS, "bus", "Bus data structures"); 168 static MALLOC_DEFINE(M_BUS_SC, "bus-sc", "Bus data structures, softc"); 169 170 EVENTHANDLER_LIST_DEFINE(device_attach); 171 EVENTHANDLER_LIST_DEFINE(device_detach); 172 EVENTHANDLER_LIST_DEFINE(device_nomatch); 173 EVENTHANDLER_LIST_DEFINE(dev_lookup); 174 175 static void devctl2_init(void); 176 static bool device_frozen; 177 178 #define DRIVERNAME(d) ((d)? d->name : "no driver") 179 #define DEVCLANAME(d) ((d)? d->name : "no devclass") 180 181 #ifdef BUS_DEBUG 182 183 static int bus_debug = 1; 184 SYSCTL_INT(_debug, OID_AUTO, bus_debug, CTLFLAG_RWTUN, &bus_debug, 0, 185 "Bus debug level"); 186 #define PDEBUG(a) if (bus_debug) {printf("%s:%d: ", __func__, __LINE__), printf a; printf("\n");} 187 #define DEVICENAME(d) ((d)? device_get_name(d): "no device") 188 189 /** 190 * Produce the indenting, indent*2 spaces plus a '.' ahead of that to 191 * prevent syslog from deleting initial spaces 192 */ 193 #define indentprintf(p) do { int iJ; printf("."); for (iJ=0; iJ<indent; iJ++) printf(" "); printf p ; } while (0) 194 195 static void print_device_short(device_t dev, int indent); 196 static void print_device(device_t dev, int indent); 197 void print_device_tree_short(device_t dev, int indent); 198 void print_device_tree(device_t dev, int indent); 199 static void print_driver_short(driver_t *driver, int indent); 200 static void print_driver(driver_t *driver, int indent); 201 static void print_driver_list(driver_list_t drivers, int indent); 202 static void print_devclass_short(devclass_t dc, int indent); 203 static void print_devclass(devclass_t dc, int indent); 204 void print_devclass_list_short(void); 205 void print_devclass_list(void); 206 207 #else 208 /* Make the compiler ignore the function calls */ 209 #define PDEBUG(a) /* nop */ 210 #define DEVICENAME(d) /* nop */ 211 212 #define print_device_short(d,i) /* nop */ 213 #define print_device(d,i) /* nop */ 214 #define print_device_tree_short(d,i) /* nop */ 215 #define print_device_tree(d,i) /* nop */ 216 #define print_driver_short(d,i) /* nop */ 217 #define print_driver(d,i) /* nop */ 218 #define print_driver_list(d,i) /* nop */ 219 #define print_devclass_short(d,i) /* nop */ 220 #define print_devclass(d,i) /* nop */ 221 #define print_devclass_list_short() /* nop */ 222 #define print_devclass_list() /* nop */ 223 #endif 224 225 /* 226 * dev sysctl tree 227 */ 228 229 enum { 230 DEVCLASS_SYSCTL_PARENT, 231 }; 232 233 static int 234 devclass_sysctl_handler(SYSCTL_HANDLER_ARGS) 235 { 236 devclass_t dc = (devclass_t)arg1; 237 const char *value; 238 239 switch (arg2) { 240 case DEVCLASS_SYSCTL_PARENT: 241 value = dc->parent ? dc->parent->name : ""; 242 break; 243 default: 244 return (EINVAL); 245 } 246 return (SYSCTL_OUT_STR(req, value)); 247 } 248 249 static void 250 devclass_sysctl_init(devclass_t dc) 251 { 252 if (dc->sysctl_tree != NULL) 253 return; 254 sysctl_ctx_init(&dc->sysctl_ctx); 255 dc->sysctl_tree = SYSCTL_ADD_NODE(&dc->sysctl_ctx, 256 SYSCTL_STATIC_CHILDREN(_dev), OID_AUTO, dc->name, 257 CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, ""); 258 SYSCTL_ADD_PROC(&dc->sysctl_ctx, SYSCTL_CHILDREN(dc->sysctl_tree), 259 OID_AUTO, "%parent", 260 CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, 261 dc, DEVCLASS_SYSCTL_PARENT, devclass_sysctl_handler, "A", 262 "parent class"); 263 } 264 265 enum { 266 DEVICE_SYSCTL_DESC, 267 DEVICE_SYSCTL_DRIVER, 268 DEVICE_SYSCTL_LOCATION, 269 DEVICE_SYSCTL_PNPINFO, 270 DEVICE_SYSCTL_PARENT, 271 DEVICE_SYSCTL_IOMMU, 272 }; 273 274 static int 275 device_sysctl_handler(SYSCTL_HANDLER_ARGS) 276 { 277 struct sbuf sb; 278 device_t dev = (device_t)arg1; 279 device_t iommu; 280 int error; 281 uint16_t rid; 282 const char *c; 283 284 sbuf_new_for_sysctl(&sb, NULL, 1024, req); 285 sbuf_clear_flags(&sb, SBUF_INCLUDENUL); 286 bus_topo_lock(); 287 switch (arg2) { 288 case DEVICE_SYSCTL_DESC: 289 sbuf_cat(&sb, dev->desc ? dev->desc : ""); 290 break; 291 case DEVICE_SYSCTL_DRIVER: 292 sbuf_cat(&sb, dev->driver ? dev->driver->name : ""); 293 break; 294 case DEVICE_SYSCTL_LOCATION: 295 bus_child_location(dev, &sb); 296 break; 297 case DEVICE_SYSCTL_PNPINFO: 298 bus_child_pnpinfo(dev, &sb); 299 break; 300 case DEVICE_SYSCTL_PARENT: 301 sbuf_cat(&sb, dev->parent ? dev->parent->nameunit : ""); 302 break; 303 case DEVICE_SYSCTL_IOMMU: 304 iommu = NULL; 305 error = device_get_prop(dev, DEV_PROP_NAME_IOMMU, 306 (void **)&iommu); 307 c = ""; 308 if (error == 0 && iommu != NULL) { 309 sbuf_printf(&sb, "unit=%s", device_get_nameunit(iommu)); 310 c = " "; 311 } 312 rid = 0; 313 #ifdef IOMMU 314 iommu_get_requester(dev, &rid); 315 #endif 316 if (rid != 0) 317 sbuf_printf(&sb, "%srid=%#x", c, rid); 318 break; 319 default: 320 error = EINVAL; 321 goto out; 322 } 323 error = sbuf_finish(&sb); 324 out: 325 bus_topo_unlock(); 326 sbuf_delete(&sb); 327 return (error); 328 } 329 330 static void 331 device_sysctl_init(device_t dev) 332 { 333 devclass_t dc = dev->devclass; 334 int domain; 335 336 if (dev->sysctl_tree != NULL) 337 return; 338 devclass_sysctl_init(dc); 339 sysctl_ctx_init(&dev->sysctl_ctx); 340 dev->sysctl_tree = SYSCTL_ADD_NODE_WITH_LABEL(&dev->sysctl_ctx, 341 SYSCTL_CHILDREN(dc->sysctl_tree), OID_AUTO, 342 dev->nameunit + strlen(dc->name), 343 CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, "", "device_index"); 344 SYSCTL_ADD_PROC(&dev->sysctl_ctx, SYSCTL_CHILDREN(dev->sysctl_tree), 345 OID_AUTO, "%desc", CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, 346 dev, DEVICE_SYSCTL_DESC, device_sysctl_handler, "A", 347 "device description"); 348 SYSCTL_ADD_PROC(&dev->sysctl_ctx, SYSCTL_CHILDREN(dev->sysctl_tree), 349 OID_AUTO, "%driver", 350 CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, 351 dev, DEVICE_SYSCTL_DRIVER, device_sysctl_handler, "A", 352 "device driver name"); 353 SYSCTL_ADD_PROC(&dev->sysctl_ctx, SYSCTL_CHILDREN(dev->sysctl_tree), 354 OID_AUTO, "%location", 355 CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, 356 dev, DEVICE_SYSCTL_LOCATION, device_sysctl_handler, "A", 357 "device location relative to parent"); 358 SYSCTL_ADD_PROC(&dev->sysctl_ctx, SYSCTL_CHILDREN(dev->sysctl_tree), 359 OID_AUTO, "%pnpinfo", 360 CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, 361 dev, DEVICE_SYSCTL_PNPINFO, device_sysctl_handler, "A", 362 "device identification"); 363 SYSCTL_ADD_PROC(&dev->sysctl_ctx, SYSCTL_CHILDREN(dev->sysctl_tree), 364 OID_AUTO, "%parent", 365 CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, 366 dev, DEVICE_SYSCTL_PARENT, device_sysctl_handler, "A", 367 "parent device"); 368 SYSCTL_ADD_PROC(&dev->sysctl_ctx, SYSCTL_CHILDREN(dev->sysctl_tree), 369 OID_AUTO, "%iommu", 370 CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, 371 dev, DEVICE_SYSCTL_IOMMU, device_sysctl_handler, "A", 372 "iommu unit handling the device requests"); 373 if (bus_get_domain(dev, &domain) == 0) 374 SYSCTL_ADD_INT(&dev->sysctl_ctx, 375 SYSCTL_CHILDREN(dev->sysctl_tree), OID_AUTO, "%domain", 376 CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, domain, "NUMA domain"); 377 } 378 379 static void 380 device_sysctl_update(device_t dev) 381 { 382 devclass_t dc = dev->devclass; 383 384 if (dev->sysctl_tree == NULL) 385 return; 386 sysctl_rename_oid(dev->sysctl_tree, dev->nameunit + strlen(dc->name)); 387 } 388 389 static void 390 device_sysctl_fini(device_t dev) 391 { 392 if (dev->sysctl_tree == NULL) 393 return; 394 sysctl_ctx_free(&dev->sysctl_ctx); 395 dev->sysctl_tree = NULL; 396 } 397 398 static struct device_list bus_data_devices; 399 static int bus_data_generation = 1; 400 401 static kobj_method_t null_methods[] = { 402 KOBJMETHOD_END 403 }; 404 405 DEFINE_CLASS(null, null_methods, 0); 406 407 void 408 bus_topo_assert(void) 409 { 410 411 GIANT_REQUIRED; 412 } 413 414 struct mtx * 415 bus_topo_mtx(void) 416 { 417 418 return (&Giant); 419 } 420 421 void 422 bus_topo_lock(void) 423 { 424 425 mtx_lock(bus_topo_mtx()); 426 } 427 428 void 429 bus_topo_unlock(void) 430 { 431 432 mtx_unlock(bus_topo_mtx()); 433 } 434 435 /* 436 * Bus pass implementation 437 */ 438 439 static driver_list_t passes = TAILQ_HEAD_INITIALIZER(passes); 440 static int bus_current_pass = BUS_PASS_ROOT; 441 442 /** 443 * @internal 444 * @brief Register the pass level of a new driver attachment 445 * 446 * Register a new driver attachment's pass level. If no driver 447 * attachment with the same pass level has been added, then @p new 448 * will be added to the global passes list. 449 * 450 * @param new the new driver attachment 451 */ 452 static void 453 driver_register_pass(struct driverlink *new) 454 { 455 struct driverlink *dl; 456 457 /* We only consider pass numbers during boot. */ 458 if (bus_current_pass == BUS_PASS_DEFAULT) 459 return; 460 461 /* 462 * Walk the passes list. If we already know about this pass 463 * then there is nothing to do. If we don't, then insert this 464 * driver link into the list. 465 */ 466 TAILQ_FOREACH(dl, &passes, passlink) { 467 if (dl->pass < new->pass) 468 continue; 469 if (dl->pass == new->pass) 470 return; 471 TAILQ_INSERT_BEFORE(dl, new, passlink); 472 return; 473 } 474 TAILQ_INSERT_TAIL(&passes, new, passlink); 475 } 476 477 /** 478 * @brief Retrieve the current bus pass 479 * 480 * Retrieves the current bus pass level. Call the BUS_NEW_PASS() 481 * method on the root bus to kick off a new device tree scan for each 482 * new pass level that has at least one driver. 483 */ 484 int 485 bus_get_pass(void) 486 { 487 488 return (bus_current_pass); 489 } 490 491 /** 492 * @brief Raise the current bus pass 493 * 494 * Raise the current bus pass level to @p pass. Call the BUS_NEW_PASS() 495 * method on the root bus to kick off a new device tree scan for each 496 * new pass level that has at least one driver. 497 */ 498 static void 499 bus_set_pass(int pass) 500 { 501 struct driverlink *dl; 502 503 if (bus_current_pass > pass) 504 panic("Attempt to lower bus pass level"); 505 506 TAILQ_FOREACH(dl, &passes, passlink) { 507 /* Skip pass values below the current pass level. */ 508 if (dl->pass <= bus_current_pass) 509 continue; 510 511 /* 512 * Bail once we hit a driver with a pass level that is 513 * too high. 514 */ 515 if (dl->pass > pass) 516 break; 517 518 /* 519 * Raise the pass level to the next level and rescan 520 * the tree. 521 */ 522 bus_current_pass = dl->pass; 523 BUS_NEW_PASS(root_bus); 524 } 525 526 /* 527 * If there isn't a driver registered for the requested pass, 528 * then bus_current_pass might still be less than 'pass'. Set 529 * it to 'pass' in that case. 530 */ 531 if (bus_current_pass < pass) 532 bus_current_pass = pass; 533 KASSERT(bus_current_pass == pass, ("Failed to update bus pass level")); 534 } 535 536 /* 537 * Devclass implementation 538 */ 539 540 static devclass_list_t devclasses = TAILQ_HEAD_INITIALIZER(devclasses); 541 542 /** 543 * @internal 544 * @brief Find or create a device class 545 * 546 * If a device class with the name @p classname exists, return it, 547 * otherwise if @p create is non-zero create and return a new device 548 * class. 549 * 550 * If @p parentname is non-NULL, the parent of the devclass is set to 551 * the devclass of that name. 552 * 553 * @param classname the devclass name to find or create 554 * @param parentname the parent devclass name or @c NULL 555 * @param create non-zero to create a devclass 556 */ 557 static devclass_t 558 devclass_find_internal(const char *classname, const char *parentname, 559 int create) 560 { 561 devclass_t dc; 562 563 PDEBUG(("looking for %s", classname)); 564 if (!classname) 565 return (NULL); 566 567 TAILQ_FOREACH(dc, &devclasses, link) { 568 if (!strcmp(dc->name, classname)) 569 break; 570 } 571 572 if (create && !dc) { 573 PDEBUG(("creating %s", classname)); 574 dc = malloc(sizeof(struct devclass) + strlen(classname) + 1, 575 M_BUS, M_NOWAIT | M_ZERO); 576 if (!dc) 577 return (NULL); 578 dc->parent = NULL; 579 dc->name = (char*) (dc + 1); 580 strcpy(dc->name, classname); 581 TAILQ_INIT(&dc->drivers); 582 TAILQ_INSERT_TAIL(&devclasses, dc, link); 583 584 bus_data_generation_update(); 585 } 586 587 /* 588 * If a parent class is specified, then set that as our parent so 589 * that this devclass will support drivers for the parent class as 590 * well. If the parent class has the same name don't do this though 591 * as it creates a cycle that can trigger an infinite loop in 592 * device_probe_child() if a device exists for which there is no 593 * suitable driver. 594 */ 595 if (parentname && dc && !dc->parent && 596 strcmp(classname, parentname) != 0) { 597 dc->parent = devclass_find_internal(parentname, NULL, TRUE); 598 dc->parent->flags |= DC_HAS_CHILDREN; 599 } 600 601 return (dc); 602 } 603 604 /** 605 * @brief Create a device class 606 * 607 * If a device class with the name @p classname exists, return it, 608 * otherwise create and return a new device class. 609 * 610 * @param classname the devclass name to find or create 611 */ 612 devclass_t 613 devclass_create(const char *classname) 614 { 615 return (devclass_find_internal(classname, NULL, TRUE)); 616 } 617 618 /** 619 * @brief Find a device class 620 * 621 * If a device class with the name @p classname exists, return it, 622 * otherwise return @c NULL. 623 * 624 * @param classname the devclass name to find 625 */ 626 devclass_t 627 devclass_find(const char *classname) 628 { 629 return (devclass_find_internal(classname, NULL, FALSE)); 630 } 631 632 /** 633 * @brief Register that a device driver has been added to a devclass 634 * 635 * Register that a device driver has been added to a devclass. This 636 * is called by devclass_add_driver to accomplish the recursive 637 * notification of all the children classes of dc, as well as dc. 638 * Each layer will have BUS_DRIVER_ADDED() called for all instances of 639 * the devclass. 640 * 641 * We do a full search here of the devclass list at each iteration 642 * level to save storing children-lists in the devclass structure. If 643 * we ever move beyond a few dozen devices doing this, we may need to 644 * reevaluate... 645 * 646 * @param dc the devclass to edit 647 * @param driver the driver that was just added 648 */ 649 static void 650 devclass_driver_added(devclass_t dc, driver_t *driver) 651 { 652 devclass_t parent; 653 int i; 654 655 /* 656 * Call BUS_DRIVER_ADDED for any existing buses in this class. 657 */ 658 for (i = 0; i < dc->maxunit; i++) 659 if (dc->devices[i] && device_is_attached(dc->devices[i])) 660 BUS_DRIVER_ADDED(dc->devices[i], driver); 661 662 /* 663 * Walk through the children classes. Since we only keep a 664 * single parent pointer around, we walk the entire list of 665 * devclasses looking for children. We set the 666 * DC_HAS_CHILDREN flag when a child devclass is created on 667 * the parent, so we only walk the list for those devclasses 668 * that have children. 669 */ 670 if (!(dc->flags & DC_HAS_CHILDREN)) 671 return; 672 parent = dc; 673 TAILQ_FOREACH(dc, &devclasses, link) { 674 if (dc->parent == parent) 675 devclass_driver_added(dc, driver); 676 } 677 } 678 679 static void 680 device_handle_nomatch(device_t dev) 681 { 682 BUS_PROBE_NOMATCH(dev->parent, dev); 683 EVENTHANDLER_DIRECT_INVOKE(device_nomatch, dev); 684 dev->flags |= DF_DONENOMATCH; 685 } 686 687 /** 688 * @brief Add a device driver to a device class 689 * 690 * Add a device driver to a devclass. This is normally called 691 * automatically by DRIVER_MODULE(). The BUS_DRIVER_ADDED() method of 692 * all devices in the devclass will be called to allow them to attempt 693 * to re-probe any unmatched children. 694 * 695 * @param dc the devclass to edit 696 * @param driver the driver to register 697 */ 698 int 699 devclass_add_driver(devclass_t dc, driver_t *driver, int pass, devclass_t *dcp) 700 { 701 driverlink_t dl; 702 devclass_t child_dc; 703 const char *parentname; 704 705 PDEBUG(("%s", DRIVERNAME(driver))); 706 707 /* Don't allow invalid pass values. */ 708 if (pass <= BUS_PASS_ROOT) 709 return (EINVAL); 710 711 dl = malloc(sizeof *dl, M_BUS, M_NOWAIT|M_ZERO); 712 if (!dl) 713 return (ENOMEM); 714 715 /* 716 * Compile the driver's methods. Also increase the reference count 717 * so that the class doesn't get freed when the last instance 718 * goes. This means we can safely use static methods and avoids a 719 * double-free in devclass_delete_driver. 720 */ 721 kobj_class_compile((kobj_class_t) driver); 722 723 /* 724 * If the driver has any base classes, make the 725 * devclass inherit from the devclass of the driver's 726 * first base class. This will allow the system to 727 * search for drivers in both devclasses for children 728 * of a device using this driver. 729 */ 730 if (driver->baseclasses) 731 parentname = driver->baseclasses[0]->name; 732 else 733 parentname = NULL; 734 child_dc = devclass_find_internal(driver->name, parentname, TRUE); 735 if (dcp != NULL) 736 *dcp = child_dc; 737 738 dl->driver = driver; 739 TAILQ_INSERT_TAIL(&dc->drivers, dl, link); 740 driver->refs++; /* XXX: kobj_mtx */ 741 dl->pass = pass; 742 driver_register_pass(dl); 743 744 if (device_frozen) { 745 dl->flags |= DL_DEFERRED_PROBE; 746 } else { 747 devclass_driver_added(dc, driver); 748 } 749 bus_data_generation_update(); 750 return (0); 751 } 752 753 /** 754 * @brief Register that a device driver has been deleted from a devclass 755 * 756 * Register that a device driver has been removed from a devclass. 757 * This is called by devclass_delete_driver to accomplish the 758 * recursive notification of all the children classes of busclass, as 759 * well as busclass. Each layer will attempt to detach the driver 760 * from any devices that are children of the bus's devclass. The function 761 * will return an error if a device fails to detach. 762 * 763 * We do a full search here of the devclass list at each iteration 764 * level to save storing children-lists in the devclass structure. If 765 * we ever move beyond a few dozen devices doing this, we may need to 766 * reevaluate... 767 * 768 * @param busclass the devclass of the parent bus 769 * @param dc the devclass of the driver being deleted 770 * @param driver the driver being deleted 771 */ 772 static int 773 devclass_driver_deleted(devclass_t busclass, devclass_t dc, driver_t *driver) 774 { 775 devclass_t parent; 776 device_t dev; 777 int error, i; 778 779 /* 780 * Disassociate from any devices. We iterate through all the 781 * devices in the devclass of the driver and detach any which are 782 * using the driver and which have a parent in the devclass which 783 * we are deleting from. 784 * 785 * Note that since a driver can be in multiple devclasses, we 786 * should not detach devices which are not children of devices in 787 * the affected devclass. 788 * 789 * If we're frozen, we don't generate NOMATCH events. Mark to 790 * generate later. 791 */ 792 for (i = 0; i < dc->maxunit; i++) { 793 if (dc->devices[i]) { 794 dev = dc->devices[i]; 795 if (dev->driver == driver && dev->parent && 796 dev->parent->devclass == busclass) { 797 if ((error = device_detach(dev)) != 0) 798 return (error); 799 if (device_frozen) { 800 dev->flags &= ~DF_DONENOMATCH; 801 dev->flags |= DF_NEEDNOMATCH; 802 } else { 803 device_handle_nomatch(dev); 804 } 805 } 806 } 807 } 808 809 /* 810 * Walk through the children classes. Since we only keep a 811 * single parent pointer around, we walk the entire list of 812 * devclasses looking for children. We set the 813 * DC_HAS_CHILDREN flag when a child devclass is created on 814 * the parent, so we only walk the list for those devclasses 815 * that have children. 816 */ 817 if (!(busclass->flags & DC_HAS_CHILDREN)) 818 return (0); 819 parent = busclass; 820 TAILQ_FOREACH(busclass, &devclasses, link) { 821 if (busclass->parent == parent) { 822 error = devclass_driver_deleted(busclass, dc, driver); 823 if (error) 824 return (error); 825 } 826 } 827 return (0); 828 } 829 830 /** 831 * @brief Delete a device driver from a device class 832 * 833 * Delete a device driver from a devclass. This is normally called 834 * automatically by DRIVER_MODULE(). 835 * 836 * If the driver is currently attached to any devices, 837 * devclass_delete_driver() will first attempt to detach from each 838 * device. If one of the detach calls fails, the driver will not be 839 * deleted. 840 * 841 * @param dc the devclass to edit 842 * @param driver the driver to unregister 843 */ 844 int 845 devclass_delete_driver(devclass_t busclass, driver_t *driver) 846 { 847 devclass_t dc = devclass_find(driver->name); 848 driverlink_t dl; 849 int error; 850 851 PDEBUG(("%s from devclass %s", driver->name, DEVCLANAME(busclass))); 852 853 if (!dc) 854 return (0); 855 856 /* 857 * Find the link structure in the bus' list of drivers. 858 */ 859 TAILQ_FOREACH(dl, &busclass->drivers, link) { 860 if (dl->driver == driver) 861 break; 862 } 863 864 if (!dl) { 865 PDEBUG(("%s not found in %s list", driver->name, 866 busclass->name)); 867 return (ENOENT); 868 } 869 870 error = devclass_driver_deleted(busclass, dc, driver); 871 if (error != 0) 872 return (error); 873 874 TAILQ_REMOVE(&busclass->drivers, dl, link); 875 free(dl, M_BUS); 876 877 /* XXX: kobj_mtx */ 878 driver->refs--; 879 if (driver->refs == 0) 880 kobj_class_free((kobj_class_t) driver); 881 882 bus_data_generation_update(); 883 return (0); 884 } 885 886 /** 887 * @brief Quiesces a set of device drivers from a device class 888 * 889 * Quiesce a device driver from a devclass. This is normally called 890 * automatically by DRIVER_MODULE(). 891 * 892 * If the driver is currently attached to any devices, 893 * devclass_quiesece_driver() will first attempt to quiesce each 894 * device. 895 * 896 * @param dc the devclass to edit 897 * @param driver the driver to unregister 898 */ 899 static int 900 devclass_quiesce_driver(devclass_t busclass, driver_t *driver) 901 { 902 devclass_t dc = devclass_find(driver->name); 903 driverlink_t dl; 904 device_t dev; 905 int i; 906 int error; 907 908 PDEBUG(("%s from devclass %s", driver->name, DEVCLANAME(busclass))); 909 910 if (!dc) 911 return (0); 912 913 /* 914 * Find the link structure in the bus' list of drivers. 915 */ 916 TAILQ_FOREACH(dl, &busclass->drivers, link) { 917 if (dl->driver == driver) 918 break; 919 } 920 921 if (!dl) { 922 PDEBUG(("%s not found in %s list", driver->name, 923 busclass->name)); 924 return (ENOENT); 925 } 926 927 /* 928 * Quiesce all devices. We iterate through all the devices in 929 * the devclass of the driver and quiesce any which are using 930 * the driver and which have a parent in the devclass which we 931 * are quiescing. 932 * 933 * Note that since a driver can be in multiple devclasses, we 934 * should not quiesce devices which are not children of 935 * devices in the affected devclass. 936 */ 937 for (i = 0; i < dc->maxunit; i++) { 938 if (dc->devices[i]) { 939 dev = dc->devices[i]; 940 if (dev->driver == driver && dev->parent && 941 dev->parent->devclass == busclass) { 942 if ((error = device_quiesce(dev)) != 0) 943 return (error); 944 } 945 } 946 } 947 948 return (0); 949 } 950 951 /** 952 * @internal 953 */ 954 static driverlink_t 955 devclass_find_driver_internal(devclass_t dc, const char *classname) 956 { 957 driverlink_t dl; 958 959 PDEBUG(("%s in devclass %s", classname, DEVCLANAME(dc))); 960 961 TAILQ_FOREACH(dl, &dc->drivers, link) { 962 if (!strcmp(dl->driver->name, classname)) 963 return (dl); 964 } 965 966 PDEBUG(("not found")); 967 return (NULL); 968 } 969 970 /** 971 * @brief Return the name of the devclass 972 */ 973 const char * 974 devclass_get_name(devclass_t dc) 975 { 976 return (dc->name); 977 } 978 979 /** 980 * @brief Find a device given a unit number 981 * 982 * @param dc the devclass to search 983 * @param unit the unit number to search for 984 * 985 * @returns the device with the given unit number or @c 986 * NULL if there is no such device 987 */ 988 device_t 989 devclass_get_device(devclass_t dc, int unit) 990 { 991 if (dc == NULL || unit < 0 || unit >= dc->maxunit) 992 return (NULL); 993 return (dc->devices[unit]); 994 } 995 996 /** 997 * @brief Find the softc field of a device given a unit number 998 * 999 * @param dc the devclass to search 1000 * @param unit the unit number to search for 1001 * 1002 * @returns the softc field of the device with the given 1003 * unit number or @c NULL if there is no such 1004 * device 1005 */ 1006 void * 1007 devclass_get_softc(devclass_t dc, int unit) 1008 { 1009 device_t dev; 1010 1011 dev = devclass_get_device(dc, unit); 1012 if (!dev) 1013 return (NULL); 1014 1015 return (device_get_softc(dev)); 1016 } 1017 1018 /** 1019 * @brief Get a list of devices in the devclass 1020 * 1021 * An array containing a list of all the devices in the given devclass 1022 * is allocated and returned in @p *devlistp. The number of devices 1023 * in the array is returned in @p *devcountp. The caller should free 1024 * the array using @c free(p, M_TEMP), even if @p *devcountp is 0. 1025 * 1026 * @param dc the devclass to examine 1027 * @param devlistp points at location for array pointer return 1028 * value 1029 * @param devcountp points at location for array size return value 1030 * 1031 * @retval 0 success 1032 * @retval ENOMEM the array allocation failed 1033 */ 1034 int 1035 devclass_get_devices(devclass_t dc, device_t **devlistp, int *devcountp) 1036 { 1037 int count, i; 1038 device_t *list; 1039 1040 count = devclass_get_count(dc); 1041 list = malloc(count * sizeof(device_t), M_TEMP, M_NOWAIT|M_ZERO); 1042 if (!list) 1043 return (ENOMEM); 1044 1045 count = 0; 1046 for (i = 0; i < dc->maxunit; i++) { 1047 if (dc->devices[i]) { 1048 list[count] = dc->devices[i]; 1049 count++; 1050 } 1051 } 1052 1053 *devlistp = list; 1054 *devcountp = count; 1055 1056 return (0); 1057 } 1058 1059 /** 1060 * @brief Get a list of drivers in the devclass 1061 * 1062 * An array containing a list of pointers to all the drivers in the 1063 * given devclass is allocated and returned in @p *listp. The number 1064 * of drivers in the array is returned in @p *countp. The caller should 1065 * free the array using @c free(p, M_TEMP). 1066 * 1067 * @param dc the devclass to examine 1068 * @param listp gives location for array pointer return value 1069 * @param countp gives location for number of array elements 1070 * return value 1071 * 1072 * @retval 0 success 1073 * @retval ENOMEM the array allocation failed 1074 */ 1075 int 1076 devclass_get_drivers(devclass_t dc, driver_t ***listp, int *countp) 1077 { 1078 driverlink_t dl; 1079 driver_t **list; 1080 int count; 1081 1082 count = 0; 1083 TAILQ_FOREACH(dl, &dc->drivers, link) 1084 count++; 1085 list = malloc(count * sizeof(driver_t *), M_TEMP, M_NOWAIT); 1086 if (list == NULL) 1087 return (ENOMEM); 1088 1089 count = 0; 1090 TAILQ_FOREACH(dl, &dc->drivers, link) { 1091 list[count] = dl->driver; 1092 count++; 1093 } 1094 *listp = list; 1095 *countp = count; 1096 1097 return (0); 1098 } 1099 1100 /** 1101 * @brief Get the number of devices in a devclass 1102 * 1103 * @param dc the devclass to examine 1104 */ 1105 int 1106 devclass_get_count(devclass_t dc) 1107 { 1108 int count, i; 1109 1110 count = 0; 1111 for (i = 0; i < dc->maxunit; i++) 1112 if (dc->devices[i]) 1113 count++; 1114 return (count); 1115 } 1116 1117 /** 1118 * @brief Get the maximum unit number used in a devclass 1119 * 1120 * Note that this is one greater than the highest currently-allocated unit. If 1121 * @p dc is NULL, @c -1 is returned to indicate that not even the devclass has 1122 * been allocated yet. 1123 * 1124 * @param dc the devclass to examine 1125 */ 1126 int 1127 devclass_get_maxunit(devclass_t dc) 1128 { 1129 if (dc == NULL) 1130 return (-1); 1131 return (dc->maxunit); 1132 } 1133 1134 /** 1135 * @brief Find a free unit number in a devclass 1136 * 1137 * This function searches for the first unused unit number greater 1138 * that or equal to @p unit. Note: This can return INT_MAX which 1139 * may be rejected elsewhere. 1140 * 1141 * @param dc the devclass to examine 1142 * @param unit the first unit number to check 1143 */ 1144 int 1145 devclass_find_free_unit(devclass_t dc, int unit) 1146 { 1147 if (dc == NULL) 1148 return (unit); 1149 while (unit < dc->maxunit && dc->devices[unit] != NULL) 1150 unit++; 1151 return (unit); 1152 } 1153 1154 /** 1155 * @brief Set the parent of a devclass 1156 * 1157 * The parent class is normally initialised automatically by 1158 * DRIVER_MODULE(). 1159 * 1160 * @param dc the devclass to edit 1161 * @param pdc the new parent devclass 1162 */ 1163 void 1164 devclass_set_parent(devclass_t dc, devclass_t pdc) 1165 { 1166 dc->parent = pdc; 1167 } 1168 1169 /** 1170 * @brief Get the parent of a devclass 1171 * 1172 * @param dc the devclass to examine 1173 */ 1174 devclass_t 1175 devclass_get_parent(devclass_t dc) 1176 { 1177 return (dc->parent); 1178 } 1179 1180 struct sysctl_ctx_list * 1181 devclass_get_sysctl_ctx(devclass_t dc) 1182 { 1183 return (&dc->sysctl_ctx); 1184 } 1185 1186 struct sysctl_oid * 1187 devclass_get_sysctl_tree(devclass_t dc) 1188 { 1189 return (dc->sysctl_tree); 1190 } 1191 1192 /** 1193 * @internal 1194 * @brief Allocate a unit number 1195 * 1196 * On entry, @p *unitp is the desired unit number (or @c DEVICE_UNIT_ANY if any 1197 * will do). The allocated unit number is returned in @p *unitp. 1198 * 1199 * @param dc the devclass to allocate from 1200 * @param unitp points at the location for the allocated unit 1201 * number 1202 * 1203 * @retval 0 success 1204 * @retval EEXIST the requested unit number is already allocated 1205 * @retval ENOMEM memory allocation failure 1206 * @retval EINVAL unit is negative or we've run out of units 1207 */ 1208 static int 1209 devclass_alloc_unit(devclass_t dc, device_t dev, int *unitp) 1210 { 1211 const char *s; 1212 int unit = *unitp; 1213 1214 PDEBUG(("unit %d in devclass %s", unit, DEVCLANAME(dc))); 1215 1216 /* Ask the parent bus if it wants to wire this device. */ 1217 if (unit == DEVICE_UNIT_ANY) 1218 BUS_HINT_DEVICE_UNIT(device_get_parent(dev), dev, dc->name, 1219 &unit); 1220 1221 /* Unit numbers are either DEVICE_UNIT_ANY or in [0,INT_MAX) */ 1222 if ((unit < 0 && unit != DEVICE_UNIT_ANY) || unit == INT_MAX) 1223 return (EINVAL); 1224 1225 /* If we were given a wired unit number, check for existing device */ 1226 if (unit != DEVICE_UNIT_ANY) { 1227 if (unit < dc->maxunit && dc->devices[unit] != NULL) { 1228 if (bootverbose) 1229 printf("%s: %s%d already exists; skipping it\n", 1230 dc->name, dc->name, *unitp); 1231 return (EEXIST); 1232 } 1233 } else { 1234 /* Unwired device, find the next available slot for it */ 1235 unit = 0; 1236 for (unit = 0; unit < INT_MAX; unit++) { 1237 /* If this device slot is already in use, skip it. */ 1238 if (unit < dc->maxunit && dc->devices[unit] != NULL) 1239 continue; 1240 1241 /* If there is an "at" hint for a unit then skip it. */ 1242 if (resource_string_value(dc->name, unit, "at", &s) == 1243 0) 1244 continue; 1245 1246 break; 1247 } 1248 } 1249 1250 /* 1251 * Unit numbers must be in the range [0, INT_MAX), so exclude INT_MAX as 1252 * too large. We constrain maxunit below to be <= INT_MAX. This means we 1253 * can treat unit and maxunit as normal integers with normal math 1254 * everywhere and we only have to flag INT_MAX as invalid. 1255 */ 1256 if (unit == INT_MAX) 1257 return (EINVAL); 1258 1259 /* 1260 * We've selected a unit beyond the length of the table, so let's extend 1261 * the table to make room for all units up to and including this one. 1262 */ 1263 if (unit >= dc->maxunit) { 1264 int newsize; 1265 1266 newsize = unit + 1; 1267 dc->devices = reallocf(dc->devices, 1268 newsize * sizeof(*dc->devices), M_BUS, M_WAITOK); 1269 memset(dc->devices + dc->maxunit, 0, 1270 sizeof(device_t) * (newsize - dc->maxunit)); 1271 dc->maxunit = newsize; 1272 } 1273 PDEBUG(("now: unit %d in devclass %s", unit, DEVCLANAME(dc))); 1274 1275 *unitp = unit; 1276 return (0); 1277 } 1278 1279 /** 1280 * @internal 1281 * @brief Add a device to a devclass 1282 * 1283 * A unit number is allocated for the device (using the device's 1284 * preferred unit number if any) and the device is registered in the 1285 * devclass. This allows the device to be looked up by its unit 1286 * number, e.g. by decoding a dev_t minor number. 1287 * 1288 * @param dc the devclass to add to 1289 * @param dev the device to add 1290 * 1291 * @retval 0 success 1292 * @retval EEXIST the requested unit number is already allocated 1293 * @retval ENOMEM memory allocation failure 1294 * @retval EINVAL Unit number invalid or too many units 1295 */ 1296 static int 1297 devclass_add_device(devclass_t dc, device_t dev) 1298 { 1299 int buflen, error; 1300 1301 PDEBUG(("%s in devclass %s", DEVICENAME(dev), DEVCLANAME(dc))); 1302 1303 buflen = snprintf(NULL, 0, "%s%d$", dc->name, INT_MAX); 1304 if (buflen < 0) 1305 return (ENOMEM); 1306 dev->nameunit = malloc(buflen, M_BUS, M_NOWAIT|M_ZERO); 1307 if (!dev->nameunit) 1308 return (ENOMEM); 1309 1310 if ((error = devclass_alloc_unit(dc, dev, &dev->unit)) != 0) { 1311 free(dev->nameunit, M_BUS); 1312 dev->nameunit = NULL; 1313 return (error); 1314 } 1315 dc->devices[dev->unit] = dev; 1316 dev->devclass = dc; 1317 snprintf(dev->nameunit, buflen, "%s%d", dc->name, dev->unit); 1318 1319 return (0); 1320 } 1321 1322 /** 1323 * @internal 1324 * @brief Delete a device from a devclass 1325 * 1326 * The device is removed from the devclass's device list and its unit 1327 * number is freed. 1328 1329 * @param dc the devclass to delete from 1330 * @param dev the device to delete 1331 * 1332 * @retval 0 success 1333 */ 1334 static int 1335 devclass_delete_device(devclass_t dc, device_t dev) 1336 { 1337 if (!dc || !dev) 1338 return (0); 1339 1340 PDEBUG(("%s in devclass %s", DEVICENAME(dev), DEVCLANAME(dc))); 1341 1342 if (dev->devclass != dc || dc->devices[dev->unit] != dev) 1343 panic("devclass_delete_device: inconsistent device class"); 1344 dc->devices[dev->unit] = NULL; 1345 if (dev->flags & DF_WILDCARD) 1346 dev->unit = DEVICE_UNIT_ANY; 1347 dev->devclass = NULL; 1348 free(dev->nameunit, M_BUS); 1349 dev->nameunit = NULL; 1350 1351 return (0); 1352 } 1353 1354 /** 1355 * @internal 1356 * @brief Make a new device and add it as a child of @p parent 1357 * 1358 * @param parent the parent of the new device 1359 * @param name the devclass name of the new device or @c NULL 1360 * to leave the devclass unspecified 1361 * @parem unit the unit number of the new device of @c DEVICE_UNIT_ANY 1362 * to leave the unit number unspecified 1363 * 1364 * @returns the new device 1365 */ 1366 static device_t 1367 make_device(device_t parent, const char *name, int unit) 1368 { 1369 device_t dev; 1370 devclass_t dc; 1371 1372 PDEBUG(("%s at %s as unit %d", name, DEVICENAME(parent), unit)); 1373 1374 if (name) { 1375 dc = devclass_find_internal(name, NULL, TRUE); 1376 if (!dc) { 1377 printf("make_device: can't find device class %s\n", 1378 name); 1379 return (NULL); 1380 } 1381 } else { 1382 dc = NULL; 1383 } 1384 1385 dev = malloc(sizeof(*dev), M_BUS, M_NOWAIT|M_ZERO); 1386 if (!dev) 1387 return (NULL); 1388 1389 dev->parent = parent; 1390 TAILQ_INIT(&dev->children); 1391 kobj_init((kobj_t) dev, &null_class); 1392 dev->driver = NULL; 1393 dev->devclass = NULL; 1394 dev->unit = unit; 1395 dev->nameunit = NULL; 1396 dev->desc = NULL; 1397 dev->busy = 0; 1398 dev->devflags = 0; 1399 dev->flags = DF_ENABLED; 1400 dev->order = 0; 1401 if (unit == DEVICE_UNIT_ANY) 1402 dev->flags |= DF_WILDCARD; 1403 if (name) { 1404 dev->flags |= DF_FIXEDCLASS; 1405 if (devclass_add_device(dc, dev)) { 1406 kobj_delete((kobj_t) dev, M_BUS); 1407 return (NULL); 1408 } 1409 } 1410 if (parent != NULL && device_has_quiet_children(parent)) 1411 dev->flags |= DF_QUIET | DF_QUIET_CHILDREN; 1412 dev->ivars = NULL; 1413 dev->softc = NULL; 1414 LIST_INIT(&dev->props); 1415 1416 dev->state = DS_NOTPRESENT; 1417 1418 TAILQ_INSERT_TAIL(&bus_data_devices, dev, devlink); 1419 bus_data_generation_update(); 1420 1421 return (dev); 1422 } 1423 1424 /** 1425 * @internal 1426 * @brief Print a description of a device. 1427 */ 1428 static int 1429 device_print_child(device_t dev, device_t child) 1430 { 1431 int retval = 0; 1432 1433 if (device_is_alive(child)) 1434 retval += BUS_PRINT_CHILD(dev, child); 1435 else 1436 retval += device_printf(child, " not found\n"); 1437 1438 return (retval); 1439 } 1440 1441 /** 1442 * @brief Create a new device 1443 * 1444 * This creates a new device and adds it as a child of an existing 1445 * parent device. The new device will be added after the last existing 1446 * child with order zero. 1447 * 1448 * @param dev the device which will be the parent of the 1449 * new child device 1450 * @param name devclass name for new device or @c NULL if not 1451 * specified 1452 * @param unit unit number for new device or @c DEVICE_UNIT_ANY if not 1453 * specified 1454 * 1455 * @returns the new device 1456 */ 1457 device_t 1458 device_add_child(device_t dev, const char *name, int unit) 1459 { 1460 return (device_add_child_ordered(dev, 0, name, unit)); 1461 } 1462 1463 /** 1464 * @brief Create a new device 1465 * 1466 * This creates a new device and adds it as a child of an existing 1467 * parent device. The new device will be added after the last existing 1468 * child with the same order. 1469 * 1470 * @param dev the device which will be the parent of the 1471 * new child device 1472 * @param order a value which is used to partially sort the 1473 * children of @p dev - devices created using 1474 * lower values of @p order appear first in @p 1475 * dev's list of children 1476 * @param name devclass name for new device or @c NULL if not 1477 * specified 1478 * @param unit unit number for new device or @c DEVICE_UNIT_ANY if not 1479 * specified 1480 * 1481 * @returns the new device 1482 */ 1483 device_t 1484 device_add_child_ordered(device_t dev, u_int order, const char *name, int unit) 1485 { 1486 device_t child; 1487 device_t place; 1488 1489 PDEBUG(("%s at %s with order %u as unit %d", 1490 name, DEVICENAME(dev), order, unit)); 1491 KASSERT(name != NULL || unit == DEVICE_UNIT_ANY, 1492 ("child device with wildcard name and specific unit number")); 1493 1494 child = make_device(dev, name, unit); 1495 if (child == NULL) 1496 return (child); 1497 child->order = order; 1498 1499 TAILQ_FOREACH(place, &dev->children, link) { 1500 if (place->order > order) 1501 break; 1502 } 1503 1504 if (place) { 1505 /* 1506 * The device 'place' is the first device whose order is 1507 * greater than the new child. 1508 */ 1509 TAILQ_INSERT_BEFORE(place, child, link); 1510 } else { 1511 /* 1512 * The new child's order is greater or equal to the order of 1513 * any existing device. Add the child to the tail of the list. 1514 */ 1515 TAILQ_INSERT_TAIL(&dev->children, child, link); 1516 } 1517 1518 bus_data_generation_update(); 1519 return (child); 1520 } 1521 1522 /** 1523 * @brief Delete a device 1524 * 1525 * This function deletes a device along with all of its children. If 1526 * the device currently has a driver attached to it, the device is 1527 * detached first using device_detach(). 1528 * 1529 * @param dev the parent device 1530 * @param child the device to delete 1531 * 1532 * @retval 0 success 1533 * @retval non-zero a unit error code describing the error 1534 */ 1535 int 1536 device_delete_child(device_t dev, device_t child) 1537 { 1538 int error; 1539 device_t grandchild; 1540 1541 PDEBUG(("%s from %s", DEVICENAME(child), DEVICENAME(dev))); 1542 1543 /* 1544 * Detach child. Ideally this cleans up any grandchild 1545 * devices. 1546 */ 1547 if ((error = device_detach(child)) != 0) 1548 return (error); 1549 1550 /* Delete any grandchildren left after detach. */ 1551 while ((grandchild = TAILQ_FIRST(&child->children)) != NULL) { 1552 error = device_delete_child(child, grandchild); 1553 if (error) 1554 return (error); 1555 } 1556 1557 device_destroy_props(dev); 1558 if (child->devclass) 1559 devclass_delete_device(child->devclass, child); 1560 if (child->parent) 1561 BUS_CHILD_DELETED(dev, child); 1562 TAILQ_REMOVE(&dev->children, child, link); 1563 TAILQ_REMOVE(&bus_data_devices, child, devlink); 1564 kobj_delete((kobj_t) child, M_BUS); 1565 1566 bus_data_generation_update(); 1567 return (0); 1568 } 1569 1570 /** 1571 * @brief Delete all children devices of the given device, if any. 1572 * 1573 * This function deletes all children devices of the given device, if 1574 * any, using the device_delete_child() function for each device it 1575 * finds. If a child device cannot be deleted, this function will 1576 * return an error code. 1577 * 1578 * @param dev the parent device 1579 * 1580 * @retval 0 success 1581 * @retval non-zero a device would not detach 1582 */ 1583 int 1584 device_delete_children(device_t dev) 1585 { 1586 device_t child; 1587 int error; 1588 1589 PDEBUG(("Deleting all children of %s", DEVICENAME(dev))); 1590 1591 error = 0; 1592 1593 while ((child = TAILQ_FIRST(&dev->children)) != NULL) { 1594 error = device_delete_child(dev, child); 1595 if (error) { 1596 PDEBUG(("Failed deleting %s", DEVICENAME(child))); 1597 break; 1598 } 1599 } 1600 return (error); 1601 } 1602 1603 /** 1604 * @brief Find a device given a unit number 1605 * 1606 * This is similar to devclass_get_devices() but only searches for 1607 * devices which have @p dev as a parent. 1608 * 1609 * @param dev the parent device to search 1610 * @param unit the unit number to search for. If the unit is 1611 * @c DEVICE_UNIT_ANY, return the first child of @p dev 1612 * which has name @p classname (that is, the one with the 1613 * lowest unit.) 1614 * 1615 * @returns the device with the given unit number or @c 1616 * NULL if there is no such device 1617 */ 1618 device_t 1619 device_find_child(device_t dev, const char *classname, int unit) 1620 { 1621 devclass_t dc; 1622 device_t child; 1623 1624 dc = devclass_find(classname); 1625 if (!dc) 1626 return (NULL); 1627 1628 if (unit != DEVICE_UNIT_ANY) { 1629 child = devclass_get_device(dc, unit); 1630 if (child && child->parent == dev) 1631 return (child); 1632 } else { 1633 for (unit = 0; unit < devclass_get_maxunit(dc); unit++) { 1634 child = devclass_get_device(dc, unit); 1635 if (child && child->parent == dev) 1636 return (child); 1637 } 1638 } 1639 return (NULL); 1640 } 1641 1642 /** 1643 * @internal 1644 */ 1645 static driverlink_t 1646 first_matching_driver(devclass_t dc, device_t dev) 1647 { 1648 if (dev->devclass) 1649 return (devclass_find_driver_internal(dc, dev->devclass->name)); 1650 return (TAILQ_FIRST(&dc->drivers)); 1651 } 1652 1653 /** 1654 * @internal 1655 */ 1656 static driverlink_t 1657 next_matching_driver(devclass_t dc, device_t dev, driverlink_t last) 1658 { 1659 if (dev->devclass) { 1660 driverlink_t dl; 1661 for (dl = TAILQ_NEXT(last, link); dl; dl = TAILQ_NEXT(dl, link)) 1662 if (!strcmp(dev->devclass->name, dl->driver->name)) 1663 return (dl); 1664 return (NULL); 1665 } 1666 return (TAILQ_NEXT(last, link)); 1667 } 1668 1669 /** 1670 * @internal 1671 */ 1672 int 1673 device_probe_child(device_t dev, device_t child) 1674 { 1675 devclass_t dc; 1676 driverlink_t best = NULL; 1677 driverlink_t dl; 1678 int result, pri = 0; 1679 /* We should preserve the devclass (or lack of) set by the bus. */ 1680 int hasclass = (child->devclass != NULL); 1681 1682 bus_topo_assert(); 1683 1684 dc = dev->devclass; 1685 if (!dc) 1686 panic("device_probe_child: parent device has no devclass"); 1687 1688 /* 1689 * If the state is already probed, then return. 1690 */ 1691 if (child->state == DS_ALIVE) 1692 return (0); 1693 1694 for (; dc; dc = dc->parent) { 1695 for (dl = first_matching_driver(dc, child); 1696 dl; 1697 dl = next_matching_driver(dc, child, dl)) { 1698 /* If this driver's pass is too high, then ignore it. */ 1699 if (dl->pass > bus_current_pass) 1700 continue; 1701 1702 PDEBUG(("Trying %s", DRIVERNAME(dl->driver))); 1703 result = device_set_driver(child, dl->driver); 1704 if (result == ENOMEM) 1705 return (result); 1706 else if (result != 0) 1707 continue; 1708 if (!hasclass) { 1709 if (device_set_devclass(child, 1710 dl->driver->name) != 0) { 1711 char const * devname = 1712 device_get_name(child); 1713 if (devname == NULL) 1714 devname = "(unknown)"; 1715 printf("driver bug: Unable to set " 1716 "devclass (class: %s " 1717 "devname: %s)\n", 1718 dl->driver->name, 1719 devname); 1720 (void)device_set_driver(child, NULL); 1721 continue; 1722 } 1723 } 1724 1725 /* Fetch any flags for the device before probing. */ 1726 resource_int_value(dl->driver->name, child->unit, 1727 "flags", &child->devflags); 1728 1729 result = DEVICE_PROBE(child); 1730 1731 /* 1732 * If probe returns 0, this is the driver that wins this 1733 * device. 1734 */ 1735 if (result == 0) { 1736 best = dl; 1737 pri = 0; 1738 goto exact_match; /* C doesn't have break 2 */ 1739 } 1740 1741 /* Reset flags and devclass before the next probe. */ 1742 child->devflags = 0; 1743 if (!hasclass) 1744 (void)device_set_devclass(child, NULL); 1745 1746 /* 1747 * Reset DF_QUIET in case this driver doesn't 1748 * end up as the best driver. 1749 */ 1750 device_verbose(child); 1751 1752 /* 1753 * Probes that return BUS_PROBE_NOWILDCARD or lower 1754 * only match on devices whose driver was explicitly 1755 * specified. 1756 */ 1757 if (result <= BUS_PROBE_NOWILDCARD && 1758 !(child->flags & DF_FIXEDCLASS)) { 1759 result = ENXIO; 1760 } 1761 1762 /* 1763 * The driver returned an error so it 1764 * certainly doesn't match. 1765 */ 1766 if (result > 0) { 1767 (void)device_set_driver(child, NULL); 1768 continue; 1769 } 1770 1771 /* 1772 * A priority lower than SUCCESS, remember the 1773 * best matching driver. Initialise the value 1774 * of pri for the first match. 1775 */ 1776 if (best == NULL || result > pri) { 1777 best = dl; 1778 pri = result; 1779 continue; 1780 } 1781 } 1782 } 1783 1784 if (best == NULL) 1785 return (ENXIO); 1786 1787 /* 1788 * If we found a driver, change state and initialise the devclass. 1789 * Set the winning driver, devclass, and flags. 1790 */ 1791 result = device_set_driver(child, best->driver); 1792 if (result != 0) 1793 return (result); 1794 if (!child->devclass) { 1795 result = device_set_devclass(child, best->driver->name); 1796 if (result != 0) { 1797 (void)device_set_driver(child, NULL); 1798 return (result); 1799 } 1800 } 1801 resource_int_value(best->driver->name, child->unit, 1802 "flags", &child->devflags); 1803 1804 /* 1805 * A bit bogus. Call the probe method again to make sure that we have 1806 * the right description for the device. 1807 */ 1808 result = DEVICE_PROBE(child); 1809 if (result > 0) { 1810 if (!hasclass) 1811 (void)device_set_devclass(child, NULL); 1812 (void)device_set_driver(child, NULL); 1813 return (result); 1814 } 1815 1816 exact_match: 1817 child->state = DS_ALIVE; 1818 bus_data_generation_update(); 1819 return (0); 1820 } 1821 1822 /** 1823 * @brief Return the parent of a device 1824 */ 1825 device_t 1826 device_get_parent(device_t dev) 1827 { 1828 return (dev->parent); 1829 } 1830 1831 /** 1832 * @brief Get a list of children of a device 1833 * 1834 * An array containing a list of all the children of the given device 1835 * is allocated and returned in @p *devlistp. The number of devices 1836 * in the array is returned in @p *devcountp. The caller should free 1837 * the array using @c free(p, M_TEMP). 1838 * 1839 * @param dev the device to examine 1840 * @param devlistp points at location for array pointer return 1841 * value 1842 * @param devcountp points at location for array size return value 1843 * 1844 * @retval 0 success 1845 * @retval ENOMEM the array allocation failed 1846 */ 1847 int 1848 device_get_children(device_t dev, device_t **devlistp, int *devcountp) 1849 { 1850 int count; 1851 device_t child; 1852 device_t *list; 1853 1854 count = 0; 1855 TAILQ_FOREACH(child, &dev->children, link) { 1856 count++; 1857 } 1858 if (count == 0) { 1859 *devlistp = NULL; 1860 *devcountp = 0; 1861 return (0); 1862 } 1863 1864 list = malloc(count * sizeof(device_t), M_TEMP, M_NOWAIT|M_ZERO); 1865 if (!list) 1866 return (ENOMEM); 1867 1868 count = 0; 1869 TAILQ_FOREACH(child, &dev->children, link) { 1870 list[count] = child; 1871 count++; 1872 } 1873 1874 *devlistp = list; 1875 *devcountp = count; 1876 1877 return (0); 1878 } 1879 1880 /** 1881 * @brief Return the current driver for the device or @c NULL if there 1882 * is no driver currently attached 1883 */ 1884 driver_t * 1885 device_get_driver(device_t dev) 1886 { 1887 return (dev->driver); 1888 } 1889 1890 /** 1891 * @brief Return the current devclass for the device or @c NULL if 1892 * there is none. 1893 */ 1894 devclass_t 1895 device_get_devclass(device_t dev) 1896 { 1897 return (dev->devclass); 1898 } 1899 1900 /** 1901 * @brief Return the name of the device's devclass or @c NULL if there 1902 * is none. 1903 */ 1904 const char * 1905 device_get_name(device_t dev) 1906 { 1907 if (dev != NULL && dev->devclass) 1908 return (devclass_get_name(dev->devclass)); 1909 return (NULL); 1910 } 1911 1912 /** 1913 * @brief Return a string containing the device's devclass name 1914 * followed by an ascii representation of the device's unit number 1915 * (e.g. @c "foo2"). 1916 */ 1917 const char * 1918 device_get_nameunit(device_t dev) 1919 { 1920 return (dev->nameunit); 1921 } 1922 1923 /** 1924 * @brief Return the device's unit number. 1925 */ 1926 int 1927 device_get_unit(device_t dev) 1928 { 1929 return (dev->unit); 1930 } 1931 1932 /** 1933 * @brief Return the device's description string 1934 */ 1935 const char * 1936 device_get_desc(device_t dev) 1937 { 1938 return (dev->desc); 1939 } 1940 1941 /** 1942 * @brief Return the device's flags 1943 */ 1944 uint32_t 1945 device_get_flags(device_t dev) 1946 { 1947 return (dev->devflags); 1948 } 1949 1950 struct sysctl_ctx_list * 1951 device_get_sysctl_ctx(device_t dev) 1952 { 1953 return (&dev->sysctl_ctx); 1954 } 1955 1956 struct sysctl_oid * 1957 device_get_sysctl_tree(device_t dev) 1958 { 1959 return (dev->sysctl_tree); 1960 } 1961 1962 /** 1963 * @brief Print the name of the device followed by a colon and a space 1964 * 1965 * @returns the number of characters printed 1966 */ 1967 int 1968 device_print_prettyname(device_t dev) 1969 { 1970 const char *name = device_get_name(dev); 1971 1972 if (name == NULL) 1973 return (printf("unknown: ")); 1974 return (printf("%s%d: ", name, device_get_unit(dev))); 1975 } 1976 1977 /** 1978 * @brief Print the name of the device followed by a colon, a space 1979 * and the result of calling vprintf() with the value of @p fmt and 1980 * the following arguments. 1981 * 1982 * @returns the number of characters printed 1983 */ 1984 int 1985 device_printf(device_t dev, const char * fmt, ...) 1986 { 1987 char buf[128]; 1988 struct sbuf sb; 1989 const char *name; 1990 va_list ap; 1991 size_t retval; 1992 1993 retval = 0; 1994 1995 sbuf_new(&sb, buf, sizeof(buf), SBUF_FIXEDLEN); 1996 sbuf_set_drain(&sb, sbuf_printf_drain, &retval); 1997 1998 name = device_get_name(dev); 1999 2000 if (name == NULL) 2001 sbuf_cat(&sb, "unknown: "); 2002 else 2003 sbuf_printf(&sb, "%s%d: ", name, device_get_unit(dev)); 2004 2005 va_start(ap, fmt); 2006 sbuf_vprintf(&sb, fmt, ap); 2007 va_end(ap); 2008 2009 sbuf_finish(&sb); 2010 sbuf_delete(&sb); 2011 2012 return (retval); 2013 } 2014 2015 /** 2016 * @brief Print the name of the device followed by a colon, a space 2017 * and the result of calling log() with the value of @p fmt and 2018 * the following arguments. 2019 * 2020 * @returns the number of characters printed 2021 */ 2022 int 2023 device_log(device_t dev, int pri, const char * fmt, ...) 2024 { 2025 char buf[128]; 2026 struct sbuf sb; 2027 const char *name; 2028 va_list ap; 2029 size_t retval; 2030 2031 retval = 0; 2032 2033 sbuf_new(&sb, buf, sizeof(buf), SBUF_FIXEDLEN); 2034 2035 name = device_get_name(dev); 2036 2037 if (name == NULL) 2038 sbuf_cat(&sb, "unknown: "); 2039 else 2040 sbuf_printf(&sb, "%s%d: ", name, device_get_unit(dev)); 2041 2042 va_start(ap, fmt); 2043 sbuf_vprintf(&sb, fmt, ap); 2044 va_end(ap); 2045 2046 sbuf_finish(&sb); 2047 2048 log(pri, "%.*s", (int) sbuf_len(&sb), sbuf_data(&sb)); 2049 retval = sbuf_len(&sb); 2050 2051 sbuf_delete(&sb); 2052 2053 return (retval); 2054 } 2055 2056 /** 2057 * @internal 2058 */ 2059 static void 2060 device_set_desc_internal(device_t dev, const char *desc, bool allocated) 2061 { 2062 if (dev->desc && (dev->flags & DF_DESCMALLOCED)) { 2063 free(dev->desc, M_BUS); 2064 dev->flags &= ~DF_DESCMALLOCED; 2065 dev->desc = NULL; 2066 } 2067 2068 if (allocated && desc) 2069 dev->flags |= DF_DESCMALLOCED; 2070 dev->desc = __DECONST(char *, desc); 2071 2072 bus_data_generation_update(); 2073 } 2074 2075 /** 2076 * @brief Set the device's description 2077 * 2078 * The value of @c desc should be a string constant that will not 2079 * change (at least until the description is changed in a subsequent 2080 * call to device_set_desc() or device_set_desc_copy()). 2081 */ 2082 void 2083 device_set_desc(device_t dev, const char *desc) 2084 { 2085 device_set_desc_internal(dev, desc, false); 2086 } 2087 2088 /** 2089 * @brief Set the device's description 2090 * 2091 * A printf-like version of device_set_desc(). 2092 */ 2093 void 2094 device_set_descf(device_t dev, const char *fmt, ...) 2095 { 2096 va_list ap; 2097 char *buf = NULL; 2098 2099 va_start(ap, fmt); 2100 vasprintf(&buf, M_BUS, fmt, ap); 2101 va_end(ap); 2102 device_set_desc_internal(dev, buf, true); 2103 } 2104 2105 /** 2106 * @brief Set the device's description 2107 * 2108 * The string pointed to by @c desc is copied. Use this function if 2109 * the device description is generated, (e.g. with sprintf()). 2110 */ 2111 void 2112 device_set_desc_copy(device_t dev, const char *desc) 2113 { 2114 char *buf; 2115 2116 buf = strdup_flags(desc, M_BUS, M_NOWAIT); 2117 device_set_desc_internal(dev, buf, true); 2118 } 2119 2120 /** 2121 * @brief Set the device's flags 2122 */ 2123 void 2124 device_set_flags(device_t dev, uint32_t flags) 2125 { 2126 dev->devflags = flags; 2127 } 2128 2129 /** 2130 * @brief Return the device's softc field 2131 * 2132 * The softc is allocated and zeroed when a driver is attached, based 2133 * on the size field of the driver. 2134 */ 2135 void * 2136 device_get_softc(device_t dev) 2137 { 2138 return (dev->softc); 2139 } 2140 2141 /** 2142 * @brief Set the device's softc field 2143 * 2144 * Most drivers do not need to use this since the softc is allocated 2145 * automatically when the driver is attached. 2146 */ 2147 void 2148 device_set_softc(device_t dev, void *softc) 2149 { 2150 if (dev->softc && !(dev->flags & DF_EXTERNALSOFTC)) 2151 free(dev->softc, M_BUS_SC); 2152 dev->softc = softc; 2153 if (dev->softc) 2154 dev->flags |= DF_EXTERNALSOFTC; 2155 else 2156 dev->flags &= ~DF_EXTERNALSOFTC; 2157 } 2158 2159 /** 2160 * @brief Free claimed softc 2161 * 2162 * Most drivers do not need to use this since the softc is freed 2163 * automatically when the driver is detached. 2164 */ 2165 void 2166 device_free_softc(void *softc) 2167 { 2168 free(softc, M_BUS_SC); 2169 } 2170 2171 /** 2172 * @brief Claim softc 2173 * 2174 * This function can be used to let the driver free the automatically 2175 * allocated softc using "device_free_softc()". This function is 2176 * useful when the driver is refcounting the softc and the softc 2177 * cannot be freed when the "device_detach" method is called. 2178 */ 2179 void 2180 device_claim_softc(device_t dev) 2181 { 2182 if (dev->softc) 2183 dev->flags |= DF_EXTERNALSOFTC; 2184 else 2185 dev->flags &= ~DF_EXTERNALSOFTC; 2186 } 2187 2188 /** 2189 * @brief Get the device's ivars field 2190 * 2191 * The ivars field is used by the parent device to store per-device 2192 * state (e.g. the physical location of the device or a list of 2193 * resources). 2194 */ 2195 void * 2196 device_get_ivars(device_t dev) 2197 { 2198 KASSERT(dev != NULL, ("device_get_ivars(NULL, ...)")); 2199 return (dev->ivars); 2200 } 2201 2202 /** 2203 * @brief Set the device's ivars field 2204 */ 2205 void 2206 device_set_ivars(device_t dev, void * ivars) 2207 { 2208 KASSERT(dev != NULL, ("device_set_ivars(NULL, ...)")); 2209 dev->ivars = ivars; 2210 } 2211 2212 /** 2213 * @brief Return the device's state 2214 */ 2215 device_state_t 2216 device_get_state(device_t dev) 2217 { 2218 return (dev->state); 2219 } 2220 2221 /** 2222 * @brief Set the DF_ENABLED flag for the device 2223 */ 2224 void 2225 device_enable(device_t dev) 2226 { 2227 dev->flags |= DF_ENABLED; 2228 } 2229 2230 /** 2231 * @brief Clear the DF_ENABLED flag for the device 2232 */ 2233 void 2234 device_disable(device_t dev) 2235 { 2236 dev->flags &= ~DF_ENABLED; 2237 } 2238 2239 /** 2240 * @brief Increment the busy counter for the device 2241 */ 2242 void 2243 device_busy(device_t dev) 2244 { 2245 2246 /* 2247 * Mark the device as busy, recursively up the tree if this busy count 2248 * goes 0->1. 2249 */ 2250 if (refcount_acquire(&dev->busy) == 0 && dev->parent != NULL) 2251 device_busy(dev->parent); 2252 } 2253 2254 /** 2255 * @brief Decrement the busy counter for the device 2256 */ 2257 void 2258 device_unbusy(device_t dev) 2259 { 2260 2261 /* 2262 * Mark the device as unbsy, recursively if this is the last busy count. 2263 */ 2264 if (refcount_release(&dev->busy) && dev->parent != NULL) 2265 device_unbusy(dev->parent); 2266 } 2267 2268 /** 2269 * @brief Set the DF_QUIET flag for the device 2270 */ 2271 void 2272 device_quiet(device_t dev) 2273 { 2274 dev->flags |= DF_QUIET; 2275 } 2276 2277 /** 2278 * @brief Set the DF_QUIET_CHILDREN flag for the device 2279 */ 2280 void 2281 device_quiet_children(device_t dev) 2282 { 2283 dev->flags |= DF_QUIET_CHILDREN; 2284 } 2285 2286 /** 2287 * @brief Clear the DF_QUIET flag for the device 2288 */ 2289 void 2290 device_verbose(device_t dev) 2291 { 2292 dev->flags &= ~DF_QUIET; 2293 } 2294 2295 ssize_t 2296 device_get_property(device_t dev, const char *prop, void *val, size_t sz, 2297 device_property_type_t type) 2298 { 2299 device_t bus = device_get_parent(dev); 2300 2301 switch (type) { 2302 case DEVICE_PROP_ANY: 2303 case DEVICE_PROP_BUFFER: 2304 case DEVICE_PROP_HANDLE: /* Size checks done in implementation. */ 2305 break; 2306 case DEVICE_PROP_UINT32: 2307 if (sz % 4 != 0) 2308 return (-1); 2309 break; 2310 case DEVICE_PROP_UINT64: 2311 if (sz % 8 != 0) 2312 return (-1); 2313 break; 2314 default: 2315 return (-1); 2316 } 2317 2318 return (BUS_GET_PROPERTY(bus, dev, prop, val, sz, type)); 2319 } 2320 2321 bool 2322 device_has_property(device_t dev, const char *prop) 2323 { 2324 return (device_get_property(dev, prop, NULL, 0, DEVICE_PROP_ANY) >= 0); 2325 } 2326 2327 /** 2328 * @brief Return non-zero if the DF_QUIET_CHIDLREN flag is set on the device 2329 */ 2330 int 2331 device_has_quiet_children(device_t dev) 2332 { 2333 return ((dev->flags & DF_QUIET_CHILDREN) != 0); 2334 } 2335 2336 /** 2337 * @brief Return non-zero if the DF_QUIET flag is set on the device 2338 */ 2339 int 2340 device_is_quiet(device_t dev) 2341 { 2342 return ((dev->flags & DF_QUIET) != 0); 2343 } 2344 2345 /** 2346 * @brief Return non-zero if the DF_ENABLED flag is set on the device 2347 */ 2348 int 2349 device_is_enabled(device_t dev) 2350 { 2351 return ((dev->flags & DF_ENABLED) != 0); 2352 } 2353 2354 /** 2355 * @brief Return non-zero if the device was successfully probed 2356 */ 2357 int 2358 device_is_alive(device_t dev) 2359 { 2360 return (dev->state >= DS_ALIVE); 2361 } 2362 2363 /** 2364 * @brief Return non-zero if the device currently has a driver 2365 * attached to it 2366 */ 2367 int 2368 device_is_attached(device_t dev) 2369 { 2370 return (dev->state >= DS_ATTACHED); 2371 } 2372 2373 /** 2374 * @brief Return non-zero if the device is currently suspended. 2375 */ 2376 int 2377 device_is_suspended(device_t dev) 2378 { 2379 return ((dev->flags & DF_SUSPENDED) != 0); 2380 } 2381 2382 /** 2383 * @brief Set the devclass of a device 2384 * @see devclass_add_device(). 2385 */ 2386 int 2387 device_set_devclass(device_t dev, const char *classname) 2388 { 2389 devclass_t dc; 2390 int error; 2391 2392 if (!classname) { 2393 if (dev->devclass) 2394 devclass_delete_device(dev->devclass, dev); 2395 return (0); 2396 } 2397 2398 if (dev->devclass) { 2399 printf("device_set_devclass: device class already set\n"); 2400 return (EINVAL); 2401 } 2402 2403 dc = devclass_find_internal(classname, NULL, TRUE); 2404 if (!dc) 2405 return (ENOMEM); 2406 2407 error = devclass_add_device(dc, dev); 2408 2409 bus_data_generation_update(); 2410 return (error); 2411 } 2412 2413 /** 2414 * @brief Set the devclass of a device and mark the devclass fixed. 2415 * @see device_set_devclass() 2416 */ 2417 int 2418 device_set_devclass_fixed(device_t dev, const char *classname) 2419 { 2420 int error; 2421 2422 if (classname == NULL) 2423 return (EINVAL); 2424 2425 error = device_set_devclass(dev, classname); 2426 if (error) 2427 return (error); 2428 dev->flags |= DF_FIXEDCLASS; 2429 return (0); 2430 } 2431 2432 /** 2433 * @brief Query the device to determine if it's of a fixed devclass 2434 * @see device_set_devclass_fixed() 2435 */ 2436 bool 2437 device_is_devclass_fixed(device_t dev) 2438 { 2439 return ((dev->flags & DF_FIXEDCLASS) != 0); 2440 } 2441 2442 /** 2443 * @brief Set the driver of a device 2444 * 2445 * @retval 0 success 2446 * @retval EBUSY the device already has a driver attached 2447 * @retval ENOMEM a memory allocation failure occurred 2448 */ 2449 int 2450 device_set_driver(device_t dev, driver_t *driver) 2451 { 2452 int domain; 2453 struct domainset *policy; 2454 2455 if (dev->state >= DS_ATTACHED) 2456 return (EBUSY); 2457 2458 if (dev->driver == driver) 2459 return (0); 2460 2461 if (dev->softc && !(dev->flags & DF_EXTERNALSOFTC)) { 2462 free(dev->softc, M_BUS_SC); 2463 dev->softc = NULL; 2464 } 2465 device_set_desc(dev, NULL); 2466 kobj_delete((kobj_t) dev, NULL); 2467 dev->driver = driver; 2468 if (driver) { 2469 kobj_init((kobj_t) dev, (kobj_class_t) driver); 2470 if (!(dev->flags & DF_EXTERNALSOFTC) && driver->size > 0) { 2471 if (bus_get_domain(dev, &domain) == 0) 2472 policy = DOMAINSET_PREF(domain); 2473 else 2474 policy = DOMAINSET_RR(); 2475 dev->softc = malloc_domainset(driver->size, M_BUS_SC, 2476 policy, M_NOWAIT | M_ZERO); 2477 if (!dev->softc) { 2478 kobj_delete((kobj_t) dev, NULL); 2479 kobj_init((kobj_t) dev, &null_class); 2480 dev->driver = NULL; 2481 return (ENOMEM); 2482 } 2483 } 2484 } else { 2485 kobj_init((kobj_t) dev, &null_class); 2486 } 2487 2488 bus_data_generation_update(); 2489 return (0); 2490 } 2491 2492 /** 2493 * @brief Probe a device, and return this status. 2494 * 2495 * This function is the core of the device autoconfiguration 2496 * system. Its purpose is to select a suitable driver for a device and 2497 * then call that driver to initialise the hardware appropriately. The 2498 * driver is selected by calling the DEVICE_PROBE() method of a set of 2499 * candidate drivers and then choosing the driver which returned the 2500 * best value. This driver is then attached to the device using 2501 * device_attach(). 2502 * 2503 * The set of suitable drivers is taken from the list of drivers in 2504 * the parent device's devclass. If the device was originally created 2505 * with a specific class name (see device_add_child()), only drivers 2506 * with that name are probed, otherwise all drivers in the devclass 2507 * are probed. If no drivers return successful probe values in the 2508 * parent devclass, the search continues in the parent of that 2509 * devclass (see devclass_get_parent()) if any. 2510 * 2511 * @param dev the device to initialise 2512 * 2513 * @retval 0 success 2514 * @retval ENXIO no driver was found 2515 * @retval ENOMEM memory allocation failure 2516 * @retval non-zero some other unix error code 2517 * @retval -1 Device already attached 2518 */ 2519 int 2520 device_probe(device_t dev) 2521 { 2522 int error; 2523 2524 bus_topo_assert(); 2525 2526 if (dev->state >= DS_ALIVE) 2527 return (-1); 2528 2529 if (!(dev->flags & DF_ENABLED)) { 2530 if (bootverbose && device_get_name(dev) != NULL) { 2531 device_print_prettyname(dev); 2532 printf("not probed (disabled)\n"); 2533 } 2534 return (-1); 2535 } 2536 if ((error = device_probe_child(dev->parent, dev)) != 0) { 2537 if (bus_current_pass == BUS_PASS_DEFAULT && 2538 !(dev->flags & DF_DONENOMATCH)) { 2539 device_handle_nomatch(dev); 2540 } 2541 return (error); 2542 } 2543 return (0); 2544 } 2545 2546 /** 2547 * @brief Probe a device and attach a driver if possible 2548 * 2549 * calls device_probe() and attaches if that was successful. 2550 */ 2551 int 2552 device_probe_and_attach(device_t dev) 2553 { 2554 int error; 2555 2556 bus_topo_assert(); 2557 2558 error = device_probe(dev); 2559 if (error == -1) 2560 return (0); 2561 else if (error != 0) 2562 return (error); 2563 2564 return (device_attach(dev)); 2565 } 2566 2567 /** 2568 * @brief Attach a device driver to a device 2569 * 2570 * This function is a wrapper around the DEVICE_ATTACH() driver 2571 * method. In addition to calling DEVICE_ATTACH(), it initialises the 2572 * device's sysctl tree, optionally prints a description of the device 2573 * and queues a notification event for user-based device management 2574 * services. 2575 * 2576 * Normally this function is only called internally from 2577 * device_probe_and_attach(). 2578 * 2579 * @param dev the device to initialise 2580 * 2581 * @retval 0 success 2582 * @retval ENXIO no driver was found 2583 * @retval ENOMEM memory allocation failure 2584 * @retval non-zero some other unix error code 2585 */ 2586 int 2587 device_attach(device_t dev) 2588 { 2589 uint64_t attachtime; 2590 uint16_t attachentropy; 2591 int error; 2592 2593 if (resource_disabled(dev->driver->name, dev->unit)) { 2594 /* 2595 * Mostly detach the device, but leave it attached to 2596 * the devclass to reserve the name and unit. 2597 */ 2598 device_disable(dev); 2599 (void)device_set_driver(dev, NULL); 2600 dev->state = DS_NOTPRESENT; 2601 if (bootverbose) 2602 device_printf(dev, "disabled via hints entry\n"); 2603 return (ENXIO); 2604 } 2605 2606 KASSERT(IS_DEFAULT_VNET(TD_TO_VNET(curthread)), 2607 ("device_attach: curthread is not in default vnet")); 2608 CURVNET_SET_QUIET(TD_TO_VNET(curthread)); 2609 2610 device_sysctl_init(dev); 2611 if (!device_is_quiet(dev)) 2612 device_print_child(dev->parent, dev); 2613 attachtime = get_cyclecount(); 2614 dev->state = DS_ATTACHING; 2615 if ((error = DEVICE_ATTACH(dev)) != 0) { 2616 printf("device_attach: %s%d attach returned %d\n", 2617 dev->driver->name, dev->unit, error); 2618 BUS_CHILD_DETACHED(dev->parent, dev); 2619 if (disable_failed_devs) { 2620 /* 2621 * When the user has asked to disable failed devices, we 2622 * directly disable the device, but leave it in the 2623 * attaching state. It will not try to probe/attach the 2624 * device further. This leaves the device numbering 2625 * intact for other similar devices in the system. It 2626 * can be removed from this state with devctl. 2627 */ 2628 device_disable(dev); 2629 } else { 2630 /* 2631 * Otherwise, when attach fails, tear down the state 2632 * around that so we can retry when, for example, new 2633 * drivers are loaded. 2634 */ 2635 if (!(dev->flags & DF_FIXEDCLASS)) 2636 devclass_delete_device(dev->devclass, dev); 2637 (void)device_set_driver(dev, NULL); 2638 device_sysctl_fini(dev); 2639 KASSERT(dev->busy == 0, ("attach failed but busy")); 2640 dev->state = DS_NOTPRESENT; 2641 } 2642 CURVNET_RESTORE(); 2643 return (error); 2644 } 2645 CURVNET_RESTORE(); 2646 dev->flags |= DF_ATTACHED_ONCE; 2647 /* 2648 * We only need the low bits of this time, but ranges from tens to thousands 2649 * have been seen, so keep 2 bytes' worth. 2650 */ 2651 attachentropy = (uint16_t)(get_cyclecount() - attachtime); 2652 random_harvest_direct(&attachentropy, sizeof(attachentropy), RANDOM_ATTACH); 2653 device_sysctl_update(dev); 2654 dev->state = DS_ATTACHED; 2655 dev->flags &= ~DF_DONENOMATCH; 2656 EVENTHANDLER_DIRECT_INVOKE(device_attach, dev); 2657 return (0); 2658 } 2659 2660 /** 2661 * @brief Detach a driver from a device 2662 * 2663 * This function is a wrapper around the DEVICE_DETACH() driver 2664 * method. If the call to DEVICE_DETACH() succeeds, it calls 2665 * BUS_CHILD_DETACHED() for the parent of @p dev, queues a 2666 * notification event for user-based device management services and 2667 * cleans up the device's sysctl tree. 2668 * 2669 * @param dev the device to un-initialise 2670 * 2671 * @retval 0 success 2672 * @retval ENXIO no driver was found 2673 * @retval ENOMEM memory allocation failure 2674 * @retval non-zero some other unix error code 2675 */ 2676 int 2677 device_detach(device_t dev) 2678 { 2679 int error; 2680 2681 bus_topo_assert(); 2682 2683 PDEBUG(("%s", DEVICENAME(dev))); 2684 if (dev->busy > 0) 2685 return (EBUSY); 2686 if (dev->state == DS_ATTACHING) { 2687 device_printf(dev, "device in attaching state! Deferring detach.\n"); 2688 return (EBUSY); 2689 } 2690 if (dev->state != DS_ATTACHED) 2691 return (0); 2692 2693 EVENTHANDLER_DIRECT_INVOKE(device_detach, dev, EVHDEV_DETACH_BEGIN); 2694 if ((error = DEVICE_DETACH(dev)) != 0) { 2695 EVENTHANDLER_DIRECT_INVOKE(device_detach, dev, 2696 EVHDEV_DETACH_FAILED); 2697 return (error); 2698 } else { 2699 EVENTHANDLER_DIRECT_INVOKE(device_detach, dev, 2700 EVHDEV_DETACH_COMPLETE); 2701 } 2702 if (!device_is_quiet(dev)) 2703 device_printf(dev, "detached\n"); 2704 if (dev->parent) 2705 BUS_CHILD_DETACHED(dev->parent, dev); 2706 2707 if (!(dev->flags & DF_FIXEDCLASS)) 2708 devclass_delete_device(dev->devclass, dev); 2709 2710 device_verbose(dev); 2711 dev->state = DS_NOTPRESENT; 2712 (void)device_set_driver(dev, NULL); 2713 device_sysctl_fini(dev); 2714 2715 return (0); 2716 } 2717 2718 /** 2719 * @brief Tells a driver to quiesce itself. 2720 * 2721 * This function is a wrapper around the DEVICE_QUIESCE() driver 2722 * method. If the call to DEVICE_QUIESCE() succeeds. 2723 * 2724 * @param dev the device to quiesce 2725 * 2726 * @retval 0 success 2727 * @retval ENXIO no driver was found 2728 * @retval ENOMEM memory allocation failure 2729 * @retval non-zero some other unix error code 2730 */ 2731 int 2732 device_quiesce(device_t dev) 2733 { 2734 PDEBUG(("%s", DEVICENAME(dev))); 2735 if (dev->busy > 0) 2736 return (EBUSY); 2737 if (dev->state != DS_ATTACHED) 2738 return (0); 2739 2740 return (DEVICE_QUIESCE(dev)); 2741 } 2742 2743 /** 2744 * @brief Notify a device of system shutdown 2745 * 2746 * This function calls the DEVICE_SHUTDOWN() driver method if the 2747 * device currently has an attached driver. 2748 * 2749 * @returns the value returned by DEVICE_SHUTDOWN() 2750 */ 2751 int 2752 device_shutdown(device_t dev) 2753 { 2754 if (dev->state < DS_ATTACHED) 2755 return (0); 2756 return (DEVICE_SHUTDOWN(dev)); 2757 } 2758 2759 /** 2760 * @brief Set the unit number of a device 2761 * 2762 * This function can be used to override the unit number used for a 2763 * device (e.g. to wire a device to a pre-configured unit number). 2764 */ 2765 int 2766 device_set_unit(device_t dev, int unit) 2767 { 2768 devclass_t dc; 2769 int err; 2770 2771 if (unit == dev->unit) 2772 return (0); 2773 dc = device_get_devclass(dev); 2774 if (unit < dc->maxunit && dc->devices[unit]) 2775 return (EBUSY); 2776 err = devclass_delete_device(dc, dev); 2777 if (err) 2778 return (err); 2779 dev->unit = unit; 2780 err = devclass_add_device(dc, dev); 2781 if (err) 2782 return (err); 2783 2784 bus_data_generation_update(); 2785 return (0); 2786 } 2787 2788 /*======================================*/ 2789 /* 2790 * Some useful method implementations to make life easier for bus drivers. 2791 */ 2792 2793 /** 2794 * @brief Initialize a resource mapping request 2795 * 2796 * This is the internal implementation of the public API 2797 * resource_init_map_request. Callers may be using a different layout 2798 * of struct resource_map_request than the kernel, so callers pass in 2799 * the size of the structure they are using to identify the structure 2800 * layout. 2801 */ 2802 void 2803 resource_init_map_request_impl(struct resource_map_request *args, size_t sz) 2804 { 2805 bzero(args, sz); 2806 args->size = sz; 2807 args->memattr = VM_MEMATTR_DEVICE; 2808 } 2809 2810 /** 2811 * @brief Validate a resource mapping request 2812 * 2813 * Translate a device driver's mapping request (@p in) to a struct 2814 * resource_map_request using the current structure layout (@p out). 2815 * In addition, validate the offset and length from the mapping 2816 * request against the bounds of the resource @p r. If the offset or 2817 * length are invalid, fail with EINVAL. If the offset and length are 2818 * valid, the absolute starting address of the requested mapping is 2819 * returned in @p startp and the length of the requested mapping is 2820 * returned in @p lengthp. 2821 */ 2822 int 2823 resource_validate_map_request(struct resource *r, 2824 struct resource_map_request *in, struct resource_map_request *out, 2825 rman_res_t *startp, rman_res_t *lengthp) 2826 { 2827 rman_res_t end, length, start; 2828 2829 /* 2830 * This assumes that any callers of this function are compiled 2831 * into the kernel and use the same version of the structure 2832 * as this file. 2833 */ 2834 MPASS(out->size == sizeof(struct resource_map_request)); 2835 2836 if (in != NULL) 2837 bcopy(in, out, imin(in->size, out->size)); 2838 start = rman_get_start(r) + out->offset; 2839 if (out->length == 0) 2840 length = rman_get_size(r); 2841 else 2842 length = out->length; 2843 end = start + length - 1; 2844 if (start > rman_get_end(r) || start < rman_get_start(r)) 2845 return (EINVAL); 2846 if (end > rman_get_end(r) || end < start) 2847 return (EINVAL); 2848 *lengthp = length; 2849 *startp = start; 2850 return (0); 2851 } 2852 2853 /** 2854 * @brief Initialise a resource list. 2855 * 2856 * @param rl the resource list to initialise 2857 */ 2858 void 2859 resource_list_init(struct resource_list *rl) 2860 { 2861 STAILQ_INIT(rl); 2862 } 2863 2864 /** 2865 * @brief Reclaim memory used by a resource list. 2866 * 2867 * This function frees the memory for all resource entries on the list 2868 * (if any). 2869 * 2870 * @param rl the resource list to free 2871 */ 2872 void 2873 resource_list_free(struct resource_list *rl) 2874 { 2875 struct resource_list_entry *rle; 2876 2877 while ((rle = STAILQ_FIRST(rl)) != NULL) { 2878 if (rle->res) 2879 panic("resource_list_free: resource entry is busy"); 2880 STAILQ_REMOVE_HEAD(rl, link); 2881 free(rle, M_BUS); 2882 } 2883 } 2884 2885 /** 2886 * @brief Add a resource entry. 2887 * 2888 * This function adds a resource entry using the given @p type, @p 2889 * start, @p end and @p count values. A rid value is chosen by 2890 * searching sequentially for the first unused rid starting at zero. 2891 * 2892 * @param rl the resource list to edit 2893 * @param type the resource entry type (e.g. SYS_RES_MEMORY) 2894 * @param start the start address of the resource 2895 * @param end the end address of the resource 2896 * @param count XXX end-start+1 2897 */ 2898 int 2899 resource_list_add_next(struct resource_list *rl, int type, rman_res_t start, 2900 rman_res_t end, rman_res_t count) 2901 { 2902 int rid; 2903 2904 rid = 0; 2905 while (resource_list_find(rl, type, rid) != NULL) 2906 rid++; 2907 resource_list_add(rl, type, rid, start, end, count); 2908 return (rid); 2909 } 2910 2911 /** 2912 * @brief Add or modify a resource entry. 2913 * 2914 * If an existing entry exists with the same type and rid, it will be 2915 * modified using the given values of @p start, @p end and @p 2916 * count. If no entry exists, a new one will be created using the 2917 * given values. The resource list entry that matches is then returned. 2918 * 2919 * @param rl the resource list to edit 2920 * @param type the resource entry type (e.g. SYS_RES_MEMORY) 2921 * @param rid the resource identifier 2922 * @param start the start address of the resource 2923 * @param end the end address of the resource 2924 * @param count XXX end-start+1 2925 */ 2926 struct resource_list_entry * 2927 resource_list_add(struct resource_list *rl, int type, int rid, 2928 rman_res_t start, rman_res_t end, rman_res_t count) 2929 { 2930 struct resource_list_entry *rle; 2931 2932 rle = resource_list_find(rl, type, rid); 2933 if (!rle) { 2934 rle = malloc(sizeof(struct resource_list_entry), M_BUS, 2935 M_NOWAIT); 2936 if (!rle) 2937 panic("resource_list_add: can't record entry"); 2938 STAILQ_INSERT_TAIL(rl, rle, link); 2939 rle->type = type; 2940 rle->rid = rid; 2941 rle->res = NULL; 2942 rle->flags = 0; 2943 } 2944 2945 if (rle->res) 2946 panic("resource_list_add: resource entry is busy"); 2947 2948 rle->start = start; 2949 rle->end = end; 2950 rle->count = count; 2951 return (rle); 2952 } 2953 2954 /** 2955 * @brief Determine if a resource entry is busy. 2956 * 2957 * Returns true if a resource entry is busy meaning that it has an 2958 * associated resource that is not an unallocated "reserved" resource. 2959 * 2960 * @param rl the resource list to search 2961 * @param type the resource entry type (e.g. SYS_RES_MEMORY) 2962 * @param rid the resource identifier 2963 * 2964 * @returns Non-zero if the entry is busy, zero otherwise. 2965 */ 2966 int 2967 resource_list_busy(struct resource_list *rl, int type, int rid) 2968 { 2969 struct resource_list_entry *rle; 2970 2971 rle = resource_list_find(rl, type, rid); 2972 if (rle == NULL || rle->res == NULL) 2973 return (0); 2974 if ((rle->flags & (RLE_RESERVED | RLE_ALLOCATED)) == RLE_RESERVED) { 2975 KASSERT(!(rman_get_flags(rle->res) & RF_ACTIVE), 2976 ("reserved resource is active")); 2977 return (0); 2978 } 2979 return (1); 2980 } 2981 2982 /** 2983 * @brief Determine if a resource entry is reserved. 2984 * 2985 * Returns true if a resource entry is reserved meaning that it has an 2986 * associated "reserved" resource. The resource can either be 2987 * allocated or unallocated. 2988 * 2989 * @param rl the resource list to search 2990 * @param type the resource entry type (e.g. SYS_RES_MEMORY) 2991 * @param rid the resource identifier 2992 * 2993 * @returns Non-zero if the entry is reserved, zero otherwise. 2994 */ 2995 int 2996 resource_list_reserved(struct resource_list *rl, int type, int rid) 2997 { 2998 struct resource_list_entry *rle; 2999 3000 rle = resource_list_find(rl, type, rid); 3001 if (rle != NULL && rle->flags & RLE_RESERVED) 3002 return (1); 3003 return (0); 3004 } 3005 3006 /** 3007 * @brief Find a resource entry by type and rid. 3008 * 3009 * @param rl the resource list to search 3010 * @param type the resource entry type (e.g. SYS_RES_MEMORY) 3011 * @param rid the resource identifier 3012 * 3013 * @returns the resource entry pointer or NULL if there is no such 3014 * entry. 3015 */ 3016 struct resource_list_entry * 3017 resource_list_find(struct resource_list *rl, int type, int rid) 3018 { 3019 struct resource_list_entry *rle; 3020 3021 STAILQ_FOREACH(rle, rl, link) { 3022 if (rle->type == type && rle->rid == rid) 3023 return (rle); 3024 } 3025 return (NULL); 3026 } 3027 3028 /** 3029 * @brief Delete a resource entry. 3030 * 3031 * @param rl the resource list to edit 3032 * @param type the resource entry type (e.g. SYS_RES_MEMORY) 3033 * @param rid the resource identifier 3034 */ 3035 void 3036 resource_list_delete(struct resource_list *rl, int type, int rid) 3037 { 3038 struct resource_list_entry *rle = resource_list_find(rl, type, rid); 3039 3040 if (rle) { 3041 if (rle->res != NULL) 3042 panic("resource_list_delete: resource has not been released"); 3043 STAILQ_REMOVE(rl, rle, resource_list_entry, link); 3044 free(rle, M_BUS); 3045 } 3046 } 3047 3048 /** 3049 * @brief Allocate a reserved resource 3050 * 3051 * This can be used by buses to force the allocation of resources 3052 * that are always active in the system even if they are not allocated 3053 * by a driver (e.g. PCI BARs). This function is usually called when 3054 * adding a new child to the bus. The resource is allocated from the 3055 * parent bus when it is reserved. The resource list entry is marked 3056 * with RLE_RESERVED to note that it is a reserved resource. 3057 * 3058 * Subsequent attempts to allocate the resource with 3059 * resource_list_alloc() will succeed the first time and will set 3060 * RLE_ALLOCATED to note that it has been allocated. When a reserved 3061 * resource that has been allocated is released with 3062 * resource_list_release() the resource RLE_ALLOCATED is cleared, but 3063 * the actual resource remains allocated. The resource can be released to 3064 * the parent bus by calling resource_list_unreserve(). 3065 * 3066 * @param rl the resource list to allocate from 3067 * @param bus the parent device of @p child 3068 * @param child the device for which the resource is being reserved 3069 * @param type the type of resource to allocate 3070 * @param rid a pointer to the resource identifier 3071 * @param start hint at the start of the resource range - pass 3072 * @c 0 for any start address 3073 * @param end hint at the end of the resource range - pass 3074 * @c ~0 for any end address 3075 * @param count hint at the size of range required - pass @c 1 3076 * for any size 3077 * @param flags any extra flags to control the resource 3078 * allocation - see @c RF_XXX flags in 3079 * <sys/rman.h> for details 3080 * 3081 * @returns the resource which was allocated or @c NULL if no 3082 * resource could be allocated 3083 */ 3084 struct resource * 3085 resource_list_reserve(struct resource_list *rl, device_t bus, device_t child, 3086 int type, int *rid, rman_res_t start, rman_res_t end, rman_res_t count, u_int flags) 3087 { 3088 struct resource_list_entry *rle = NULL; 3089 int passthrough = (device_get_parent(child) != bus); 3090 struct resource *r; 3091 3092 if (passthrough) 3093 panic( 3094 "resource_list_reserve() should only be called for direct children"); 3095 if (flags & RF_ACTIVE) 3096 panic( 3097 "resource_list_reserve() should only reserve inactive resources"); 3098 3099 r = resource_list_alloc(rl, bus, child, type, rid, start, end, count, 3100 flags); 3101 if (r != NULL) { 3102 rle = resource_list_find(rl, type, *rid); 3103 rle->flags |= RLE_RESERVED; 3104 } 3105 return (r); 3106 } 3107 3108 /** 3109 * @brief Helper function for implementing BUS_ALLOC_RESOURCE() 3110 * 3111 * Implement BUS_ALLOC_RESOURCE() by looking up a resource from the list 3112 * and passing the allocation up to the parent of @p bus. This assumes 3113 * that the first entry of @c device_get_ivars(child) is a struct 3114 * resource_list. This also handles 'passthrough' allocations where a 3115 * child is a remote descendant of bus by passing the allocation up to 3116 * the parent of bus. 3117 * 3118 * Typically, a bus driver would store a list of child resources 3119 * somewhere in the child device's ivars (see device_get_ivars()) and 3120 * its implementation of BUS_ALLOC_RESOURCE() would find that list and 3121 * then call resource_list_alloc() to perform the allocation. 3122 * 3123 * @param rl the resource list to allocate from 3124 * @param bus the parent device of @p child 3125 * @param child the device which is requesting an allocation 3126 * @param type the type of resource to allocate 3127 * @param rid a pointer to the resource identifier 3128 * @param start hint at the start of the resource range - pass 3129 * @c 0 for any start address 3130 * @param end hint at the end of the resource range - pass 3131 * @c ~0 for any end address 3132 * @param count hint at the size of range required - pass @c 1 3133 * for any size 3134 * @param flags any extra flags to control the resource 3135 * allocation - see @c RF_XXX flags in 3136 * <sys/rman.h> for details 3137 * 3138 * @returns the resource which was allocated or @c NULL if no 3139 * resource could be allocated 3140 */ 3141 struct resource * 3142 resource_list_alloc(struct resource_list *rl, device_t bus, device_t child, 3143 int type, int *rid, rman_res_t start, rman_res_t end, rman_res_t count, u_int flags) 3144 { 3145 struct resource_list_entry *rle = NULL; 3146 int passthrough = (device_get_parent(child) != bus); 3147 int isdefault = RMAN_IS_DEFAULT_RANGE(start, end); 3148 3149 if (passthrough) { 3150 return (BUS_ALLOC_RESOURCE(device_get_parent(bus), child, 3151 type, rid, start, end, count, flags)); 3152 } 3153 3154 rle = resource_list_find(rl, type, *rid); 3155 3156 if (!rle) 3157 return (NULL); /* no resource of that type/rid */ 3158 3159 if (rle->res) { 3160 if (rle->flags & RLE_RESERVED) { 3161 if (rle->flags & RLE_ALLOCATED) 3162 return (NULL); 3163 if ((flags & RF_ACTIVE) && 3164 bus_activate_resource(child, type, *rid, 3165 rle->res) != 0) 3166 return (NULL); 3167 rle->flags |= RLE_ALLOCATED; 3168 return (rle->res); 3169 } 3170 device_printf(bus, 3171 "resource entry %#x type %d for child %s is busy\n", *rid, 3172 type, device_get_nameunit(child)); 3173 return (NULL); 3174 } 3175 3176 if (isdefault) { 3177 start = rle->start; 3178 count = ulmax(count, rle->count); 3179 end = ulmax(rle->end, start + count - 1); 3180 } 3181 3182 rle->res = BUS_ALLOC_RESOURCE(device_get_parent(bus), child, 3183 type, rid, start, end, count, flags); 3184 3185 /* 3186 * Record the new range. 3187 */ 3188 if (rle->res) { 3189 rle->start = rman_get_start(rle->res); 3190 rle->end = rman_get_end(rle->res); 3191 rle->count = count; 3192 } 3193 3194 return (rle->res); 3195 } 3196 3197 /** 3198 * @brief Helper function for implementing BUS_RELEASE_RESOURCE() 3199 * 3200 * Implement BUS_RELEASE_RESOURCE() using a resource list. Normally 3201 * used with resource_list_alloc(). 3202 * 3203 * @param rl the resource list which was allocated from 3204 * @param bus the parent device of @p child 3205 * @param child the device which is requesting a release 3206 * @param res the resource to release 3207 * 3208 * @retval 0 success 3209 * @retval non-zero a standard unix error code indicating what 3210 * error condition prevented the operation 3211 */ 3212 int 3213 resource_list_release(struct resource_list *rl, device_t bus, device_t child, 3214 struct resource *res) 3215 { 3216 struct resource_list_entry *rle = NULL; 3217 int passthrough = (device_get_parent(child) != bus); 3218 int error; 3219 3220 if (passthrough) { 3221 return (BUS_RELEASE_RESOURCE(device_get_parent(bus), child, 3222 res)); 3223 } 3224 3225 rle = resource_list_find(rl, rman_get_type(res), rman_get_rid(res)); 3226 3227 if (!rle) 3228 panic("resource_list_release: can't find resource"); 3229 if (!rle->res) 3230 panic("resource_list_release: resource entry is not busy"); 3231 if (rle->flags & RLE_RESERVED) { 3232 if (rle->flags & RLE_ALLOCATED) { 3233 if (rman_get_flags(res) & RF_ACTIVE) { 3234 error = bus_deactivate_resource(child, res); 3235 if (error) 3236 return (error); 3237 } 3238 rle->flags &= ~RLE_ALLOCATED; 3239 return (0); 3240 } 3241 return (EINVAL); 3242 } 3243 3244 error = BUS_RELEASE_RESOURCE(device_get_parent(bus), child, res); 3245 if (error) 3246 return (error); 3247 3248 rle->res = NULL; 3249 return (0); 3250 } 3251 3252 /** 3253 * @brief Release all active resources of a given type 3254 * 3255 * Release all active resources of a specified type. This is intended 3256 * to be used to cleanup resources leaked by a driver after detach or 3257 * a failed attach. 3258 * 3259 * @param rl the resource list which was allocated from 3260 * @param bus the parent device of @p child 3261 * @param child the device whose active resources are being released 3262 * @param type the type of resources to release 3263 * 3264 * @retval 0 success 3265 * @retval EBUSY at least one resource was active 3266 */ 3267 int 3268 resource_list_release_active(struct resource_list *rl, device_t bus, 3269 device_t child, int type) 3270 { 3271 struct resource_list_entry *rle; 3272 int error, retval; 3273 3274 retval = 0; 3275 STAILQ_FOREACH(rle, rl, link) { 3276 if (rle->type != type) 3277 continue; 3278 if (rle->res == NULL) 3279 continue; 3280 if ((rle->flags & (RLE_RESERVED | RLE_ALLOCATED)) == 3281 RLE_RESERVED) 3282 continue; 3283 retval = EBUSY; 3284 error = resource_list_release(rl, bus, child, rle->res); 3285 if (error != 0) 3286 device_printf(bus, 3287 "Failed to release active resource: %d\n", error); 3288 } 3289 return (retval); 3290 } 3291 3292 /** 3293 * @brief Fully release a reserved resource 3294 * 3295 * Fully releases a resource reserved via resource_list_reserve(). 3296 * 3297 * @param rl the resource list which was allocated from 3298 * @param bus the parent device of @p child 3299 * @param child the device whose reserved resource is being released 3300 * @param type the type of resource to release 3301 * @param rid the resource identifier 3302 * @param res the resource to release 3303 * 3304 * @retval 0 success 3305 * @retval non-zero a standard unix error code indicating what 3306 * error condition prevented the operation 3307 */ 3308 int 3309 resource_list_unreserve(struct resource_list *rl, device_t bus, device_t child, 3310 int type, int rid) 3311 { 3312 struct resource_list_entry *rle = NULL; 3313 int passthrough = (device_get_parent(child) != bus); 3314 3315 if (passthrough) 3316 panic( 3317 "resource_list_unreserve() should only be called for direct children"); 3318 3319 rle = resource_list_find(rl, type, rid); 3320 3321 if (!rle) 3322 panic("resource_list_unreserve: can't find resource"); 3323 if (!(rle->flags & RLE_RESERVED)) 3324 return (EINVAL); 3325 if (rle->flags & RLE_ALLOCATED) 3326 return (EBUSY); 3327 rle->flags &= ~RLE_RESERVED; 3328 return (resource_list_release(rl, bus, child, rle->res)); 3329 } 3330 3331 /** 3332 * @brief Print a description of resources in a resource list 3333 * 3334 * Print all resources of a specified type, for use in BUS_PRINT_CHILD(). 3335 * The name is printed if at least one resource of the given type is available. 3336 * The format is used to print resource start and end. 3337 * 3338 * @param rl the resource list to print 3339 * @param name the name of @p type, e.g. @c "memory" 3340 * @param type type type of resource entry to print 3341 * @param format printf(9) format string to print resource 3342 * start and end values 3343 * 3344 * @returns the number of characters printed 3345 */ 3346 int 3347 resource_list_print_type(struct resource_list *rl, const char *name, int type, 3348 const char *format) 3349 { 3350 struct resource_list_entry *rle; 3351 int printed, retval; 3352 3353 printed = 0; 3354 retval = 0; 3355 /* Yes, this is kinda cheating */ 3356 STAILQ_FOREACH(rle, rl, link) { 3357 if (rle->type == type) { 3358 if (printed == 0) 3359 retval += printf(" %s ", name); 3360 else 3361 retval += printf(","); 3362 printed++; 3363 retval += printf(format, rle->start); 3364 if (rle->count > 1) { 3365 retval += printf("-"); 3366 retval += printf(format, rle->start + 3367 rle->count - 1); 3368 } 3369 } 3370 } 3371 return (retval); 3372 } 3373 3374 /** 3375 * @brief Releases all the resources in a list. 3376 * 3377 * @param rl The resource list to purge. 3378 * 3379 * @returns nothing 3380 */ 3381 void 3382 resource_list_purge(struct resource_list *rl) 3383 { 3384 struct resource_list_entry *rle; 3385 3386 while ((rle = STAILQ_FIRST(rl)) != NULL) { 3387 if (rle->res) 3388 bus_release_resource(rman_get_device(rle->res), 3389 rle->type, rle->rid, rle->res); 3390 STAILQ_REMOVE_HEAD(rl, link); 3391 free(rle, M_BUS); 3392 } 3393 } 3394 3395 device_t 3396 bus_generic_add_child(device_t dev, u_int order, const char *name, int unit) 3397 { 3398 return (device_add_child_ordered(dev, order, name, unit)); 3399 } 3400 3401 /** 3402 * @brief Helper function for implementing DEVICE_PROBE() 3403 * 3404 * This function can be used to help implement the DEVICE_PROBE() for 3405 * a bus (i.e. a device which has other devices attached to it). It 3406 * calls the DEVICE_IDENTIFY() method of each driver in the device's 3407 * devclass. 3408 */ 3409 int 3410 bus_generic_probe(device_t dev) 3411 { 3412 bus_identify_children(dev); 3413 return (0); 3414 } 3415 3416 /** 3417 * @brief Ask drivers to add child devices of the given device. 3418 * 3419 * This function allows drivers for child devices of a bus to identify 3420 * child devices and add them as children of the given device. NB: 3421 * The driver for @param dev must implement the BUS_ADD_CHILD method. 3422 * 3423 * @param dev the parent device 3424 */ 3425 void 3426 bus_identify_children(device_t dev) 3427 { 3428 devclass_t dc = dev->devclass; 3429 driverlink_t dl; 3430 3431 TAILQ_FOREACH(dl, &dc->drivers, link) { 3432 /* 3433 * If this driver's pass is too high, then ignore it. 3434 * For most drivers in the default pass, this will 3435 * never be true. For early-pass drivers they will 3436 * only call the identify routines of eligible drivers 3437 * when this routine is called. Drivers for later 3438 * passes should have their identify routines called 3439 * on early-pass buses during BUS_NEW_PASS(). 3440 */ 3441 if (dl->pass > bus_current_pass) 3442 continue; 3443 DEVICE_IDENTIFY(dl->driver, dev); 3444 } 3445 } 3446 3447 /** 3448 * @brief Helper function for implementing DEVICE_ATTACH() 3449 * 3450 * This function can be used to help implement the DEVICE_ATTACH() for 3451 * a bus. It calls device_probe_and_attach() for each of the device's 3452 * children. 3453 */ 3454 int 3455 bus_generic_attach(device_t dev) 3456 { 3457 bus_attach_children(dev); 3458 return (0); 3459 } 3460 3461 /** 3462 * @brief Probe and attach all children of the given device 3463 * 3464 * This function attempts to attach a device driver to each unattached 3465 * child of the given device using device_probe_and_attach(). If an 3466 * individual child fails to attach this function continues attaching 3467 * other children. 3468 * 3469 * @param dev the parent device 3470 */ 3471 void 3472 bus_attach_children(device_t dev) 3473 { 3474 device_t child; 3475 3476 TAILQ_FOREACH(child, &dev->children, link) { 3477 device_probe_and_attach(child); 3478 } 3479 } 3480 3481 /** 3482 * @brief Helper function for delaying attaching children 3483 * 3484 * Many buses can't run transactions on the bus which children need to probe and 3485 * attach until after interrupts and/or timers are running. This function 3486 * delays their attach until interrupts and timers are enabled. 3487 */ 3488 void 3489 bus_delayed_attach_children(device_t dev) 3490 { 3491 /* Probe and attach the bus children when interrupts are available */ 3492 config_intrhook_oneshot((ich_func_t)bus_attach_children, dev); 3493 } 3494 3495 /** 3496 * @brief Helper function for implementing DEVICE_DETACH() 3497 * 3498 * This function can be used to help implement the DEVICE_DETACH() for 3499 * a bus. It detaches and deletes all children. If an individual 3500 * child fails to detach, this function stops and returns an error. 3501 * 3502 * @param dev the parent device 3503 * 3504 * @retval 0 success 3505 * @retval non-zero a device would not detach 3506 */ 3507 int 3508 bus_generic_detach(device_t dev) 3509 { 3510 int error; 3511 3512 error = bus_detach_children(dev); 3513 if (error != 0) 3514 return (error); 3515 3516 return (device_delete_children(dev)); 3517 } 3518 3519 /** 3520 * @brief Detach drivers from all children of a device 3521 * 3522 * This function attempts to detach a device driver from each attached 3523 * child of the given device using device_detach(). If an individual 3524 * child fails to detach this function stops and returns an error. 3525 * NB: Children that were successfully detached are not re-attached if 3526 * an error occurs. 3527 * 3528 * @param dev the parent device 3529 * 3530 * @retval 0 success 3531 * @retval non-zero a device would not detach 3532 */ 3533 int 3534 bus_detach_children(device_t dev) 3535 { 3536 device_t child; 3537 int error; 3538 3539 /* 3540 * Detach children in the reverse order. 3541 * See bus_generic_suspend for details. 3542 */ 3543 TAILQ_FOREACH_REVERSE(child, &dev->children, device_list, link) { 3544 if ((error = device_detach(child)) != 0) 3545 return (error); 3546 } 3547 3548 return (0); 3549 } 3550 3551 /** 3552 * @brief Helper function for implementing DEVICE_SHUTDOWN() 3553 * 3554 * This function can be used to help implement the DEVICE_SHUTDOWN() 3555 * for a bus. It calls device_shutdown() for each of the device's 3556 * children. 3557 */ 3558 int 3559 bus_generic_shutdown(device_t dev) 3560 { 3561 device_t child; 3562 3563 /* 3564 * Shut down children in the reverse order. 3565 * See bus_generic_suspend for details. 3566 */ 3567 TAILQ_FOREACH_REVERSE(child, &dev->children, device_list, link) { 3568 device_shutdown(child); 3569 } 3570 3571 return (0); 3572 } 3573 3574 /** 3575 * @brief Default function for suspending a child device. 3576 * 3577 * This function is to be used by a bus's DEVICE_SUSPEND_CHILD(). 3578 */ 3579 int 3580 bus_generic_suspend_child(device_t dev, device_t child) 3581 { 3582 int error; 3583 3584 error = DEVICE_SUSPEND(child); 3585 3586 if (error == 0) { 3587 child->flags |= DF_SUSPENDED; 3588 } else { 3589 printf("DEVICE_SUSPEND(%s) failed: %d\n", 3590 device_get_nameunit(child), error); 3591 } 3592 3593 return (error); 3594 } 3595 3596 /** 3597 * @brief Default function for resuming a child device. 3598 * 3599 * This function is to be used by a bus's DEVICE_RESUME_CHILD(). 3600 */ 3601 int 3602 bus_generic_resume_child(device_t dev, device_t child) 3603 { 3604 DEVICE_RESUME(child); 3605 child->flags &= ~DF_SUSPENDED; 3606 3607 return (0); 3608 } 3609 3610 /** 3611 * @brief Helper function for implementing DEVICE_SUSPEND() 3612 * 3613 * This function can be used to help implement the DEVICE_SUSPEND() 3614 * for a bus. It calls DEVICE_SUSPEND() for each of the device's 3615 * children. If any call to DEVICE_SUSPEND() fails, the suspend 3616 * operation is aborted and any devices which were suspended are 3617 * resumed immediately by calling their DEVICE_RESUME() methods. 3618 */ 3619 int 3620 bus_generic_suspend(device_t dev) 3621 { 3622 int error; 3623 device_t child; 3624 3625 /* 3626 * Suspend children in the reverse order. 3627 * For most buses all children are equal, so the order does not matter. 3628 * Other buses, such as acpi, carefully order their child devices to 3629 * express implicit dependencies between them. For such buses it is 3630 * safer to bring down devices in the reverse order. 3631 */ 3632 TAILQ_FOREACH_REVERSE(child, &dev->children, device_list, link) { 3633 error = BUS_SUSPEND_CHILD(dev, child); 3634 if (error != 0) { 3635 child = TAILQ_NEXT(child, link); 3636 if (child != NULL) { 3637 TAILQ_FOREACH_FROM(child, &dev->children, link) 3638 BUS_RESUME_CHILD(dev, child); 3639 } 3640 return (error); 3641 } 3642 } 3643 return (0); 3644 } 3645 3646 /** 3647 * @brief Helper function for implementing DEVICE_RESUME() 3648 * 3649 * This function can be used to help implement the DEVICE_RESUME() for 3650 * a bus. It calls DEVICE_RESUME() on each of the device's children. 3651 */ 3652 int 3653 bus_generic_resume(device_t dev) 3654 { 3655 device_t child; 3656 3657 TAILQ_FOREACH(child, &dev->children, link) { 3658 BUS_RESUME_CHILD(dev, child); 3659 /* if resume fails, there's nothing we can usefully do... */ 3660 } 3661 return (0); 3662 } 3663 3664 /** 3665 * @brief Helper function for implementing BUS_RESET_POST 3666 * 3667 * Bus can use this function to implement common operations of 3668 * re-attaching or resuming the children after the bus itself was 3669 * reset, and after restoring bus-unique state of children. 3670 * 3671 * @param dev The bus 3672 * #param flags DEVF_RESET_* 3673 */ 3674 int 3675 bus_helper_reset_post(device_t dev, int flags) 3676 { 3677 device_t child; 3678 int error, error1; 3679 3680 error = 0; 3681 TAILQ_FOREACH(child, &dev->children,link) { 3682 BUS_RESET_POST(dev, child); 3683 error1 = (flags & DEVF_RESET_DETACH) != 0 ? 3684 device_probe_and_attach(child) : 3685 BUS_RESUME_CHILD(dev, child); 3686 if (error == 0 && error1 != 0) 3687 error = error1; 3688 } 3689 return (error); 3690 } 3691 3692 static void 3693 bus_helper_reset_prepare_rollback(device_t dev, device_t child, int flags) 3694 { 3695 child = TAILQ_NEXT(child, link); 3696 if (child == NULL) 3697 return; 3698 TAILQ_FOREACH_FROM(child, &dev->children,link) { 3699 BUS_RESET_POST(dev, child); 3700 if ((flags & DEVF_RESET_DETACH) != 0) 3701 device_probe_and_attach(child); 3702 else 3703 BUS_RESUME_CHILD(dev, child); 3704 } 3705 } 3706 3707 /** 3708 * @brief Helper function for implementing BUS_RESET_PREPARE 3709 * 3710 * Bus can use this function to implement common operations of 3711 * detaching or suspending the children before the bus itself is 3712 * reset, and then save bus-unique state of children that must 3713 * persists around reset. 3714 * 3715 * @param dev The bus 3716 * #param flags DEVF_RESET_* 3717 */ 3718 int 3719 bus_helper_reset_prepare(device_t dev, int flags) 3720 { 3721 device_t child; 3722 int error; 3723 3724 if (dev->state != DS_ATTACHED) 3725 return (EBUSY); 3726 3727 TAILQ_FOREACH_REVERSE(child, &dev->children, device_list, link) { 3728 if ((flags & DEVF_RESET_DETACH) != 0) { 3729 error = device_get_state(child) == DS_ATTACHED ? 3730 device_detach(child) : 0; 3731 } else { 3732 error = BUS_SUSPEND_CHILD(dev, child); 3733 } 3734 if (error == 0) { 3735 error = BUS_RESET_PREPARE(dev, child); 3736 if (error != 0) { 3737 if ((flags & DEVF_RESET_DETACH) != 0) 3738 device_probe_and_attach(child); 3739 else 3740 BUS_RESUME_CHILD(dev, child); 3741 } 3742 } 3743 if (error != 0) { 3744 bus_helper_reset_prepare_rollback(dev, child, flags); 3745 return (error); 3746 } 3747 } 3748 return (0); 3749 } 3750 3751 /** 3752 * @brief Helper function for implementing BUS_PRINT_CHILD(). 3753 * 3754 * This function prints the first part of the ascii representation of 3755 * @p child, including its name, unit and description (if any - see 3756 * device_set_desc()). 3757 * 3758 * @returns the number of characters printed 3759 */ 3760 int 3761 bus_print_child_header(device_t dev, device_t child) 3762 { 3763 int retval = 0; 3764 3765 if (device_get_desc(child)) { 3766 retval += device_printf(child, "<%s>", device_get_desc(child)); 3767 } else { 3768 retval += printf("%s", device_get_nameunit(child)); 3769 } 3770 3771 return (retval); 3772 } 3773 3774 /** 3775 * @brief Helper function for implementing BUS_PRINT_CHILD(). 3776 * 3777 * This function prints the last part of the ascii representation of 3778 * @p child, which consists of the string @c " on " followed by the 3779 * name and unit of the @p dev. 3780 * 3781 * @returns the number of characters printed 3782 */ 3783 int 3784 bus_print_child_footer(device_t dev, device_t child) 3785 { 3786 return (printf(" on %s\n", device_get_nameunit(dev))); 3787 } 3788 3789 /** 3790 * @brief Helper function for implementing BUS_PRINT_CHILD(). 3791 * 3792 * This function prints out the VM domain for the given device. 3793 * 3794 * @returns the number of characters printed 3795 */ 3796 int 3797 bus_print_child_domain(device_t dev, device_t child) 3798 { 3799 int domain; 3800 3801 /* No domain? Don't print anything */ 3802 if (BUS_GET_DOMAIN(dev, child, &domain) != 0) 3803 return (0); 3804 3805 return (printf(" numa-domain %d", domain)); 3806 } 3807 3808 /** 3809 * @brief Helper function for implementing BUS_PRINT_CHILD(). 3810 * 3811 * This function simply calls bus_print_child_header() followed by 3812 * bus_print_child_footer(). 3813 * 3814 * @returns the number of characters printed 3815 */ 3816 int 3817 bus_generic_print_child(device_t dev, device_t child) 3818 { 3819 int retval = 0; 3820 3821 retval += bus_print_child_header(dev, child); 3822 retval += bus_print_child_domain(dev, child); 3823 retval += bus_print_child_footer(dev, child); 3824 3825 return (retval); 3826 } 3827 3828 /** 3829 * @brief Stub function for implementing BUS_READ_IVAR(). 3830 * 3831 * @returns ENOENT 3832 */ 3833 int 3834 bus_generic_read_ivar(device_t dev, device_t child, int index, 3835 uintptr_t * result) 3836 { 3837 return (ENOENT); 3838 } 3839 3840 /** 3841 * @brief Stub function for implementing BUS_WRITE_IVAR(). 3842 * 3843 * @returns ENOENT 3844 */ 3845 int 3846 bus_generic_write_ivar(device_t dev, device_t child, int index, 3847 uintptr_t value) 3848 { 3849 return (ENOENT); 3850 } 3851 3852 /** 3853 * @brief Helper function for implementing BUS_GET_PROPERTY(). 3854 * 3855 * This simply calls the BUS_GET_PROPERTY of the parent of dev, 3856 * until a non-default implementation is found. 3857 */ 3858 ssize_t 3859 bus_generic_get_property(device_t dev, device_t child, const char *propname, 3860 void *propvalue, size_t size, device_property_type_t type) 3861 { 3862 if (device_get_parent(dev) != NULL) 3863 return (BUS_GET_PROPERTY(device_get_parent(dev), child, 3864 propname, propvalue, size, type)); 3865 3866 return (-1); 3867 } 3868 3869 /** 3870 * @brief Stub function for implementing BUS_GET_RESOURCE_LIST(). 3871 * 3872 * @returns NULL 3873 */ 3874 struct resource_list * 3875 bus_generic_get_resource_list(device_t dev, device_t child) 3876 { 3877 return (NULL); 3878 } 3879 3880 /** 3881 * @brief Helper function for implementing BUS_DRIVER_ADDED(). 3882 * 3883 * This implementation of BUS_DRIVER_ADDED() simply calls the driver's 3884 * DEVICE_IDENTIFY() method to allow it to add new children to the bus 3885 * and then calls device_probe_and_attach() for each unattached child. 3886 */ 3887 void 3888 bus_generic_driver_added(device_t dev, driver_t *driver) 3889 { 3890 device_t child; 3891 3892 DEVICE_IDENTIFY(driver, dev); 3893 TAILQ_FOREACH(child, &dev->children, link) { 3894 if (child->state == DS_NOTPRESENT) 3895 device_probe_and_attach(child); 3896 } 3897 } 3898 3899 /** 3900 * @brief Helper function for implementing BUS_NEW_PASS(). 3901 * 3902 * This implementing of BUS_NEW_PASS() first calls the identify 3903 * routines for any drivers that probe at the current pass. Then it 3904 * walks the list of devices for this bus. If a device is already 3905 * attached, then it calls BUS_NEW_PASS() on that device. If the 3906 * device is not already attached, it attempts to attach a driver to 3907 * it. 3908 */ 3909 void 3910 bus_generic_new_pass(device_t dev) 3911 { 3912 driverlink_t dl; 3913 devclass_t dc; 3914 device_t child; 3915 3916 dc = dev->devclass; 3917 TAILQ_FOREACH(dl, &dc->drivers, link) { 3918 if (dl->pass == bus_current_pass) 3919 DEVICE_IDENTIFY(dl->driver, dev); 3920 } 3921 TAILQ_FOREACH(child, &dev->children, link) { 3922 if (child->state >= DS_ATTACHED) 3923 BUS_NEW_PASS(child); 3924 else if (child->state == DS_NOTPRESENT) 3925 device_probe_and_attach(child); 3926 } 3927 } 3928 3929 /** 3930 * @brief Helper function for implementing BUS_SETUP_INTR(). 3931 * 3932 * This simple implementation of BUS_SETUP_INTR() simply calls the 3933 * BUS_SETUP_INTR() method of the parent of @p dev. 3934 */ 3935 int 3936 bus_generic_setup_intr(device_t dev, device_t child, struct resource *irq, 3937 int flags, driver_filter_t *filter, driver_intr_t *intr, void *arg, 3938 void **cookiep) 3939 { 3940 /* Propagate up the bus hierarchy until someone handles it. */ 3941 if (dev->parent) 3942 return (BUS_SETUP_INTR(dev->parent, child, irq, flags, 3943 filter, intr, arg, cookiep)); 3944 return (EINVAL); 3945 } 3946 3947 /** 3948 * @brief Helper function for implementing BUS_TEARDOWN_INTR(). 3949 * 3950 * This simple implementation of BUS_TEARDOWN_INTR() simply calls the 3951 * BUS_TEARDOWN_INTR() method of the parent of @p dev. 3952 */ 3953 int 3954 bus_generic_teardown_intr(device_t dev, device_t child, struct resource *irq, 3955 void *cookie) 3956 { 3957 /* Propagate up the bus hierarchy until someone handles it. */ 3958 if (dev->parent) 3959 return (BUS_TEARDOWN_INTR(dev->parent, child, irq, cookie)); 3960 return (EINVAL); 3961 } 3962 3963 /** 3964 * @brief Helper function for implementing BUS_SUSPEND_INTR(). 3965 * 3966 * This simple implementation of BUS_SUSPEND_INTR() simply calls the 3967 * BUS_SUSPEND_INTR() method of the parent of @p dev. 3968 */ 3969 int 3970 bus_generic_suspend_intr(device_t dev, device_t child, struct resource *irq) 3971 { 3972 /* Propagate up the bus hierarchy until someone handles it. */ 3973 if (dev->parent) 3974 return (BUS_SUSPEND_INTR(dev->parent, child, irq)); 3975 return (EINVAL); 3976 } 3977 3978 /** 3979 * @brief Helper function for implementing BUS_RESUME_INTR(). 3980 * 3981 * This simple implementation of BUS_RESUME_INTR() simply calls the 3982 * BUS_RESUME_INTR() method of the parent of @p dev. 3983 */ 3984 int 3985 bus_generic_resume_intr(device_t dev, device_t child, struct resource *irq) 3986 { 3987 /* Propagate up the bus hierarchy until someone handles it. */ 3988 if (dev->parent) 3989 return (BUS_RESUME_INTR(dev->parent, child, irq)); 3990 return (EINVAL); 3991 } 3992 3993 /** 3994 * @brief Helper function for implementing BUS_ADJUST_RESOURCE(). 3995 * 3996 * This simple implementation of BUS_ADJUST_RESOURCE() simply calls the 3997 * BUS_ADJUST_RESOURCE() method of the parent of @p dev. 3998 */ 3999 int 4000 bus_generic_adjust_resource(device_t dev, device_t child, struct resource *r, 4001 rman_res_t start, rman_res_t end) 4002 { 4003 /* Propagate up the bus hierarchy until someone handles it. */ 4004 if (dev->parent) 4005 return (BUS_ADJUST_RESOURCE(dev->parent, child, r, start, end)); 4006 return (EINVAL); 4007 } 4008 4009 /* 4010 * @brief Helper function for implementing BUS_TRANSLATE_RESOURCE(). 4011 * 4012 * This simple implementation of BUS_TRANSLATE_RESOURCE() simply calls the 4013 * BUS_TRANSLATE_RESOURCE() method of the parent of @p dev. If there is no 4014 * parent, no translation happens. 4015 */ 4016 int 4017 bus_generic_translate_resource(device_t dev, int type, rman_res_t start, 4018 rman_res_t *newstart) 4019 { 4020 if (dev->parent) 4021 return (BUS_TRANSLATE_RESOURCE(dev->parent, type, start, 4022 newstart)); 4023 *newstart = start; 4024 return (0); 4025 } 4026 4027 /** 4028 * @brief Helper function for implementing BUS_ALLOC_RESOURCE(). 4029 * 4030 * This simple implementation of BUS_ALLOC_RESOURCE() simply calls the 4031 * BUS_ALLOC_RESOURCE() method of the parent of @p dev. 4032 */ 4033 struct resource * 4034 bus_generic_alloc_resource(device_t dev, device_t child, int type, int *rid, 4035 rman_res_t start, rman_res_t end, rman_res_t count, u_int flags) 4036 { 4037 /* Propagate up the bus hierarchy until someone handles it. */ 4038 if (dev->parent) 4039 return (BUS_ALLOC_RESOURCE(dev->parent, child, type, rid, 4040 start, end, count, flags)); 4041 return (NULL); 4042 } 4043 4044 /** 4045 * @brief Helper function for implementing BUS_RELEASE_RESOURCE(). 4046 * 4047 * This simple implementation of BUS_RELEASE_RESOURCE() simply calls the 4048 * BUS_RELEASE_RESOURCE() method of the parent of @p dev. 4049 */ 4050 int 4051 bus_generic_release_resource(device_t dev, device_t child, struct resource *r) 4052 { 4053 /* Propagate up the bus hierarchy until someone handles it. */ 4054 if (dev->parent) 4055 return (BUS_RELEASE_RESOURCE(dev->parent, child, r)); 4056 return (EINVAL); 4057 } 4058 4059 /** 4060 * @brief Helper function for implementing BUS_ACTIVATE_RESOURCE(). 4061 * 4062 * This simple implementation of BUS_ACTIVATE_RESOURCE() simply calls the 4063 * BUS_ACTIVATE_RESOURCE() method of the parent of @p dev. 4064 */ 4065 int 4066 bus_generic_activate_resource(device_t dev, device_t child, struct resource *r) 4067 { 4068 /* Propagate up the bus hierarchy until someone handles it. */ 4069 if (dev->parent) 4070 return (BUS_ACTIVATE_RESOURCE(dev->parent, child, r)); 4071 return (EINVAL); 4072 } 4073 4074 /** 4075 * @brief Helper function for implementing BUS_DEACTIVATE_RESOURCE(). 4076 * 4077 * This simple implementation of BUS_DEACTIVATE_RESOURCE() simply calls the 4078 * BUS_DEACTIVATE_RESOURCE() method of the parent of @p dev. 4079 */ 4080 int 4081 bus_generic_deactivate_resource(device_t dev, device_t child, 4082 struct resource *r) 4083 { 4084 /* Propagate up the bus hierarchy until someone handles it. */ 4085 if (dev->parent) 4086 return (BUS_DEACTIVATE_RESOURCE(dev->parent, child, r)); 4087 return (EINVAL); 4088 } 4089 4090 /** 4091 * @brief Helper function for implementing BUS_MAP_RESOURCE(). 4092 * 4093 * This simple implementation of BUS_MAP_RESOURCE() simply calls the 4094 * BUS_MAP_RESOURCE() method of the parent of @p dev. 4095 */ 4096 int 4097 bus_generic_map_resource(device_t dev, device_t child, struct resource *r, 4098 struct resource_map_request *args, struct resource_map *map) 4099 { 4100 /* Propagate up the bus hierarchy until someone handles it. */ 4101 if (dev->parent) 4102 return (BUS_MAP_RESOURCE(dev->parent, child, r, args, map)); 4103 return (EINVAL); 4104 } 4105 4106 /** 4107 * @brief Helper function for implementing BUS_UNMAP_RESOURCE(). 4108 * 4109 * This simple implementation of BUS_UNMAP_RESOURCE() simply calls the 4110 * BUS_UNMAP_RESOURCE() method of the parent of @p dev. 4111 */ 4112 int 4113 bus_generic_unmap_resource(device_t dev, device_t child, struct resource *r, 4114 struct resource_map *map) 4115 { 4116 /* Propagate up the bus hierarchy until someone handles it. */ 4117 if (dev->parent) 4118 return (BUS_UNMAP_RESOURCE(dev->parent, child, r, map)); 4119 return (EINVAL); 4120 } 4121 4122 /** 4123 * @brief Helper function for implementing BUS_BIND_INTR(). 4124 * 4125 * This simple implementation of BUS_BIND_INTR() simply calls the 4126 * BUS_BIND_INTR() method of the parent of @p dev. 4127 */ 4128 int 4129 bus_generic_bind_intr(device_t dev, device_t child, struct resource *irq, 4130 int cpu) 4131 { 4132 /* Propagate up the bus hierarchy until someone handles it. */ 4133 if (dev->parent) 4134 return (BUS_BIND_INTR(dev->parent, child, irq, cpu)); 4135 return (EINVAL); 4136 } 4137 4138 /** 4139 * @brief Helper function for implementing BUS_CONFIG_INTR(). 4140 * 4141 * This simple implementation of BUS_CONFIG_INTR() simply calls the 4142 * BUS_CONFIG_INTR() method of the parent of @p dev. 4143 */ 4144 int 4145 bus_generic_config_intr(device_t dev, int irq, enum intr_trigger trig, 4146 enum intr_polarity pol) 4147 { 4148 /* Propagate up the bus hierarchy until someone handles it. */ 4149 if (dev->parent) 4150 return (BUS_CONFIG_INTR(dev->parent, irq, trig, pol)); 4151 return (EINVAL); 4152 } 4153 4154 /** 4155 * @brief Helper function for implementing BUS_DESCRIBE_INTR(). 4156 * 4157 * This simple implementation of BUS_DESCRIBE_INTR() simply calls the 4158 * BUS_DESCRIBE_INTR() method of the parent of @p dev. 4159 */ 4160 int 4161 bus_generic_describe_intr(device_t dev, device_t child, struct resource *irq, 4162 void *cookie, const char *descr) 4163 { 4164 /* Propagate up the bus hierarchy until someone handles it. */ 4165 if (dev->parent) 4166 return (BUS_DESCRIBE_INTR(dev->parent, child, irq, cookie, 4167 descr)); 4168 return (EINVAL); 4169 } 4170 4171 /** 4172 * @brief Helper function for implementing BUS_GET_CPUS(). 4173 * 4174 * This simple implementation of BUS_GET_CPUS() simply calls the 4175 * BUS_GET_CPUS() method of the parent of @p dev. 4176 */ 4177 int 4178 bus_generic_get_cpus(device_t dev, device_t child, enum cpu_sets op, 4179 size_t setsize, cpuset_t *cpuset) 4180 { 4181 /* Propagate up the bus hierarchy until someone handles it. */ 4182 if (dev->parent != NULL) 4183 return (BUS_GET_CPUS(dev->parent, child, op, setsize, cpuset)); 4184 return (EINVAL); 4185 } 4186 4187 /** 4188 * @brief Helper function for implementing BUS_GET_DMA_TAG(). 4189 * 4190 * This simple implementation of BUS_GET_DMA_TAG() simply calls the 4191 * BUS_GET_DMA_TAG() method of the parent of @p dev. 4192 */ 4193 bus_dma_tag_t 4194 bus_generic_get_dma_tag(device_t dev, device_t child) 4195 { 4196 /* Propagate up the bus hierarchy until someone handles it. */ 4197 if (dev->parent != NULL) 4198 return (BUS_GET_DMA_TAG(dev->parent, child)); 4199 return (NULL); 4200 } 4201 4202 /** 4203 * @brief Helper function for implementing BUS_GET_BUS_TAG(). 4204 * 4205 * This simple implementation of BUS_GET_BUS_TAG() simply calls the 4206 * BUS_GET_BUS_TAG() method of the parent of @p dev. 4207 */ 4208 bus_space_tag_t 4209 bus_generic_get_bus_tag(device_t dev, device_t child) 4210 { 4211 /* Propagate up the bus hierarchy until someone handles it. */ 4212 if (dev->parent != NULL) 4213 return (BUS_GET_BUS_TAG(dev->parent, child)); 4214 return ((bus_space_tag_t)0); 4215 } 4216 4217 /** 4218 * @brief Helper function for implementing BUS_GET_RESOURCE(). 4219 * 4220 * This implementation of BUS_GET_RESOURCE() uses the 4221 * resource_list_find() function to do most of the work. It calls 4222 * BUS_GET_RESOURCE_LIST() to find a suitable resource list to 4223 * search. 4224 */ 4225 int 4226 bus_generic_rl_get_resource(device_t dev, device_t child, int type, int rid, 4227 rman_res_t *startp, rman_res_t *countp) 4228 { 4229 struct resource_list * rl = NULL; 4230 struct resource_list_entry * rle = NULL; 4231 4232 rl = BUS_GET_RESOURCE_LIST(dev, child); 4233 if (!rl) 4234 return (EINVAL); 4235 4236 rle = resource_list_find(rl, type, rid); 4237 if (!rle) 4238 return (ENOENT); 4239 4240 if (startp) 4241 *startp = rle->start; 4242 if (countp) 4243 *countp = rle->count; 4244 4245 return (0); 4246 } 4247 4248 /** 4249 * @brief Helper function for implementing BUS_SET_RESOURCE(). 4250 * 4251 * This implementation of BUS_SET_RESOURCE() uses the 4252 * resource_list_add() function to do most of the work. It calls 4253 * BUS_GET_RESOURCE_LIST() to find a suitable resource list to 4254 * edit. 4255 */ 4256 int 4257 bus_generic_rl_set_resource(device_t dev, device_t child, int type, int rid, 4258 rman_res_t start, rman_res_t count) 4259 { 4260 struct resource_list * rl = NULL; 4261 4262 rl = BUS_GET_RESOURCE_LIST(dev, child); 4263 if (!rl) 4264 return (EINVAL); 4265 4266 resource_list_add(rl, type, rid, start, (start + count - 1), count); 4267 4268 return (0); 4269 } 4270 4271 /** 4272 * @brief Helper function for implementing BUS_DELETE_RESOURCE(). 4273 * 4274 * This implementation of BUS_DELETE_RESOURCE() uses the 4275 * resource_list_delete() function to do most of the work. It calls 4276 * BUS_GET_RESOURCE_LIST() to find a suitable resource list to 4277 * edit. 4278 */ 4279 void 4280 bus_generic_rl_delete_resource(device_t dev, device_t child, int type, int rid) 4281 { 4282 struct resource_list * rl = NULL; 4283 4284 rl = BUS_GET_RESOURCE_LIST(dev, child); 4285 if (!rl) 4286 return; 4287 4288 resource_list_delete(rl, type, rid); 4289 4290 return; 4291 } 4292 4293 /** 4294 * @brief Helper function for implementing BUS_RELEASE_RESOURCE(). 4295 * 4296 * This implementation of BUS_RELEASE_RESOURCE() uses the 4297 * resource_list_release() function to do most of the work. It calls 4298 * BUS_GET_RESOURCE_LIST() to find a suitable resource list. 4299 */ 4300 int 4301 bus_generic_rl_release_resource(device_t dev, device_t child, 4302 struct resource *r) 4303 { 4304 struct resource_list * rl = NULL; 4305 4306 if (device_get_parent(child) != dev) 4307 return (BUS_RELEASE_RESOURCE(device_get_parent(dev), child, r)); 4308 4309 rl = BUS_GET_RESOURCE_LIST(dev, child); 4310 if (!rl) 4311 return (EINVAL); 4312 4313 return (resource_list_release(rl, dev, child, r)); 4314 } 4315 4316 /** 4317 * @brief Helper function for implementing BUS_ALLOC_RESOURCE(). 4318 * 4319 * This implementation of BUS_ALLOC_RESOURCE() uses the 4320 * resource_list_alloc() function to do most of the work. It calls 4321 * BUS_GET_RESOURCE_LIST() to find a suitable resource list. 4322 */ 4323 struct resource * 4324 bus_generic_rl_alloc_resource(device_t dev, device_t child, int type, 4325 int *rid, rman_res_t start, rman_res_t end, rman_res_t count, u_int flags) 4326 { 4327 struct resource_list * rl = NULL; 4328 4329 if (device_get_parent(child) != dev) 4330 return (BUS_ALLOC_RESOURCE(device_get_parent(dev), child, 4331 type, rid, start, end, count, flags)); 4332 4333 rl = BUS_GET_RESOURCE_LIST(dev, child); 4334 if (!rl) 4335 return (NULL); 4336 4337 return (resource_list_alloc(rl, dev, child, type, rid, 4338 start, end, count, flags)); 4339 } 4340 4341 /** 4342 * @brief Helper function for implementing BUS_ALLOC_RESOURCE(). 4343 * 4344 * This implementation of BUS_ALLOC_RESOURCE() allocates a 4345 * resource from a resource manager. It uses BUS_GET_RMAN() 4346 * to obtain the resource manager. 4347 */ 4348 struct resource * 4349 bus_generic_rman_alloc_resource(device_t dev, device_t child, int type, 4350 int *rid, rman_res_t start, rman_res_t end, rman_res_t count, u_int flags) 4351 { 4352 struct resource *r; 4353 struct rman *rm; 4354 4355 rm = BUS_GET_RMAN(dev, type, flags); 4356 if (rm == NULL) 4357 return (NULL); 4358 4359 r = rman_reserve_resource(rm, start, end, count, flags & ~RF_ACTIVE, 4360 child); 4361 if (r == NULL) 4362 return (NULL); 4363 rman_set_rid(r, *rid); 4364 rman_set_type(r, type); 4365 4366 if (flags & RF_ACTIVE) { 4367 if (bus_activate_resource(child, type, *rid, r) != 0) { 4368 rman_release_resource(r); 4369 return (NULL); 4370 } 4371 } 4372 4373 return (r); 4374 } 4375 4376 /** 4377 * @brief Helper function for implementing BUS_ADJUST_RESOURCE(). 4378 * 4379 * This implementation of BUS_ADJUST_RESOURCE() adjusts resources only 4380 * if they were allocated from the resource manager returned by 4381 * BUS_GET_RMAN(). 4382 */ 4383 int 4384 bus_generic_rman_adjust_resource(device_t dev, device_t child, 4385 struct resource *r, rman_res_t start, rman_res_t end) 4386 { 4387 struct rman *rm; 4388 4389 rm = BUS_GET_RMAN(dev, rman_get_type(r), rman_get_flags(r)); 4390 if (rm == NULL) 4391 return (ENXIO); 4392 if (!rman_is_region_manager(r, rm)) 4393 return (EINVAL); 4394 return (rman_adjust_resource(r, start, end)); 4395 } 4396 4397 /** 4398 * @brief Helper function for implementing BUS_RELEASE_RESOURCE(). 4399 * 4400 * This implementation of BUS_RELEASE_RESOURCE() releases resources 4401 * allocated by bus_generic_rman_alloc_resource. 4402 */ 4403 int 4404 bus_generic_rman_release_resource(device_t dev, device_t child, 4405 struct resource *r) 4406 { 4407 #ifdef INVARIANTS 4408 struct rman *rm; 4409 #endif 4410 int error; 4411 4412 #ifdef INVARIANTS 4413 rm = BUS_GET_RMAN(dev, rman_get_type(r), rman_get_flags(r)); 4414 KASSERT(rman_is_region_manager(r, rm), 4415 ("%s: rman %p doesn't match for resource %p", __func__, rm, r)); 4416 #endif 4417 4418 if (rman_get_flags(r) & RF_ACTIVE) { 4419 error = bus_deactivate_resource(child, r); 4420 if (error != 0) 4421 return (error); 4422 } 4423 return (rman_release_resource(r)); 4424 } 4425 4426 /** 4427 * @brief Helper function for implementing BUS_ACTIVATE_RESOURCE(). 4428 * 4429 * This implementation of BUS_ACTIVATE_RESOURCE() activates resources 4430 * allocated by bus_generic_rman_alloc_resource. 4431 */ 4432 int 4433 bus_generic_rman_activate_resource(device_t dev, device_t child, 4434 struct resource *r) 4435 { 4436 struct resource_map map; 4437 #ifdef INVARIANTS 4438 struct rman *rm; 4439 #endif 4440 int error, type; 4441 4442 type = rman_get_type(r); 4443 #ifdef INVARIANTS 4444 rm = BUS_GET_RMAN(dev, type, rman_get_flags(r)); 4445 KASSERT(rman_is_region_manager(r, rm), 4446 ("%s: rman %p doesn't match for resource %p", __func__, rm, r)); 4447 #endif 4448 4449 error = rman_activate_resource(r); 4450 if (error != 0) 4451 return (error); 4452 4453 switch (type) { 4454 case SYS_RES_IOPORT: 4455 case SYS_RES_MEMORY: 4456 if ((rman_get_flags(r) & RF_UNMAPPED) == 0) { 4457 error = BUS_MAP_RESOURCE(dev, child, r, NULL, &map); 4458 if (error != 0) 4459 break; 4460 4461 rman_set_mapping(r, &map); 4462 } 4463 break; 4464 #ifdef INTRNG 4465 case SYS_RES_IRQ: 4466 error = intr_activate_irq(child, r); 4467 break; 4468 #endif 4469 } 4470 if (error != 0) 4471 rman_deactivate_resource(r); 4472 return (error); 4473 } 4474 4475 /** 4476 * @brief Helper function for implementing BUS_DEACTIVATE_RESOURCE(). 4477 * 4478 * This implementation of BUS_DEACTIVATE_RESOURCE() deactivates 4479 * resources allocated by bus_generic_rman_alloc_resource. 4480 */ 4481 int 4482 bus_generic_rman_deactivate_resource(device_t dev, device_t child, 4483 struct resource *r) 4484 { 4485 struct resource_map map; 4486 #ifdef INVARIANTS 4487 struct rman *rm; 4488 #endif 4489 int error, type; 4490 4491 type = rman_get_type(r); 4492 #ifdef INVARIANTS 4493 rm = BUS_GET_RMAN(dev, type, rman_get_flags(r)); 4494 KASSERT(rman_is_region_manager(r, rm), 4495 ("%s: rman %p doesn't match for resource %p", __func__, rm, r)); 4496 #endif 4497 4498 error = rman_deactivate_resource(r); 4499 if (error != 0) 4500 return (error); 4501 4502 switch (type) { 4503 case SYS_RES_IOPORT: 4504 case SYS_RES_MEMORY: 4505 if ((rman_get_flags(r) & RF_UNMAPPED) == 0) { 4506 rman_get_mapping(r, &map); 4507 BUS_UNMAP_RESOURCE(dev, child, r, &map); 4508 } 4509 break; 4510 #ifdef INTRNG 4511 case SYS_RES_IRQ: 4512 intr_deactivate_irq(child, r); 4513 break; 4514 #endif 4515 } 4516 return (0); 4517 } 4518 4519 /** 4520 * @brief Helper function for implementing BUS_CHILD_PRESENT(). 4521 * 4522 * This simple implementation of BUS_CHILD_PRESENT() simply calls the 4523 * BUS_CHILD_PRESENT() method of the parent of @p dev. 4524 */ 4525 int 4526 bus_generic_child_present(device_t dev, device_t child) 4527 { 4528 return (BUS_CHILD_PRESENT(device_get_parent(dev), dev)); 4529 } 4530 4531 /** 4532 * @brief Helper function for implementing BUS_GET_DOMAIN(). 4533 * 4534 * This simple implementation of BUS_GET_DOMAIN() calls the 4535 * BUS_GET_DOMAIN() method of the parent of @p dev. If @p dev 4536 * does not have a parent, the function fails with ENOENT. 4537 */ 4538 int 4539 bus_generic_get_domain(device_t dev, device_t child, int *domain) 4540 { 4541 if (dev->parent) 4542 return (BUS_GET_DOMAIN(dev->parent, dev, domain)); 4543 4544 return (ENOENT); 4545 } 4546 4547 /** 4548 * @brief Helper function to implement normal BUS_GET_DEVICE_PATH() 4549 * 4550 * This function knows how to (a) pass the request up the tree if there's 4551 * a parent and (b) Knows how to supply a FreeBSD locator. 4552 * 4553 * @param bus bus in the walk up the tree 4554 * @param child leaf node to print information about 4555 * @param locator BUS_LOCATOR_xxx string for locator 4556 * @param sb Buffer to print information into 4557 */ 4558 int 4559 bus_generic_get_device_path(device_t bus, device_t child, const char *locator, 4560 struct sbuf *sb) 4561 { 4562 int rv = 0; 4563 device_t parent; 4564 4565 /* 4566 * We don't recurse on ACPI since either we know the handle for the 4567 * device or we don't. And if we're in the generic routine, we don't 4568 * have a ACPI override. All other locators build up a path by having 4569 * their parents create a path and then adding the path element for this 4570 * node. That's why we recurse with parent, bus rather than the typical 4571 * parent, child: each spot in the tree is independent of what our child 4572 * will do with this path. 4573 */ 4574 parent = device_get_parent(bus); 4575 if (parent != NULL && strcmp(locator, BUS_LOCATOR_ACPI) != 0) { 4576 rv = BUS_GET_DEVICE_PATH(parent, bus, locator, sb); 4577 } 4578 if (strcmp(locator, BUS_LOCATOR_FREEBSD) == 0) { 4579 if (rv == 0) { 4580 sbuf_printf(sb, "/%s", device_get_nameunit(child)); 4581 } 4582 return (rv); 4583 } 4584 /* 4585 * Don't know what to do. So assume we do nothing. Not sure that's 4586 * the right thing, but keeps us from having a big list here. 4587 */ 4588 return (0); 4589 } 4590 4591 4592 /** 4593 * @brief Helper function for implementing BUS_RESCAN(). 4594 * 4595 * This null implementation of BUS_RESCAN() always fails to indicate 4596 * the bus does not support rescanning. 4597 */ 4598 int 4599 bus_null_rescan(device_t dev) 4600 { 4601 return (ENODEV); 4602 } 4603 4604 /* 4605 * Some convenience functions to make it easier for drivers to use the 4606 * resource-management functions. All these really do is hide the 4607 * indirection through the parent's method table, making for slightly 4608 * less-wordy code. In the future, it might make sense for this code 4609 * to maintain some sort of a list of resources allocated by each device. 4610 */ 4611 4612 int 4613 bus_alloc_resources(device_t dev, struct resource_spec *rs, 4614 struct resource **res) 4615 { 4616 int i; 4617 4618 for (i = 0; rs[i].type != -1; i++) 4619 res[i] = NULL; 4620 for (i = 0; rs[i].type != -1; i++) { 4621 res[i] = bus_alloc_resource_any(dev, 4622 rs[i].type, &rs[i].rid, rs[i].flags); 4623 if (res[i] == NULL && !(rs[i].flags & RF_OPTIONAL)) { 4624 bus_release_resources(dev, rs, res); 4625 return (ENXIO); 4626 } 4627 } 4628 return (0); 4629 } 4630 4631 void 4632 bus_release_resources(device_t dev, const struct resource_spec *rs, 4633 struct resource **res) 4634 { 4635 int i; 4636 4637 for (i = 0; rs[i].type != -1; i++) 4638 if (res[i] != NULL) { 4639 bus_release_resource( 4640 dev, rs[i].type, rs[i].rid, res[i]); 4641 res[i] = NULL; 4642 } 4643 } 4644 4645 /** 4646 * @brief Wrapper function for BUS_ALLOC_RESOURCE(). 4647 * 4648 * This function simply calls the BUS_ALLOC_RESOURCE() method of the 4649 * parent of @p dev. 4650 */ 4651 struct resource * 4652 bus_alloc_resource(device_t dev, int type, int *rid, rman_res_t start, 4653 rman_res_t end, rman_res_t count, u_int flags) 4654 { 4655 struct resource *res; 4656 4657 if (dev->parent == NULL) 4658 return (NULL); 4659 res = BUS_ALLOC_RESOURCE(dev->parent, dev, type, rid, start, end, 4660 count, flags); 4661 return (res); 4662 } 4663 4664 /** 4665 * @brief Wrapper function for BUS_ADJUST_RESOURCE(). 4666 * 4667 * This function simply calls the BUS_ADJUST_RESOURCE() method of the 4668 * parent of @p dev. 4669 */ 4670 int 4671 bus_adjust_resource(device_t dev, struct resource *r, rman_res_t start, 4672 rman_res_t end) 4673 { 4674 if (dev->parent == NULL) 4675 return (EINVAL); 4676 return (BUS_ADJUST_RESOURCE(dev->parent, dev, r, start, end)); 4677 } 4678 4679 int 4680 bus_adjust_resource_old(device_t dev, int type __unused, struct resource *r, 4681 rman_res_t start, rman_res_t end) 4682 { 4683 return (bus_adjust_resource(dev, r, start, end)); 4684 } 4685 4686 /** 4687 * @brief Wrapper function for BUS_TRANSLATE_RESOURCE(). 4688 * 4689 * This function simply calls the BUS_TRANSLATE_RESOURCE() method of the 4690 * parent of @p dev. 4691 */ 4692 int 4693 bus_translate_resource(device_t dev, int type, rman_res_t start, 4694 rman_res_t *newstart) 4695 { 4696 if (dev->parent == NULL) 4697 return (EINVAL); 4698 return (BUS_TRANSLATE_RESOURCE(dev->parent, type, start, newstart)); 4699 } 4700 4701 /** 4702 * @brief Wrapper function for BUS_ACTIVATE_RESOURCE(). 4703 * 4704 * This function simply calls the BUS_ACTIVATE_RESOURCE() method of the 4705 * parent of @p dev. 4706 */ 4707 int 4708 bus_activate_resource(device_t dev, struct resource *r) 4709 { 4710 if (dev->parent == NULL) 4711 return (EINVAL); 4712 return (BUS_ACTIVATE_RESOURCE(dev->parent, dev, r)); 4713 } 4714 4715 int 4716 bus_activate_resource_old(device_t dev, int type, int rid, struct resource *r) 4717 { 4718 return (bus_activate_resource(dev, r)); 4719 } 4720 4721 /** 4722 * @brief Wrapper function for BUS_DEACTIVATE_RESOURCE(). 4723 * 4724 * This function simply calls the BUS_DEACTIVATE_RESOURCE() method of the 4725 * parent of @p dev. 4726 */ 4727 int 4728 bus_deactivate_resource(device_t dev, struct resource *r) 4729 { 4730 if (dev->parent == NULL) 4731 return (EINVAL); 4732 return (BUS_DEACTIVATE_RESOURCE(dev->parent, dev, r)); 4733 } 4734 4735 int 4736 bus_deactivate_resource_old(device_t dev, int type, int rid, struct resource *r) 4737 { 4738 return (bus_deactivate_resource(dev, r)); 4739 } 4740 4741 /** 4742 * @brief Wrapper function for BUS_MAP_RESOURCE(). 4743 * 4744 * This function simply calls the BUS_MAP_RESOURCE() method of the 4745 * parent of @p dev. 4746 */ 4747 int 4748 bus_map_resource(device_t dev, struct resource *r, 4749 struct resource_map_request *args, struct resource_map *map) 4750 { 4751 if (dev->parent == NULL) 4752 return (EINVAL); 4753 return (BUS_MAP_RESOURCE(dev->parent, dev, r, args, map)); 4754 } 4755 4756 int 4757 bus_map_resource_old(device_t dev, int type, struct resource *r, 4758 struct resource_map_request *args, struct resource_map *map) 4759 { 4760 return (bus_map_resource(dev, r, args, map)); 4761 } 4762 4763 /** 4764 * @brief Wrapper function for BUS_UNMAP_RESOURCE(). 4765 * 4766 * This function simply calls the BUS_UNMAP_RESOURCE() method of the 4767 * parent of @p dev. 4768 */ 4769 int 4770 bus_unmap_resource(device_t dev, struct resource *r, struct resource_map *map) 4771 { 4772 if (dev->parent == NULL) 4773 return (EINVAL); 4774 return (BUS_UNMAP_RESOURCE(dev->parent, dev, r, map)); 4775 } 4776 4777 int 4778 bus_unmap_resource_old(device_t dev, int type, struct resource *r, 4779 struct resource_map *map) 4780 { 4781 return (bus_unmap_resource(dev, r, map)); 4782 } 4783 4784 /** 4785 * @brief Wrapper function for BUS_RELEASE_RESOURCE(). 4786 * 4787 * This function simply calls the BUS_RELEASE_RESOURCE() method of the 4788 * parent of @p dev. 4789 */ 4790 int 4791 bus_release_resource(device_t dev, struct resource *r) 4792 { 4793 int rv; 4794 4795 if (dev->parent == NULL) 4796 return (EINVAL); 4797 rv = BUS_RELEASE_RESOURCE(dev->parent, dev, r); 4798 return (rv); 4799 } 4800 4801 int 4802 bus_release_resource_old(device_t dev, int type, int rid, struct resource *r) 4803 { 4804 return (bus_release_resource(dev, r)); 4805 } 4806 4807 /** 4808 * @brief Wrapper function for BUS_SETUP_INTR(). 4809 * 4810 * This function simply calls the BUS_SETUP_INTR() method of the 4811 * parent of @p dev. 4812 */ 4813 int 4814 bus_setup_intr(device_t dev, struct resource *r, int flags, 4815 driver_filter_t filter, driver_intr_t handler, void *arg, void **cookiep) 4816 { 4817 int error; 4818 4819 if (dev->parent == NULL) 4820 return (EINVAL); 4821 error = BUS_SETUP_INTR(dev->parent, dev, r, flags, filter, handler, 4822 arg, cookiep); 4823 if (error != 0) 4824 return (error); 4825 if (handler != NULL && !(flags & INTR_MPSAFE)) 4826 device_printf(dev, "[GIANT-LOCKED]\n"); 4827 return (0); 4828 } 4829 4830 /** 4831 * @brief Wrapper function for BUS_TEARDOWN_INTR(). 4832 * 4833 * This function simply calls the BUS_TEARDOWN_INTR() method of the 4834 * parent of @p dev. 4835 */ 4836 int 4837 bus_teardown_intr(device_t dev, struct resource *r, void *cookie) 4838 { 4839 if (dev->parent == NULL) 4840 return (EINVAL); 4841 return (BUS_TEARDOWN_INTR(dev->parent, dev, r, cookie)); 4842 } 4843 4844 /** 4845 * @brief Wrapper function for BUS_SUSPEND_INTR(). 4846 * 4847 * This function simply calls the BUS_SUSPEND_INTR() method of the 4848 * parent of @p dev. 4849 */ 4850 int 4851 bus_suspend_intr(device_t dev, struct resource *r) 4852 { 4853 if (dev->parent == NULL) 4854 return (EINVAL); 4855 return (BUS_SUSPEND_INTR(dev->parent, dev, r)); 4856 } 4857 4858 /** 4859 * @brief Wrapper function for BUS_RESUME_INTR(). 4860 * 4861 * This function simply calls the BUS_RESUME_INTR() method of the 4862 * parent of @p dev. 4863 */ 4864 int 4865 bus_resume_intr(device_t dev, struct resource *r) 4866 { 4867 if (dev->parent == NULL) 4868 return (EINVAL); 4869 return (BUS_RESUME_INTR(dev->parent, dev, r)); 4870 } 4871 4872 /** 4873 * @brief Wrapper function for BUS_BIND_INTR(). 4874 * 4875 * This function simply calls the BUS_BIND_INTR() method of the 4876 * parent of @p dev. 4877 */ 4878 int 4879 bus_bind_intr(device_t dev, struct resource *r, int cpu) 4880 { 4881 if (dev->parent == NULL) 4882 return (EINVAL); 4883 return (BUS_BIND_INTR(dev->parent, dev, r, cpu)); 4884 } 4885 4886 /** 4887 * @brief Wrapper function for BUS_DESCRIBE_INTR(). 4888 * 4889 * This function first formats the requested description into a 4890 * temporary buffer and then calls the BUS_DESCRIBE_INTR() method of 4891 * the parent of @p dev. 4892 */ 4893 int 4894 bus_describe_intr(device_t dev, struct resource *irq, void *cookie, 4895 const char *fmt, ...) 4896 { 4897 va_list ap; 4898 char descr[MAXCOMLEN + 1]; 4899 4900 if (dev->parent == NULL) 4901 return (EINVAL); 4902 va_start(ap, fmt); 4903 vsnprintf(descr, sizeof(descr), fmt, ap); 4904 va_end(ap); 4905 return (BUS_DESCRIBE_INTR(dev->parent, dev, irq, cookie, descr)); 4906 } 4907 4908 /** 4909 * @brief Wrapper function for BUS_SET_RESOURCE(). 4910 * 4911 * This function simply calls the BUS_SET_RESOURCE() method of the 4912 * parent of @p dev. 4913 */ 4914 int 4915 bus_set_resource(device_t dev, int type, int rid, 4916 rman_res_t start, rman_res_t count) 4917 { 4918 return (BUS_SET_RESOURCE(device_get_parent(dev), dev, type, rid, 4919 start, count)); 4920 } 4921 4922 /** 4923 * @brief Wrapper function for BUS_GET_RESOURCE(). 4924 * 4925 * This function simply calls the BUS_GET_RESOURCE() method of the 4926 * parent of @p dev. 4927 */ 4928 int 4929 bus_get_resource(device_t dev, int type, int rid, 4930 rman_res_t *startp, rman_res_t *countp) 4931 { 4932 return (BUS_GET_RESOURCE(device_get_parent(dev), dev, type, rid, 4933 startp, countp)); 4934 } 4935 4936 /** 4937 * @brief Wrapper function for BUS_GET_RESOURCE(). 4938 * 4939 * This function simply calls the BUS_GET_RESOURCE() method of the 4940 * parent of @p dev and returns the start value. 4941 */ 4942 rman_res_t 4943 bus_get_resource_start(device_t dev, int type, int rid) 4944 { 4945 rman_res_t start; 4946 rman_res_t count; 4947 int error; 4948 4949 error = BUS_GET_RESOURCE(device_get_parent(dev), dev, type, rid, 4950 &start, &count); 4951 if (error) 4952 return (0); 4953 return (start); 4954 } 4955 4956 /** 4957 * @brief Wrapper function for BUS_GET_RESOURCE(). 4958 * 4959 * This function simply calls the BUS_GET_RESOURCE() method of the 4960 * parent of @p dev and returns the count value. 4961 */ 4962 rman_res_t 4963 bus_get_resource_count(device_t dev, int type, int rid) 4964 { 4965 rman_res_t start; 4966 rman_res_t count; 4967 int error; 4968 4969 error = BUS_GET_RESOURCE(device_get_parent(dev), dev, type, rid, 4970 &start, &count); 4971 if (error) 4972 return (0); 4973 return (count); 4974 } 4975 4976 /** 4977 * @brief Wrapper function for BUS_DELETE_RESOURCE(). 4978 * 4979 * This function simply calls the BUS_DELETE_RESOURCE() method of the 4980 * parent of @p dev. 4981 */ 4982 void 4983 bus_delete_resource(device_t dev, int type, int rid) 4984 { 4985 BUS_DELETE_RESOURCE(device_get_parent(dev), dev, type, rid); 4986 } 4987 4988 /** 4989 * @brief Wrapper function for BUS_CHILD_PRESENT(). 4990 * 4991 * This function simply calls the BUS_CHILD_PRESENT() method of the 4992 * parent of @p dev. 4993 */ 4994 int 4995 bus_child_present(device_t child) 4996 { 4997 return (BUS_CHILD_PRESENT(device_get_parent(child), child)); 4998 } 4999 5000 /** 5001 * @brief Wrapper function for BUS_CHILD_PNPINFO(). 5002 * 5003 * This function simply calls the BUS_CHILD_PNPINFO() method of the parent of @p 5004 * dev. 5005 */ 5006 int 5007 bus_child_pnpinfo(device_t child, struct sbuf *sb) 5008 { 5009 device_t parent; 5010 5011 parent = device_get_parent(child); 5012 if (parent == NULL) 5013 return (0); 5014 return (BUS_CHILD_PNPINFO(parent, child, sb)); 5015 } 5016 5017 /** 5018 * @brief Generic implementation that does nothing for bus_child_pnpinfo 5019 * 5020 * This function has the right signature and returns 0 since the sbuf is passed 5021 * to us to append to. 5022 */ 5023 int 5024 bus_generic_child_pnpinfo(device_t dev, device_t child, struct sbuf *sb) 5025 { 5026 return (0); 5027 } 5028 5029 /** 5030 * @brief Wrapper function for BUS_CHILD_LOCATION(). 5031 * 5032 * This function simply calls the BUS_CHILD_LOCATION() method of the parent of 5033 * @p dev. 5034 */ 5035 int 5036 bus_child_location(device_t child, struct sbuf *sb) 5037 { 5038 device_t parent; 5039 5040 parent = device_get_parent(child); 5041 if (parent == NULL) 5042 return (0); 5043 return (BUS_CHILD_LOCATION(parent, child, sb)); 5044 } 5045 5046 /** 5047 * @brief Generic implementation that does nothing for bus_child_location 5048 * 5049 * This function has the right signature and returns 0 since the sbuf is passed 5050 * to us to append to. 5051 */ 5052 int 5053 bus_generic_child_location(device_t dev, device_t child, struct sbuf *sb) 5054 { 5055 return (0); 5056 } 5057 5058 /** 5059 * @brief Wrapper function for BUS_GET_CPUS(). 5060 * 5061 * This function simply calls the BUS_GET_CPUS() method of the 5062 * parent of @p dev. 5063 */ 5064 int 5065 bus_get_cpus(device_t dev, enum cpu_sets op, size_t setsize, cpuset_t *cpuset) 5066 { 5067 device_t parent; 5068 5069 parent = device_get_parent(dev); 5070 if (parent == NULL) 5071 return (EINVAL); 5072 return (BUS_GET_CPUS(parent, dev, op, setsize, cpuset)); 5073 } 5074 5075 /** 5076 * @brief Wrapper function for BUS_GET_DMA_TAG(). 5077 * 5078 * This function simply calls the BUS_GET_DMA_TAG() method of the 5079 * parent of @p dev. 5080 */ 5081 bus_dma_tag_t 5082 bus_get_dma_tag(device_t dev) 5083 { 5084 device_t parent; 5085 5086 parent = device_get_parent(dev); 5087 if (parent == NULL) 5088 return (NULL); 5089 return (BUS_GET_DMA_TAG(parent, dev)); 5090 } 5091 5092 /** 5093 * @brief Wrapper function for BUS_GET_BUS_TAG(). 5094 * 5095 * This function simply calls the BUS_GET_BUS_TAG() method of the 5096 * parent of @p dev. 5097 */ 5098 bus_space_tag_t 5099 bus_get_bus_tag(device_t dev) 5100 { 5101 device_t parent; 5102 5103 parent = device_get_parent(dev); 5104 if (parent == NULL) 5105 return ((bus_space_tag_t)0); 5106 return (BUS_GET_BUS_TAG(parent, dev)); 5107 } 5108 5109 /** 5110 * @brief Wrapper function for BUS_GET_DOMAIN(). 5111 * 5112 * This function simply calls the BUS_GET_DOMAIN() method of the 5113 * parent of @p dev. 5114 */ 5115 int 5116 bus_get_domain(device_t dev, int *domain) 5117 { 5118 return (BUS_GET_DOMAIN(device_get_parent(dev), dev, domain)); 5119 } 5120 5121 /* Resume all devices and then notify userland that we're up again. */ 5122 static int 5123 root_resume(device_t dev) 5124 { 5125 int error; 5126 5127 error = bus_generic_resume(dev); 5128 if (error == 0) { 5129 devctl_notify("kernel", "power", "resume", NULL); 5130 } 5131 return (error); 5132 } 5133 5134 static int 5135 root_print_child(device_t dev, device_t child) 5136 { 5137 int retval = 0; 5138 5139 retval += bus_print_child_header(dev, child); 5140 retval += printf("\n"); 5141 5142 return (retval); 5143 } 5144 5145 static int 5146 root_setup_intr(device_t dev, device_t child, struct resource *irq, int flags, 5147 driver_filter_t *filter, driver_intr_t *intr, void *arg, void **cookiep) 5148 { 5149 /* 5150 * If an interrupt mapping gets to here something bad has happened. 5151 */ 5152 panic("root_setup_intr"); 5153 } 5154 5155 /* 5156 * If we get here, assume that the device is permanent and really is 5157 * present in the system. Removable bus drivers are expected to intercept 5158 * this call long before it gets here. We return -1 so that drivers that 5159 * really care can check vs -1 or some ERRNO returned higher in the food 5160 * chain. 5161 */ 5162 static int 5163 root_child_present(device_t dev, device_t child) 5164 { 5165 return (-1); 5166 } 5167 5168 static int 5169 root_get_cpus(device_t dev, device_t child, enum cpu_sets op, size_t setsize, 5170 cpuset_t *cpuset) 5171 { 5172 switch (op) { 5173 case INTR_CPUS: 5174 /* Default to returning the set of all CPUs. */ 5175 if (setsize != sizeof(cpuset_t)) 5176 return (EINVAL); 5177 *cpuset = all_cpus; 5178 return (0); 5179 default: 5180 return (EINVAL); 5181 } 5182 } 5183 5184 static kobj_method_t root_methods[] = { 5185 /* Device interface */ 5186 KOBJMETHOD(device_shutdown, bus_generic_shutdown), 5187 KOBJMETHOD(device_suspend, bus_generic_suspend), 5188 KOBJMETHOD(device_resume, root_resume), 5189 5190 /* Bus interface */ 5191 KOBJMETHOD(bus_print_child, root_print_child), 5192 KOBJMETHOD(bus_read_ivar, bus_generic_read_ivar), 5193 KOBJMETHOD(bus_write_ivar, bus_generic_write_ivar), 5194 KOBJMETHOD(bus_setup_intr, root_setup_intr), 5195 KOBJMETHOD(bus_child_present, root_child_present), 5196 KOBJMETHOD(bus_get_cpus, root_get_cpus), 5197 5198 KOBJMETHOD_END 5199 }; 5200 5201 static driver_t root_driver = { 5202 "root", 5203 root_methods, 5204 1, /* no softc */ 5205 }; 5206 5207 device_t root_bus; 5208 devclass_t root_devclass; 5209 5210 static int 5211 root_bus_module_handler(module_t mod, int what, void* arg) 5212 { 5213 switch (what) { 5214 case MOD_LOAD: 5215 TAILQ_INIT(&bus_data_devices); 5216 kobj_class_compile((kobj_class_t) &root_driver); 5217 root_bus = make_device(NULL, "root", 0); 5218 root_bus->desc = "System root bus"; 5219 kobj_init((kobj_t) root_bus, (kobj_class_t) &root_driver); 5220 root_bus->driver = &root_driver; 5221 root_bus->state = DS_ATTACHED; 5222 root_devclass = devclass_find_internal("root", NULL, FALSE); 5223 devctl2_init(); 5224 return (0); 5225 5226 case MOD_SHUTDOWN: 5227 device_shutdown(root_bus); 5228 return (0); 5229 default: 5230 return (EOPNOTSUPP); 5231 } 5232 5233 return (0); 5234 } 5235 5236 static moduledata_t root_bus_mod = { 5237 "rootbus", 5238 root_bus_module_handler, 5239 NULL 5240 }; 5241 DECLARE_MODULE(rootbus, root_bus_mod, SI_SUB_DRIVERS, SI_ORDER_FIRST); 5242 5243 /** 5244 * @brief Automatically configure devices 5245 * 5246 * This function begins the autoconfiguration process by calling 5247 * device_probe_and_attach() for each child of the @c root0 device. 5248 */ 5249 void 5250 root_bus_configure(void) 5251 { 5252 PDEBUG((".")); 5253 5254 /* Eventually this will be split up, but this is sufficient for now. */ 5255 bus_set_pass(BUS_PASS_DEFAULT); 5256 } 5257 5258 /** 5259 * @brief Module handler for registering device drivers 5260 * 5261 * This module handler is used to automatically register device 5262 * drivers when modules are loaded. If @p what is MOD_LOAD, it calls 5263 * devclass_add_driver() for the driver described by the 5264 * driver_module_data structure pointed to by @p arg 5265 */ 5266 int 5267 driver_module_handler(module_t mod, int what, void *arg) 5268 { 5269 struct driver_module_data *dmd; 5270 devclass_t bus_devclass; 5271 kobj_class_t driver; 5272 int error, pass; 5273 5274 dmd = (struct driver_module_data *)arg; 5275 bus_devclass = devclass_find_internal(dmd->dmd_busname, NULL, TRUE); 5276 error = 0; 5277 5278 switch (what) { 5279 case MOD_LOAD: 5280 if (dmd->dmd_chainevh) 5281 error = dmd->dmd_chainevh(mod,what,dmd->dmd_chainarg); 5282 5283 pass = dmd->dmd_pass; 5284 driver = dmd->dmd_driver; 5285 PDEBUG(("Loading module: driver %s on bus %s (pass %d)", 5286 DRIVERNAME(driver), dmd->dmd_busname, pass)); 5287 error = devclass_add_driver(bus_devclass, driver, pass, 5288 dmd->dmd_devclass); 5289 break; 5290 5291 case MOD_UNLOAD: 5292 PDEBUG(("Unloading module: driver %s from bus %s", 5293 DRIVERNAME(dmd->dmd_driver), 5294 dmd->dmd_busname)); 5295 error = devclass_delete_driver(bus_devclass, 5296 dmd->dmd_driver); 5297 5298 if (!error && dmd->dmd_chainevh) 5299 error = dmd->dmd_chainevh(mod,what,dmd->dmd_chainarg); 5300 break; 5301 case MOD_QUIESCE: 5302 PDEBUG(("Quiesce module: driver %s from bus %s", 5303 DRIVERNAME(dmd->dmd_driver), 5304 dmd->dmd_busname)); 5305 error = devclass_quiesce_driver(bus_devclass, 5306 dmd->dmd_driver); 5307 5308 if (!error && dmd->dmd_chainevh) 5309 error = dmd->dmd_chainevh(mod,what,dmd->dmd_chainarg); 5310 break; 5311 default: 5312 error = EOPNOTSUPP; 5313 break; 5314 } 5315 5316 return (error); 5317 } 5318 5319 /** 5320 * @brief Enumerate all hinted devices for this bus. 5321 * 5322 * Walks through the hints for this bus and calls the bus_hinted_child 5323 * routine for each one it fines. It searches first for the specific 5324 * bus that's being probed for hinted children (eg isa0), and then for 5325 * generic children (eg isa). 5326 * 5327 * @param dev bus device to enumerate 5328 */ 5329 void 5330 bus_enumerate_hinted_children(device_t bus) 5331 { 5332 int i; 5333 const char *dname, *busname; 5334 int dunit; 5335 5336 /* 5337 * enumerate all devices on the specific bus 5338 */ 5339 busname = device_get_nameunit(bus); 5340 i = 0; 5341 while (resource_find_match(&i, &dname, &dunit, "at", busname) == 0) 5342 BUS_HINTED_CHILD(bus, dname, dunit); 5343 5344 /* 5345 * and all the generic ones. 5346 */ 5347 busname = device_get_name(bus); 5348 i = 0; 5349 while (resource_find_match(&i, &dname, &dunit, "at", busname) == 0) 5350 BUS_HINTED_CHILD(bus, dname, dunit); 5351 } 5352 5353 #ifdef BUS_DEBUG 5354 5355 /* the _short versions avoid iteration by not calling anything that prints 5356 * more than oneliners. I love oneliners. 5357 */ 5358 5359 static void 5360 print_device_short(device_t dev, int indent) 5361 { 5362 if (!dev) 5363 return; 5364 5365 indentprintf(("device %d: <%s> %sparent,%schildren,%s%s%s%s%s,%sivars,%ssoftc,busy=%d\n", 5366 dev->unit, dev->desc, 5367 (dev->parent? "":"no "), 5368 (TAILQ_EMPTY(&dev->children)? "no ":""), 5369 (dev->flags&DF_ENABLED? "enabled,":"disabled,"), 5370 (dev->flags&DF_FIXEDCLASS? "fixed,":""), 5371 (dev->flags&DF_WILDCARD? "wildcard,":""), 5372 (dev->flags&DF_DESCMALLOCED? "descmalloced,":""), 5373 (dev->flags&DF_SUSPENDED? "suspended,":""), 5374 (dev->ivars? "":"no "), 5375 (dev->softc? "":"no "), 5376 dev->busy)); 5377 } 5378 5379 static void 5380 print_device(device_t dev, int indent) 5381 { 5382 if (!dev) 5383 return; 5384 5385 print_device_short(dev, indent); 5386 5387 indentprintf(("Parent:\n")); 5388 print_device_short(dev->parent, indent+1); 5389 indentprintf(("Driver:\n")); 5390 print_driver_short(dev->driver, indent+1); 5391 indentprintf(("Devclass:\n")); 5392 print_devclass_short(dev->devclass, indent+1); 5393 } 5394 5395 void 5396 print_device_tree_short(device_t dev, int indent) 5397 /* print the device and all its children (indented) */ 5398 { 5399 device_t child; 5400 5401 if (!dev) 5402 return; 5403 5404 print_device_short(dev, indent); 5405 5406 TAILQ_FOREACH(child, &dev->children, link) { 5407 print_device_tree_short(child, indent+1); 5408 } 5409 } 5410 5411 void 5412 print_device_tree(device_t dev, int indent) 5413 /* print the device and all its children (indented) */ 5414 { 5415 device_t child; 5416 5417 if (!dev) 5418 return; 5419 5420 print_device(dev, indent); 5421 5422 TAILQ_FOREACH(child, &dev->children, link) { 5423 print_device_tree(child, indent+1); 5424 } 5425 } 5426 5427 static void 5428 print_driver_short(driver_t *driver, int indent) 5429 { 5430 if (!driver) 5431 return; 5432 5433 indentprintf(("driver %s: softc size = %zd\n", 5434 driver->name, driver->size)); 5435 } 5436 5437 static void 5438 print_driver(driver_t *driver, int indent) 5439 { 5440 if (!driver) 5441 return; 5442 5443 print_driver_short(driver, indent); 5444 } 5445 5446 static void 5447 print_driver_list(driver_list_t drivers, int indent) 5448 { 5449 driverlink_t driver; 5450 5451 TAILQ_FOREACH(driver, &drivers, link) { 5452 print_driver(driver->driver, indent); 5453 } 5454 } 5455 5456 static void 5457 print_devclass_short(devclass_t dc, int indent) 5458 { 5459 if ( !dc ) 5460 return; 5461 5462 indentprintf(("devclass %s: max units = %d\n", dc->name, dc->maxunit)); 5463 } 5464 5465 static void 5466 print_devclass(devclass_t dc, int indent) 5467 { 5468 int i; 5469 5470 if ( !dc ) 5471 return; 5472 5473 print_devclass_short(dc, indent); 5474 indentprintf(("Drivers:\n")); 5475 print_driver_list(dc->drivers, indent+1); 5476 5477 indentprintf(("Devices:\n")); 5478 for (i = 0; i < dc->maxunit; i++) 5479 if (dc->devices[i]) 5480 print_device(dc->devices[i], indent+1); 5481 } 5482 5483 void 5484 print_devclass_list_short(void) 5485 { 5486 devclass_t dc; 5487 5488 printf("Short listing of devclasses, drivers & devices:\n"); 5489 TAILQ_FOREACH(dc, &devclasses, link) { 5490 print_devclass_short(dc, 0); 5491 } 5492 } 5493 5494 void 5495 print_devclass_list(void) 5496 { 5497 devclass_t dc; 5498 5499 printf("Full listing of devclasses, drivers & devices:\n"); 5500 TAILQ_FOREACH(dc, &devclasses, link) { 5501 print_devclass(dc, 0); 5502 } 5503 } 5504 5505 #endif 5506 5507 /* 5508 * User-space access to the device tree. 5509 * 5510 * We implement a small set of nodes: 5511 * 5512 * hw.bus Single integer read method to obtain the 5513 * current generation count. 5514 * hw.bus.devices Reads the entire device tree in flat space. 5515 * hw.bus.rman Resource manager interface 5516 * 5517 * We might like to add the ability to scan devclasses and/or drivers to 5518 * determine what else is currently loaded/available. 5519 */ 5520 5521 static int 5522 sysctl_bus_info(SYSCTL_HANDLER_ARGS) 5523 { 5524 struct u_businfo ubus; 5525 5526 ubus.ub_version = BUS_USER_VERSION; 5527 ubus.ub_generation = bus_data_generation; 5528 5529 return (SYSCTL_OUT(req, &ubus, sizeof(ubus))); 5530 } 5531 SYSCTL_PROC(_hw_bus, OID_AUTO, info, CTLTYPE_STRUCT | CTLFLAG_RD | 5532 CTLFLAG_MPSAFE, NULL, 0, sysctl_bus_info, "S,u_businfo", 5533 "bus-related data"); 5534 5535 static int 5536 sysctl_devices(SYSCTL_HANDLER_ARGS) 5537 { 5538 struct sbuf sb; 5539 int *name = (int *)arg1; 5540 u_int namelen = arg2; 5541 int index; 5542 device_t dev; 5543 struct u_device *udev; 5544 int error; 5545 5546 if (namelen != 2) 5547 return (EINVAL); 5548 5549 if (bus_data_generation_check(name[0])) 5550 return (EINVAL); 5551 5552 index = name[1]; 5553 5554 /* 5555 * Scan the list of devices, looking for the requested index. 5556 */ 5557 TAILQ_FOREACH(dev, &bus_data_devices, devlink) { 5558 if (index-- == 0) 5559 break; 5560 } 5561 if (dev == NULL) 5562 return (ENOENT); 5563 5564 /* 5565 * Populate the return item, careful not to overflow the buffer. 5566 */ 5567 udev = malloc(sizeof(*udev), M_BUS, M_WAITOK | M_ZERO); 5568 udev->dv_handle = (uintptr_t)dev; 5569 udev->dv_parent = (uintptr_t)dev->parent; 5570 udev->dv_devflags = dev->devflags; 5571 udev->dv_flags = dev->flags; 5572 udev->dv_state = dev->state; 5573 sbuf_new(&sb, udev->dv_fields, sizeof(udev->dv_fields), SBUF_FIXEDLEN); 5574 if (dev->nameunit != NULL) 5575 sbuf_cat(&sb, dev->nameunit); 5576 sbuf_putc(&sb, '\0'); 5577 if (dev->desc != NULL) 5578 sbuf_cat(&sb, dev->desc); 5579 sbuf_putc(&sb, '\0'); 5580 if (dev->driver != NULL) 5581 sbuf_cat(&sb, dev->driver->name); 5582 sbuf_putc(&sb, '\0'); 5583 bus_child_pnpinfo(dev, &sb); 5584 sbuf_putc(&sb, '\0'); 5585 bus_child_location(dev, &sb); 5586 sbuf_putc(&sb, '\0'); 5587 error = sbuf_finish(&sb); 5588 if (error == 0) 5589 error = SYSCTL_OUT(req, udev, sizeof(*udev)); 5590 sbuf_delete(&sb); 5591 free(udev, M_BUS); 5592 return (error); 5593 } 5594 5595 SYSCTL_NODE(_hw_bus, OID_AUTO, devices, 5596 CTLFLAG_RD | CTLFLAG_NEEDGIANT, sysctl_devices, 5597 "system device tree"); 5598 5599 int 5600 bus_data_generation_check(int generation) 5601 { 5602 if (generation != bus_data_generation) 5603 return (1); 5604 5605 /* XXX generate optimised lists here? */ 5606 return (0); 5607 } 5608 5609 void 5610 bus_data_generation_update(void) 5611 { 5612 atomic_add_int(&bus_data_generation, 1); 5613 } 5614 5615 int 5616 bus_free_resource(device_t dev, int type, struct resource *r) 5617 { 5618 if (r == NULL) 5619 return (0); 5620 return (bus_release_resource(dev, type, rman_get_rid(r), r)); 5621 } 5622 5623 device_t 5624 device_lookup_by_name(const char *name) 5625 { 5626 device_t dev; 5627 5628 TAILQ_FOREACH(dev, &bus_data_devices, devlink) { 5629 if (dev->nameunit != NULL && strcmp(dev->nameunit, name) == 0) 5630 return (dev); 5631 } 5632 return (NULL); 5633 } 5634 5635 /* 5636 * /dev/devctl2 implementation. The existing /dev/devctl device has 5637 * implicit semantics on open, so it could not be reused for this. 5638 * Another option would be to call this /dev/bus? 5639 */ 5640 static int 5641 find_device(struct devreq *req, device_t *devp) 5642 { 5643 device_t dev; 5644 5645 /* 5646 * First, ensure that the name is nul terminated. 5647 */ 5648 if (memchr(req->dr_name, '\0', sizeof(req->dr_name)) == NULL) 5649 return (EINVAL); 5650 5651 /* 5652 * Second, try to find an attached device whose name matches 5653 * 'name'. 5654 */ 5655 dev = device_lookup_by_name(req->dr_name); 5656 if (dev != NULL) { 5657 *devp = dev; 5658 return (0); 5659 } 5660 5661 /* Finally, give device enumerators a chance. */ 5662 dev = NULL; 5663 EVENTHANDLER_DIRECT_INVOKE(dev_lookup, req->dr_name, &dev); 5664 if (dev == NULL) 5665 return (ENOENT); 5666 *devp = dev; 5667 return (0); 5668 } 5669 5670 static bool 5671 driver_exists(device_t bus, const char *driver) 5672 { 5673 devclass_t dc; 5674 5675 for (dc = bus->devclass; dc != NULL; dc = dc->parent) { 5676 if (devclass_find_driver_internal(dc, driver) != NULL) 5677 return (true); 5678 } 5679 return (false); 5680 } 5681 5682 static void 5683 device_gen_nomatch(device_t dev) 5684 { 5685 device_t child; 5686 5687 if (dev->flags & DF_NEEDNOMATCH && 5688 dev->state == DS_NOTPRESENT) { 5689 device_handle_nomatch(dev); 5690 } 5691 dev->flags &= ~DF_NEEDNOMATCH; 5692 TAILQ_FOREACH(child, &dev->children, link) { 5693 device_gen_nomatch(child); 5694 } 5695 } 5696 5697 static void 5698 device_do_deferred_actions(void) 5699 { 5700 devclass_t dc; 5701 driverlink_t dl; 5702 5703 /* 5704 * Walk through the devclasses to find all the drivers we've tagged as 5705 * deferred during the freeze and call the driver added routines. They 5706 * have already been added to the lists in the background, so the driver 5707 * added routines that trigger a probe will have all the right bidders 5708 * for the probe auction. 5709 */ 5710 TAILQ_FOREACH(dc, &devclasses, link) { 5711 TAILQ_FOREACH(dl, &dc->drivers, link) { 5712 if (dl->flags & DL_DEFERRED_PROBE) { 5713 devclass_driver_added(dc, dl->driver); 5714 dl->flags &= ~DL_DEFERRED_PROBE; 5715 } 5716 } 5717 } 5718 5719 /* 5720 * We also defer no-match events during a freeze. Walk the tree and 5721 * generate all the pent-up events that are still relevant. 5722 */ 5723 device_gen_nomatch(root_bus); 5724 bus_data_generation_update(); 5725 } 5726 5727 static int 5728 device_get_path(device_t dev, const char *locator, struct sbuf *sb) 5729 { 5730 device_t parent; 5731 int error; 5732 5733 KASSERT(sb != NULL, ("sb is NULL")); 5734 parent = device_get_parent(dev); 5735 if (parent == NULL) { 5736 error = sbuf_putc(sb, '/'); 5737 } else { 5738 error = BUS_GET_DEVICE_PATH(parent, dev, locator, sb); 5739 if (error == 0) { 5740 error = sbuf_error(sb); 5741 if (error == 0 && sbuf_len(sb) <= 1) 5742 error = EIO; 5743 } 5744 } 5745 sbuf_finish(sb); 5746 return (error); 5747 } 5748 5749 static int 5750 devctl2_ioctl(struct cdev *cdev, u_long cmd, caddr_t data, int fflag, 5751 struct thread *td) 5752 { 5753 struct devreq *req; 5754 device_t dev; 5755 int error, old; 5756 5757 /* Locate the device to control. */ 5758 bus_topo_lock(); 5759 req = (struct devreq *)data; 5760 switch (cmd) { 5761 case DEV_ATTACH: 5762 case DEV_DETACH: 5763 case DEV_ENABLE: 5764 case DEV_DISABLE: 5765 case DEV_SUSPEND: 5766 case DEV_RESUME: 5767 case DEV_SET_DRIVER: 5768 case DEV_CLEAR_DRIVER: 5769 case DEV_RESCAN: 5770 case DEV_DELETE: 5771 case DEV_RESET: 5772 error = priv_check(td, PRIV_DRIVER); 5773 if (error == 0) 5774 error = find_device(req, &dev); 5775 break; 5776 case DEV_FREEZE: 5777 case DEV_THAW: 5778 error = priv_check(td, PRIV_DRIVER); 5779 break; 5780 case DEV_GET_PATH: 5781 error = find_device(req, &dev); 5782 break; 5783 default: 5784 error = ENOTTY; 5785 break; 5786 } 5787 if (error) { 5788 bus_topo_unlock(); 5789 return (error); 5790 } 5791 5792 /* Perform the requested operation. */ 5793 switch (cmd) { 5794 case DEV_ATTACH: 5795 if (device_is_attached(dev)) 5796 error = EBUSY; 5797 else if (!device_is_enabled(dev)) 5798 error = ENXIO; 5799 else 5800 error = device_probe_and_attach(dev); 5801 break; 5802 case DEV_DETACH: 5803 if (!device_is_attached(dev)) { 5804 error = ENXIO; 5805 break; 5806 } 5807 if (!(req->dr_flags & DEVF_FORCE_DETACH)) { 5808 error = device_quiesce(dev); 5809 if (error) 5810 break; 5811 } 5812 error = device_detach(dev); 5813 break; 5814 case DEV_ENABLE: 5815 if (device_is_enabled(dev)) { 5816 error = EBUSY; 5817 break; 5818 } 5819 5820 /* 5821 * If the device has been probed but not attached (e.g. 5822 * when it has been disabled by a loader hint), just 5823 * attach the device rather than doing a full probe. 5824 */ 5825 device_enable(dev); 5826 if (dev->devclass != NULL) { 5827 /* 5828 * If the device was disabled via a hint, clear 5829 * the hint. 5830 */ 5831 if (resource_disabled(dev->devclass->name, dev->unit)) 5832 resource_unset_value(dev->devclass->name, 5833 dev->unit, "disabled"); 5834 5835 /* Allow any drivers to rebid. */ 5836 if (!(dev->flags & DF_FIXEDCLASS)) 5837 devclass_delete_device(dev->devclass, dev); 5838 } 5839 error = device_probe_and_attach(dev); 5840 break; 5841 case DEV_DISABLE: 5842 if (!device_is_enabled(dev)) { 5843 error = ENXIO; 5844 break; 5845 } 5846 5847 if (!(req->dr_flags & DEVF_FORCE_DETACH)) { 5848 error = device_quiesce(dev); 5849 if (error) 5850 break; 5851 } 5852 5853 /* 5854 * Force DF_FIXEDCLASS on around detach to preserve 5855 * the existing name. 5856 */ 5857 old = dev->flags; 5858 dev->flags |= DF_FIXEDCLASS; 5859 error = device_detach(dev); 5860 if (!(old & DF_FIXEDCLASS)) 5861 dev->flags &= ~DF_FIXEDCLASS; 5862 if (error == 0) 5863 device_disable(dev); 5864 break; 5865 case DEV_SUSPEND: 5866 if (device_is_suspended(dev)) { 5867 error = EBUSY; 5868 break; 5869 } 5870 if (device_get_parent(dev) == NULL) { 5871 error = EINVAL; 5872 break; 5873 } 5874 error = BUS_SUSPEND_CHILD(device_get_parent(dev), dev); 5875 break; 5876 case DEV_RESUME: 5877 if (!device_is_suspended(dev)) { 5878 error = EINVAL; 5879 break; 5880 } 5881 if (device_get_parent(dev) == NULL) { 5882 error = EINVAL; 5883 break; 5884 } 5885 error = BUS_RESUME_CHILD(device_get_parent(dev), dev); 5886 break; 5887 case DEV_SET_DRIVER: { 5888 devclass_t dc; 5889 char driver[128]; 5890 5891 error = copyinstr(req->dr_data, driver, sizeof(driver), NULL); 5892 if (error) 5893 break; 5894 if (driver[0] == '\0') { 5895 error = EINVAL; 5896 break; 5897 } 5898 if (dev->devclass != NULL && 5899 strcmp(driver, dev->devclass->name) == 0) 5900 /* XXX: Could possibly force DF_FIXEDCLASS on? */ 5901 break; 5902 5903 /* 5904 * Scan drivers for this device's bus looking for at 5905 * least one matching driver. 5906 */ 5907 if (dev->parent == NULL) { 5908 error = EINVAL; 5909 break; 5910 } 5911 if (!driver_exists(dev->parent, driver)) { 5912 error = ENOENT; 5913 break; 5914 } 5915 dc = devclass_create(driver); 5916 if (dc == NULL) { 5917 error = ENOMEM; 5918 break; 5919 } 5920 5921 /* Detach device if necessary. */ 5922 if (device_is_attached(dev)) { 5923 if (req->dr_flags & DEVF_SET_DRIVER_DETACH) 5924 error = device_detach(dev); 5925 else 5926 error = EBUSY; 5927 if (error) 5928 break; 5929 } 5930 5931 /* Clear any previously-fixed device class and unit. */ 5932 if (dev->flags & DF_FIXEDCLASS) 5933 devclass_delete_device(dev->devclass, dev); 5934 dev->flags |= DF_WILDCARD; 5935 dev->unit = DEVICE_UNIT_ANY; 5936 5937 /* Force the new device class. */ 5938 error = devclass_add_device(dc, dev); 5939 if (error) 5940 break; 5941 dev->flags |= DF_FIXEDCLASS; 5942 error = device_probe_and_attach(dev); 5943 break; 5944 } 5945 case DEV_CLEAR_DRIVER: 5946 if (!(dev->flags & DF_FIXEDCLASS)) { 5947 error = 0; 5948 break; 5949 } 5950 if (device_is_attached(dev)) { 5951 if (req->dr_flags & DEVF_CLEAR_DRIVER_DETACH) 5952 error = device_detach(dev); 5953 else 5954 error = EBUSY; 5955 if (error) 5956 break; 5957 } 5958 5959 dev->flags &= ~DF_FIXEDCLASS; 5960 dev->flags |= DF_WILDCARD; 5961 devclass_delete_device(dev->devclass, dev); 5962 error = device_probe_and_attach(dev); 5963 break; 5964 case DEV_RESCAN: 5965 if (!device_is_attached(dev)) { 5966 error = ENXIO; 5967 break; 5968 } 5969 error = BUS_RESCAN(dev); 5970 break; 5971 case DEV_DELETE: { 5972 device_t parent; 5973 5974 parent = device_get_parent(dev); 5975 if (parent == NULL) { 5976 error = EINVAL; 5977 break; 5978 } 5979 if (!(req->dr_flags & DEVF_FORCE_DELETE)) { 5980 if (bus_child_present(dev) != 0) { 5981 error = EBUSY; 5982 break; 5983 } 5984 } 5985 5986 error = device_delete_child(parent, dev); 5987 break; 5988 } 5989 case DEV_FREEZE: 5990 if (device_frozen) 5991 error = EBUSY; 5992 else 5993 device_frozen = true; 5994 break; 5995 case DEV_THAW: 5996 if (!device_frozen) 5997 error = EBUSY; 5998 else { 5999 device_do_deferred_actions(); 6000 device_frozen = false; 6001 } 6002 break; 6003 case DEV_RESET: 6004 if ((req->dr_flags & ~(DEVF_RESET_DETACH)) != 0) { 6005 error = EINVAL; 6006 break; 6007 } 6008 if (device_get_parent(dev) == NULL) { 6009 error = EINVAL; 6010 break; 6011 } 6012 error = BUS_RESET_CHILD(device_get_parent(dev), dev, 6013 req->dr_flags); 6014 break; 6015 case DEV_GET_PATH: { 6016 struct sbuf *sb; 6017 char locator[64]; 6018 ssize_t len; 6019 6020 error = copyinstr(req->dr_buffer.buffer, locator, 6021 sizeof(locator), NULL); 6022 if (error != 0) 6023 break; 6024 sb = sbuf_new(NULL, NULL, 0, SBUF_AUTOEXTEND | 6025 SBUF_INCLUDENUL /* | SBUF_WAITOK */); 6026 error = device_get_path(dev, locator, sb); 6027 if (error == 0) { 6028 len = sbuf_len(sb); 6029 if (req->dr_buffer.length < len) { 6030 error = ENAMETOOLONG; 6031 } else { 6032 error = copyout(sbuf_data(sb), 6033 req->dr_buffer.buffer, len); 6034 } 6035 req->dr_buffer.length = len; 6036 } 6037 sbuf_delete(sb); 6038 break; 6039 } 6040 } 6041 bus_topo_unlock(); 6042 return (error); 6043 } 6044 6045 static struct cdevsw devctl2_cdevsw = { 6046 .d_version = D_VERSION, 6047 .d_ioctl = devctl2_ioctl, 6048 .d_name = "devctl2", 6049 }; 6050 6051 static void 6052 devctl2_init(void) 6053 { 6054 make_dev_credf(MAKEDEV_ETERNAL, &devctl2_cdevsw, 0, NULL, 6055 UID_ROOT, GID_WHEEL, 0644, "devctl2"); 6056 } 6057 6058 /* 6059 * For maintaining device 'at' location info to avoid recomputing it 6060 */ 6061 struct device_location_node { 6062 const char *dln_locator; 6063 const char *dln_path; 6064 TAILQ_ENTRY(device_location_node) dln_link; 6065 }; 6066 typedef TAILQ_HEAD(device_location_list, device_location_node) device_location_list_t; 6067 6068 struct device_location_cache { 6069 device_location_list_t dlc_list; 6070 }; 6071 6072 6073 /* 6074 * Location cache for wired devices. 6075 */ 6076 device_location_cache_t * 6077 dev_wired_cache_init(void) 6078 { 6079 device_location_cache_t *dcp; 6080 6081 dcp = malloc(sizeof(*dcp), M_BUS, M_WAITOK | M_ZERO); 6082 TAILQ_INIT(&dcp->dlc_list); 6083 6084 return (dcp); 6085 } 6086 6087 void 6088 dev_wired_cache_fini(device_location_cache_t *dcp) 6089 { 6090 struct device_location_node *dln, *tdln; 6091 6092 TAILQ_FOREACH_SAFE(dln, &dcp->dlc_list, dln_link, tdln) { 6093 free(dln, M_BUS); 6094 } 6095 free(dcp, M_BUS); 6096 } 6097 6098 static struct device_location_node * 6099 dev_wired_cache_lookup(device_location_cache_t *dcp, const char *locator) 6100 { 6101 struct device_location_node *dln; 6102 6103 TAILQ_FOREACH(dln, &dcp->dlc_list, dln_link) { 6104 if (strcmp(locator, dln->dln_locator) == 0) 6105 return (dln); 6106 } 6107 6108 return (NULL); 6109 } 6110 6111 static struct device_location_node * 6112 dev_wired_cache_add(device_location_cache_t *dcp, const char *locator, const char *path) 6113 { 6114 struct device_location_node *dln; 6115 size_t loclen, pathlen; 6116 6117 loclen = strlen(locator) + 1; 6118 pathlen = strlen(path) + 1; 6119 dln = malloc(sizeof(*dln) + loclen + pathlen, M_BUS, M_WAITOK | M_ZERO); 6120 dln->dln_locator = (char *)(dln + 1); 6121 memcpy(__DECONST(char *, dln->dln_locator), locator, loclen); 6122 dln->dln_path = dln->dln_locator + loclen; 6123 memcpy(__DECONST(char *, dln->dln_path), path, pathlen); 6124 TAILQ_INSERT_HEAD(&dcp->dlc_list, dln, dln_link); 6125 6126 return (dln); 6127 } 6128 6129 bool 6130 dev_wired_cache_match(device_location_cache_t *dcp, device_t dev, 6131 const char *at) 6132 { 6133 struct sbuf *sb; 6134 const char *cp; 6135 char locator[32]; 6136 int error, len; 6137 struct device_location_node *res; 6138 6139 cp = strchr(at, ':'); 6140 if (cp == NULL) 6141 return (false); 6142 len = cp - at; 6143 if (len > sizeof(locator) - 1) /* Skip too long locator */ 6144 return (false); 6145 memcpy(locator, at, len); 6146 locator[len] = '\0'; 6147 cp++; 6148 6149 error = 0; 6150 /* maybe cache this inside device_t and look that up, but not yet */ 6151 res = dev_wired_cache_lookup(dcp, locator); 6152 if (res == NULL) { 6153 sb = sbuf_new(NULL, NULL, 0, SBUF_AUTOEXTEND | 6154 SBUF_INCLUDENUL | SBUF_NOWAIT); 6155 if (sb != NULL) { 6156 error = device_get_path(dev, locator, sb); 6157 if (error == 0) { 6158 res = dev_wired_cache_add(dcp, locator, 6159 sbuf_data(sb)); 6160 } 6161 sbuf_delete(sb); 6162 } 6163 } 6164 if (error != 0 || res == NULL || res->dln_path == NULL) 6165 return (false); 6166 6167 return (strcmp(res->dln_path, cp) == 0); 6168 } 6169 6170 static struct device_prop_elm * 6171 device_prop_find(device_t dev, const char *name) 6172 { 6173 struct device_prop_elm *e; 6174 6175 bus_topo_assert(); 6176 6177 LIST_FOREACH(e, &dev->props, link) { 6178 if (strcmp(name, e->name) == 0) 6179 return (e); 6180 } 6181 return (NULL); 6182 } 6183 6184 int 6185 device_set_prop(device_t dev, const char *name, void *val, 6186 device_prop_dtr_t dtr, void *dtr_ctx) 6187 { 6188 struct device_prop_elm *e, *e1; 6189 6190 bus_topo_assert(); 6191 6192 e = device_prop_find(dev, name); 6193 if (e != NULL) 6194 goto found; 6195 6196 e1 = malloc(sizeof(*e), M_BUS, M_WAITOK); 6197 e = device_prop_find(dev, name); 6198 if (e != NULL) { 6199 free(e1, M_BUS); 6200 goto found; 6201 } 6202 6203 e1->name = name; 6204 e1->val = val; 6205 e1->dtr = dtr; 6206 e1->dtr_ctx = dtr_ctx; 6207 LIST_INSERT_HEAD(&dev->props, e1, link); 6208 return (0); 6209 6210 found: 6211 LIST_REMOVE(e, link); 6212 if (e->dtr != NULL) 6213 e->dtr(dev, name, e->val, e->dtr_ctx); 6214 e->val = val; 6215 e->dtr = dtr; 6216 e->dtr_ctx = dtr_ctx; 6217 LIST_INSERT_HEAD(&dev->props, e, link); 6218 return (EEXIST); 6219 } 6220 6221 int 6222 device_get_prop(device_t dev, const char *name, void **valp) 6223 { 6224 struct device_prop_elm *e; 6225 6226 bus_topo_assert(); 6227 6228 e = device_prop_find(dev, name); 6229 if (e == NULL) 6230 return (ENOENT); 6231 *valp = e->val; 6232 return (0); 6233 } 6234 6235 int 6236 device_clear_prop(device_t dev, const char *name) 6237 { 6238 struct device_prop_elm *e; 6239 6240 bus_topo_assert(); 6241 6242 e = device_prop_find(dev, name); 6243 if (e == NULL) 6244 return (ENOENT); 6245 LIST_REMOVE(e, link); 6246 if (e->dtr != NULL) 6247 e->dtr(dev, e->name, e->val, e->dtr_ctx); 6248 free(e, M_BUS); 6249 return (0); 6250 } 6251 6252 static void 6253 device_destroy_props(device_t dev) 6254 { 6255 struct device_prop_elm *e; 6256 6257 bus_topo_assert(); 6258 6259 while ((e = LIST_FIRST(&dev->props)) != NULL) { 6260 LIST_REMOVE_HEAD(&dev->props, link); 6261 if (e->dtr != NULL) 6262 e->dtr(dev, e->name, e->val, e->dtr_ctx); 6263 free(e, M_BUS); 6264 } 6265 } 6266 6267 void 6268 device_clear_prop_alldev(const char *name) 6269 { 6270 device_t dev; 6271 6272 TAILQ_FOREACH(dev, &bus_data_devices, devlink) { 6273 device_clear_prop(dev, name); 6274 } 6275 } 6276 6277 /* 6278 * APIs to manage deprecation and obsolescence. 6279 */ 6280 static int obsolete_panic = 0; 6281 SYSCTL_INT(_debug, OID_AUTO, obsolete_panic, CTLFLAG_RWTUN, &obsolete_panic, 0, 6282 "Panic when obsolete features are used (0 = never, 1 = if obsolete, " 6283 "2 = if deprecated)"); 6284 6285 static void 6286 gone_panic(int major, int running, const char *msg) 6287 { 6288 switch (obsolete_panic) 6289 { 6290 case 0: 6291 return; 6292 case 1: 6293 if (running < major) 6294 return; 6295 /* FALLTHROUGH */ 6296 default: 6297 panic("%s", msg); 6298 } 6299 } 6300 6301 void 6302 _gone_in(int major, const char *msg) 6303 { 6304 gone_panic(major, P_OSREL_MAJOR(__FreeBSD_version), msg); 6305 if (P_OSREL_MAJOR(__FreeBSD_version) >= major) 6306 printf("Obsolete code will be removed soon: %s\n", msg); 6307 else 6308 printf("Deprecated code (to be removed in FreeBSD %d): %s\n", 6309 major, msg); 6310 } 6311 6312 void 6313 _gone_in_dev(device_t dev, int major, const char *msg) 6314 { 6315 gone_panic(major, P_OSREL_MAJOR(__FreeBSD_version), msg); 6316 if (P_OSREL_MAJOR(__FreeBSD_version) >= major) 6317 device_printf(dev, 6318 "Obsolete code will be removed soon: %s\n", msg); 6319 else 6320 device_printf(dev, 6321 "Deprecated code (to be removed in FreeBSD %d): %s\n", 6322 major, msg); 6323 } 6324 6325 #ifdef DDB 6326 DB_SHOW_COMMAND(device, db_show_device) 6327 { 6328 device_t dev; 6329 6330 if (!have_addr) 6331 return; 6332 6333 dev = (device_t)addr; 6334 6335 db_printf("name: %s\n", device_get_nameunit(dev)); 6336 db_printf(" driver: %s\n", DRIVERNAME(dev->driver)); 6337 db_printf(" class: %s\n", DEVCLANAME(dev->devclass)); 6338 db_printf(" addr: %p\n", dev); 6339 db_printf(" parent: %p\n", dev->parent); 6340 db_printf(" softc: %p\n", dev->softc); 6341 db_printf(" ivars: %p\n", dev->ivars); 6342 } 6343 6344 DB_SHOW_ALL_COMMAND(devices, db_show_all_devices) 6345 { 6346 device_t dev; 6347 6348 TAILQ_FOREACH(dev, &bus_data_devices, devlink) { 6349 db_show_device((db_expr_t)dev, true, count, modif); 6350 } 6351 } 6352 #endif 6353