sys/kern/subr_bus.c

   1 /*
   2  * Copyright (c) 1997,1998 Doug Rabson
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24  * SUCH DAMAGE.
  25  *
  26  * $FreeBSD: src/sys/kern/subr_bus.c,v 1.54.2.9 2002/10/10 15:13:32 jhb Exp $
  27  * $DragonFly: src/sys/kern/subr_bus.c,v 1.18 2004/05/10 10:51:31 hmp Exp $
  28  */
  29
  30 #include "opt_bus.h"
  31
  32 #include <sys/param.h>
  33 #include <sys/queue.h>
  34 #include <sys/malloc.h>
  35 #include <sys/kernel.h>
  36 #include <sys/module.h>
  37 #ifdef DEVICE_SYSCTLS
  38 #include <sys/sysctl.h>
  39 #endif
  40 #include <sys/kobj.h>
  41 #include <sys/bus_private.h>
  42 #include <sys/systm.h>
  43 #include <machine/bus.h>
  44 #include <sys/rman.h>
  45 #include <machine/stdarg.h>     /* for device_printf() */
  46
  47 MALLOC_DEFINE(M_BUS, "bus", "Bus data structures");
  48
  49 #ifdef BUS_DEBUG
  50 #define PDEBUG(a)       (printf(__FUNCTION__ ":%d: ", __LINE__), printf a, printf("\n"))
  51 #define DEVICENAME(d)   ((d)? device_get_name(d): "no device")
  52 #define DRIVERNAME(d)   ((d)? d->name : "no driver")
  53 #define DEVCLANAME(d)   ((d)? d->name : "no devclass")
  54
  55 /* Produce the indenting, indent*2 spaces plus a '.' ahead of that to
  56  * prevent syslog from deleting initial spaces
  57  */
  58 #define indentprintf(p) do { int iJ; printf("."); for (iJ=0; iJ<indent; iJ++) printf("  "); printf p ; } while(0)
  59
  60 static void     print_device_short(device_t dev, int indent);
  61 static void     print_device(device_t dev, int indent);
  62 void            print_device_tree_short(device_t dev, int indent);
  63 void            print_device_tree(device_t dev, int indent);
  64 static void     print_driver_short(driver_t *driver, int indent);
  65 static void     print_driver(driver_t *driver, int indent);
  66 static void     print_driver_list(driver_list_t drivers, int indent);
  67 static void     print_devclass_short(devclass_t dc, int indent);
  68 static void     print_devclass(devclass_t dc, int indent);
  69 void            print_devclass_list_short(void);
  70 void            print_devclass_list(void);
  71
  72 #else
  73 /* Make the compiler ignore the function calls */
  74 #define PDEBUG(a)                       /* nop */
  75 #define DEVICENAME(d)                   /* nop */
  76 #define DRIVERNAME(d)                   /* nop */
  77 #define DEVCLANAME(d)                   /* nop */
  78
  79 #define print_device_short(d,i)         /* nop */
  80 #define print_device(d,i)               /* nop */
  81 #define print_device_tree_short(d,i)    /* nop */
  82 #define print_device_tree(d,i)          /* nop */
  83 #define print_driver_short(d,i)         /* nop */
  84 #define print_driver(d,i)               /* nop */
  85 #define print_driver_list(d,i)          /* nop */
  86 #define print_devclass_short(d,i)       /* nop */
  87 #define print_devclass(d,i)             /* nop */
  88 #define print_devclass_list_short()     /* nop */
  89 #define print_devclass_list()           /* nop */
  90 #endif
  91
  92 #ifdef DEVICE_SYSCTLS
  93 static void     device_register_oids(device_t dev);
  94 static void     device_unregister_oids(device_t dev);
  95 #endif
  96
  97 kobj_method_t null_methods[] = {
  98         { 0, 0 }
  99 };
 100
 101 DEFINE_CLASS(null, null_methods, 0);
 102
 103 /*
 104  * Devclass implementation
 105  */
 106
 107 static devclass_list_t devclasses = TAILQ_HEAD_INITIALIZER(devclasses);
 108
 109 static devclass_t
 110 devclass_find_internal(const char *classname, const char *parentname,
 111                        int create)
 112 {
 113         devclass_t dc;
 114
 115         PDEBUG(("looking for %s", classname));
 116         if (classname == NULL)
 117                 return(NULL);
 118
 119         TAILQ_FOREACH(dc, &devclasses, link)
 120                 if (!strcmp(dc->name, classname))
 121                         break;
 122
 123         if (create && !dc) {
 124                 PDEBUG(("creating %s", classname));
 125                 dc = malloc(sizeof(struct devclass) + strlen(classname) + 1,
 126                             M_BUS, M_INTWAIT | M_ZERO);
 127                 if (!dc)
 128                         return(NULL);
 129                 dc->parent = NULL;
 130                 dc->name = (char*) (dc + 1);
 131                 strcpy(dc->name, classname);
 132                 dc->devices = NULL;
 133                 dc->maxunit = 0;
 134                 TAILQ_INIT(&dc->drivers);
 135                 TAILQ_INSERT_TAIL(&devclasses, dc, link);
 136         }
 137         if (parentname && dc && !dc->parent)
 138                 dc->parent = devclass_find_internal(parentname, NULL, FALSE);
 139
 140         return(dc);
 141 }
 142
 143 devclass_t
 144 devclass_create(const char *classname)
 145 {
 146         return(devclass_find_internal(classname, NULL, TRUE));
 147 }
 148
 149 devclass_t
 150 devclass_find(const char *classname)
 151 {
 152         return(devclass_find_internal(classname, NULL, FALSE));
 153 }
 154
 155 int
 156 devclass_add_driver(devclass_t dc, driver_t *driver)
 157 {
 158         driverlink_t dl;
 159         int i;
 160
 161         PDEBUG(("%s", DRIVERNAME(driver)));
 162
 163         dl = malloc(sizeof *dl, M_BUS, M_INTWAIT | M_ZERO);
 164         if (!dl)
 165                 return(ENOMEM);
 166
 167         /*
 168          * Compile the driver's methods. Also increase the reference count
 169          * so that the class doesn't get freed when the last instance
 170          * goes. This means we can safely use static methods and avoids a
 171          * double-free in devclass_delete_driver.
 172          */
 173         kobj_class_instantiate(driver);
 174
 175         /*
 176          * Make sure the devclass which the driver is implementing exists.
 177          */
 178         devclass_find_internal(driver->name, NULL, TRUE);
 179
 180         dl->driver = driver;
 181         TAILQ_INSERT_TAIL(&dc->drivers, dl, link);
 182
 183         /*
 184          * Call BUS_DRIVER_ADDED for any existing busses in this class.
 185          */
 186         for (i = 0; i < dc->maxunit; i++)
 187                 if (dc->devices[i])
 188                         BUS_DRIVER_ADDED(dc->devices[i], driver);
 189
 190         return(0);
 191 }
 192
 193 int
 194 devclass_delete_driver(devclass_t busclass, driver_t *driver)
 195 {
 196         devclass_t dc = devclass_find(driver->name);
 197         driverlink_t dl;
 198         device_t dev;
 199         int i;
 200         int error;
 201
 202         PDEBUG(("%s from devclass %s", driver->name, DEVCLANAME(busclass)));
 203
 204         if (!dc)
 205                 return(0);
 206
 207         /*
 208          * Find the link structure in the bus' list of drivers.
 209          */
 210         TAILQ_FOREACH(dl, &busclass->drivers, link)
 211                 if (dl->driver == driver)
 212                         break;
 213
 214         if (!dl) {
 215                 PDEBUG(("%s not found in %s list", driver->name, busclass->name));
 216                 return(ENOENT);
 217         }
 218
 219         /*
 220          * Disassociate from any devices.  We iterate through all the
 221          * devices in the devclass of the driver and detach any which are
 222          * using the driver and which have a parent in the devclass which
 223          * we are deleting from.
 224          *
 225          * Note that since a driver can be in multiple devclasses, we
 226          * should not detach devices which are not children of devices in
 227          * the affected devclass.
 228          */
 229         for (i = 0; i < dc->maxunit; i++)
 230                 if (dc->devices[i]) {
 231                         dev = dc->devices[i];
 232                         if (dev->driver == driver && dev->parent &&
 233                             dev->parent->devclass == busclass) {
 234                                 if ((error = device_detach(dev)) != 0)
 235                                         return(error);
 236                                 device_set_driver(dev, NULL);
 237                         }
 238                 }
 239
 240         TAILQ_REMOVE(&busclass->drivers, dl, link);
 241         free(dl, M_BUS);
 242
 243         kobj_class_uninstantiate(driver);
 244
 245         return(0);
 246 }
 247
 248 static driverlink_t
 249 devclass_find_driver_internal(devclass_t dc, const char *classname)
 250 {
 251         driverlink_t dl;
 252
 253         PDEBUG(("%s in devclass %s", classname, DEVCLANAME(dc)));
 254
 255         TAILQ_FOREACH(dl, &dc->drivers, link)
 256                 if (!strcmp(dl->driver->name, classname))
 257                         return(dl);
 258
 259         PDEBUG(("not found"));
 260         return(NULL);
 261 }
 262
 263 kobj_class_t
 264 devclass_find_driver(devclass_t dc, const char *classname)
 265 {
 266         driverlink_t dl;
 267
 268         dl = devclass_find_driver_internal(dc, classname);
 269         if (dl)
 270                 return(dl->driver);
 271         else
 272                 return(NULL);
 273 }
 274
 275 const char *
 276 devclass_get_name(devclass_t dc)
 277 {
 278         return(dc->name);
 279 }
 280
 281 device_t
 282 devclass_get_device(devclass_t dc, int unit)
 283 {
 284         if (dc == NULL || unit < 0 || unit >= dc->maxunit)
 285                 return(NULL);
 286         return(dc->devices[unit]);
 287 }
 288
 289 void *
 290 devclass_get_softc(devclass_t dc, int unit)
 291 {
 292         device_t dev;
 293
 294         dev = devclass_get_device(dc, unit);
 295         if (!dev)
 296                 return(NULL);
 297
 298         return(device_get_softc(dev));
 299 }
 300
 301 int
 302 devclass_get_devices(devclass_t dc, device_t **devlistp, int *devcountp)
 303 {
 304         int i;
 305         int count;
 306         device_t *list;
 307
 308         count = 0;
 309         for (i = 0; i < dc->maxunit; i++)
 310                 if (dc->devices[i])
 311                         count++;
 312
 313         list = malloc(count * sizeof(device_t), M_TEMP, M_INTWAIT | M_ZERO);
 314         if (list == NULL)
 315                 return(ENOMEM);
 316
 317         count = 0;
 318         for (i = 0; i < dc->maxunit; i++)
 319                 if (dc->devices[i]) {
 320                         list[count] = dc->devices[i];
 321                         count++;
 322                 }
 323
 324         *devlistp = list;
 325         *devcountp = count;
 326
 327         return(0);
 328 }
 329
 330 int
 331 devclass_get_maxunit(devclass_t dc)
 332 {
 333         return(dc->maxunit);
 334 }
 335
 336 void
 337 devclass_set_parent(devclass_t dc, devclass_t pdc)
 338 {
 339         dc->parent = pdc;
 340 }
 341
 342 devclass_t
 343 devclass_get_parent(devclass_t dc)
 344 {
 345         return(dc->parent);
 346 }
 347
 348 static int
 349 devclass_alloc_unit(devclass_t dc, int *unitp)
 350 {
 351         int unit = *unitp;
 352
 353         PDEBUG(("unit %d in devclass %s", unit, DEVCLANAME(dc)));
 354
 355         /* If we have been given a wired unit number, check for existing device */
 356         if (unit != -1) {
 357                 if (unit >= 0 && unit < dc->maxunit &&
 358                     dc->devices[unit] != NULL) {
 359                         if (bootverbose)
 360                                 printf("%s-: %s%d exists, using next available unit number\n",
 361                                        dc->name, dc->name, unit);
 362                         /* find the next available slot */
 363                         while (++unit < dc->maxunit && dc->devices[unit] != NULL)
 364                                 ;
 365                 }
 366         } else {
 367                 /* Unwired device, find the next available slot for it */
 368                 unit = 0;
 369                 while (unit < dc->maxunit && dc->devices[unit] != NULL)
 370                         unit++;
 371         }
 372
 373         /*
 374          * We've selected a unit beyond the length of the table, so let's
 375          * extend the table to make room for all units up to and including
 376          * this one.
 377          */
 378         if (unit >= dc->maxunit) {
 379                 device_t *newlist;
 380                 int newsize;
 381
 382                 newsize = roundup((unit + 1), MINALLOCSIZE / sizeof(device_t));
 383                 newlist = malloc(sizeof(device_t) * newsize, M_BUS,
 384                                  M_INTWAIT | M_ZERO);
 385                 if (newlist == NULL)
 386                         return(ENOMEM);
 387                 bcopy(dc->devices, newlist, sizeof(device_t) * dc->maxunit);
 388                 if (dc->devices)
 389                         free(dc->devices, M_BUS);
 390                 dc->devices = newlist;
 391                 dc->maxunit = newsize;
 392         }
 393         PDEBUG(("now: unit %d in devclass %s", unit, DEVCLANAME(dc)));
 394
 395         *unitp = unit;
 396         return(0);
 397 }
 398
 399 static int
 400 devclass_add_device(devclass_t dc, device_t dev)
 401 {
 402         int buflen, error;
 403
 404         PDEBUG(("%s in devclass %s", DEVICENAME(dev), DEVCLANAME(dc)));
 405
 406         buflen = strlen(dc->name) + 5;
 407         dev->nameunit = malloc(buflen, M_BUS, M_INTWAIT | M_ZERO);
 408         if (!dev->nameunit)
 409                 return(ENOMEM);
 410
 411         if ((error = devclass_alloc_unit(dc, &dev->unit)) != 0) {
 412                 free(dev->nameunit, M_BUS);
 413                 dev->nameunit = NULL;
 414                 return(error);
 415         }
 416         dc->devices[dev->unit] = dev;
 417         dev->devclass = dc;
 418         snprintf(dev->nameunit, buflen, "%s%d", dc->name, dev->unit);
 419
 420 #ifdef DEVICE_SYSCTLS
 421         device_register_oids(dev);
 422 #endif
 423
 424         return(0);
 425 }
 426
 427 static int
 428 devclass_delete_device(devclass_t dc, device_t dev)
 429 {
 430         if (!dc || !dev)
 431                 return(0);
 432
 433         PDEBUG(("%s in devclass %s", DEVICENAME(dev), DEVCLANAME(dc)));
 434
 435         if (dev->devclass != dc || dc->devices[dev->unit] != dev)
 436                 panic("devclass_delete_device: inconsistent device class");
 437         dc->devices[dev->unit] = NULL;
 438         if (dev->flags & DF_WILDCARD)
 439                 dev->unit = -1;
 440         dev->devclass = NULL;
 441         free(dev->nameunit, M_BUS);
 442         dev->nameunit = NULL;
 443
 444 #ifdef DEVICE_SYSCTLS
 445         device_unregister_oids(dev);
 446 #endif
 447
 448         return(0);
 449 }
 450
 451 static device_t
 452 make_device(device_t parent, const char *name, int unit)
 453 {
 454         device_t dev;
 455         devclass_t dc;
 456
 457         PDEBUG(("%s at %s as unit %d", name, DEVICENAME(parent), unit));
 458
 459         if (name != NULL) {
 460                 dc = devclass_find_internal(name, NULL, TRUE);
 461                 if (!dc) {
 462                         printf("make_device: can't find device class %s\n", name);
 463                         return(NULL);
 464                 }
 465         } else
 466                 dc = NULL;
 467
 468         dev = malloc(sizeof(struct device), M_BUS, M_INTWAIT | M_ZERO);
 469         if (!dev)
 470                 return(0);
 471
 472         dev->parent = parent;
 473         TAILQ_INIT(&dev->children);
 474         kobj_init((kobj_t) dev, &null_class);
 475         dev->driver = NULL;
 476         dev->devclass = NULL;
 477         dev->unit = unit;
 478         dev->nameunit = NULL;
 479         dev->desc = NULL;
 480         dev->busy = 0;
 481         dev->devflags = 0;
 482         dev->flags = DF_ENABLED;
 483         dev->order = 0;
 484         if (unit == -1)
 485                 dev->flags |= DF_WILDCARD;
 486         if (name) {
 487                 dev->flags |= DF_FIXEDCLASS;
 488                 if (devclass_add_device(dc, dev) != 0) {
 489                         kobj_delete((kobj_t)dev, M_BUS);
 490                         return(NULL);
 491                 }
 492         }
 493         dev->ivars = NULL;
 494         dev->softc = NULL;
 495
 496         dev->state = DS_NOTPRESENT;
 497
 498         return(dev);
 499 }
 500
 501 static int
 502 device_print_child(device_t dev, device_t child)
 503 {
 504         int retval = 0;
 505
 506         if (device_is_alive(child))
 507                 retval += BUS_PRINT_CHILD(dev, child);
 508         else
 509                 retval += device_printf(child, " not found\n");
 510
 511         return(retval);
 512 }
 513
 514 device_t
 515 device_add_child(device_t dev, const char *name, int unit)
 516 {
 517         return device_add_child_ordered(dev, 0, name, unit);
 518 }
 519
 520 device_t
 521 device_add_child_ordered(device_t dev, int order, const char *name, int unit)
 522 {
 523         device_t child;
 524         device_t place;
 525
 526         PDEBUG(("%s at %s with order %d as unit %d", name, DEVICENAME(dev),
 527                 order, unit));
 528
 529         child = make_device(dev, name, unit);
 530         if (child == NULL)
 531                 return child;
 532         child->order = order;
 533
 534         TAILQ_FOREACH(place, &dev->children, link)
 535                 if (place->order > order)
 536                         break;
 537
 538         if (place) {
 539                 /*
 540                  * The device 'place' is the first device whose order is
 541                  * greater than the new child.
 542                  */
 543                 TAILQ_INSERT_BEFORE(place, child, link);
 544         } else {
 545                 /*
 546                  * The new child's order is greater or equal to the order of
 547                  * any existing device. Add the child to the tail of the list.
 548                  */
 549                 TAILQ_INSERT_TAIL(&dev->children, child, link);
 550         }
 551
 552         return(child);
 553 }
 554
 555 int
 556 device_delete_child(device_t dev, device_t child)
 557 {
 558         int error;
 559         device_t grandchild;
 560
 561         PDEBUG(("%s from %s", DEVICENAME(child), DEVICENAME(dev)));
 562
 563         /* remove children first */
 564         while ( (grandchild = TAILQ_FIRST(&child->children)) ) {
 565                 error = device_delete_child(child, grandchild);
 566                 if (error)
 567                         return(error);
 568         }
 569
 570         if ((error = device_detach(child)) != 0)
 571                 return(error);
 572         if (child->devclass)
 573                 devclass_delete_device(child->devclass, child);
 574         TAILQ_REMOVE(&dev->children, child, link);
 575         device_set_desc(child, NULL);
 576         kobj_delete((kobj_t)child, M_BUS);
 577
 578         return(0);
 579 }
 580
 581 /*
 582  * Find only devices attached to this bus.
 583  */
 584 device_t
 585 device_find_child(device_t dev, const char *classname, int unit)
 586 {
 587         devclass_t dc;
 588         device_t child;
 589
 590         dc = devclass_find(classname);
 591         if (!dc)
 592                 return(NULL);
 593
 594         child = devclass_get_device(dc, unit);
 595         if (child && child->parent == dev)
 596                 return(child);
 597         return(NULL);
 598 }
 599
 600 static driverlink_t
 601 first_matching_driver(devclass_t dc, device_t dev)
 602 {
 603         if (dev->devclass)
 604                 return(devclass_find_driver_internal(dc, dev->devclass->name));
 605         else
 606                 return(TAILQ_FIRST(&dc->drivers));
 607 }
 608
 609 static driverlink_t
 610 next_matching_driver(devclass_t dc, device_t dev, driverlink_t last)
 611 {
 612         if (dev->devclass) {
 613                 driverlink_t dl;
 614                 for (dl = TAILQ_NEXT(last, link); dl; dl = TAILQ_NEXT(dl, link))
 615                         if (!strcmp(dev->devclass->name, dl->driver->name))
 616                                 return(dl);
 617                 return(NULL);
 618         } else
 619                 return(TAILQ_NEXT(last, link));
 620 }
 621
 622 static int
 623 device_probe_child(device_t dev, device_t child)
 624 {
 625         devclass_t dc;
 626         driverlink_t best = 0;
 627         driverlink_t dl;
 628         int result, pri = 0;
 629         int hasclass = (child->devclass != 0);
 630
 631         dc = dev->devclass;
 632         if (!dc)
 633                 panic("device_probe_child: parent device has no devclass");
 634
 635         if (child->state == DS_ALIVE)
 636                 return(0);
 637
 638         for (; dc; dc = dc->parent) {
 639                 for (dl = first_matching_driver(dc, child); dl;
 640                      dl = next_matching_driver(dc, child, dl)) {
 641                         PDEBUG(("Trying %s", DRIVERNAME(dl->driver)));
 642                         device_set_driver(child, dl->driver);
 643                         if (!hasclass)
 644                                 device_set_devclass(child, dl->driver->name);
 645                         result = DEVICE_PROBE(child);
 646                         if (!hasclass)
 647                                 device_set_devclass(child, 0);
 648
 649                         /*
 650                          * If the driver returns SUCCESS, there can be
 651                          * no higher match for this device.
 652                          */
 653                         if (result == 0) {
 654                                 best = dl;
 655                                 pri = 0;
 656                                 break;
 657                         }
 658
 659                         /*
 660                          * The driver returned an error so it
 661                          * certainly doesn't match.
 662                          */
 663                         if (result > 0) {
 664                                 device_set_driver(child, 0);
 665                                 continue;
 666                         }
 667
 668                         /*
 669                          * A priority lower than SUCCESS, remember the
 670                          * best matching driver. Initialise the value
 671                          * of pri for the first match.
 672                          */
 673                         if (best == 0 || result > pri) {
 674                                 best = dl;
 675                                 pri = result;
 676                                 continue;
 677                         }
 678                 }
 679                 /*
 680                  * If we have unambiguous match in this devclass,
 681                  * don't look in the parent.
 682                  */
 683                 if (best && pri == 0)
 684                         break;
 685         }
 686
 687         /*
 688          * If we found a driver, change state and initialise the devclass.
 689          */
 690         if (best) {
 691                 if (!child->devclass)
 692                         device_set_devclass(child, best->driver->name);
 693                 device_set_driver(child, best->driver);
 694                 if (pri < 0) {
 695                         /*
 696                          * A bit bogus. Call the probe method again to make
 697                          * sure that we have the right description.
 698                          */
 699                         DEVICE_PROBE(child);
 700                 }
 701                 child->state = DS_ALIVE;
 702                 return(0);
 703         }
 704
 705         return(ENXIO);
 706 }
 707
 708 device_t
 709 device_get_parent(device_t dev)
 710 {
 711         return dev->parent;
 712 }
 713
 714 int
 715 device_get_children(device_t dev, device_t **devlistp, int *devcountp)
 716 {
 717         int count;
 718         device_t child;
 719         device_t *list;
 720
 721         count = 0;
 722         TAILQ_FOREACH(child, &dev->children, link)
 723                 count++;
 724
 725         list = malloc(count * sizeof(device_t), M_TEMP, M_INTWAIT | M_ZERO);
 726         if (!list)
 727                 return(ENOMEM);
 728
 729         count = 0;
 730         TAILQ_FOREACH(child, &dev->children, link) {
 731                 list[count] = child;
 732                 count++;
 733         }
 734
 735         *devlistp = list;
 736         *devcountp = count;
 737
 738         return(0);
 739 }
 740
 741 driver_t *
 742 device_get_driver(device_t dev)
 743 {
 744         return(dev->driver);
 745 }
 746
 747 devclass_t
 748 device_get_devclass(device_t dev)
 749 {
 750         return(dev->devclass);
 751 }
 752
 753 const char *
 754 device_get_name(device_t dev)
 755 {
 756         if (dev->devclass)
 757                 return devclass_get_name(dev->devclass);
 758         return(NULL);
 759 }
 760
 761 const char *
 762 device_get_nameunit(device_t dev)
 763 {
 764         return(dev->nameunit);
 765 }
 766
 767 int
 768 device_get_unit(device_t dev)
 769 {
 770         return(dev->unit);
 771 }
 772
 773 const char *
 774 device_get_desc(device_t dev)
 775 {
 776         return(dev->desc);
 777 }
 778
 779 uint32_t
 780 device_get_flags(device_t dev)
 781 {
 782         return(dev->devflags);
 783 }
 784
 785 int
 786 device_print_prettyname(device_t dev)
 787 {
 788         const char *name = device_get_name(dev);
 789
 790         if (name == 0)
 791                 return printf("unknown: ");
 792         else
 793                 return printf("%s%d: ", name, device_get_unit(dev));
 794 }
 795
 796 int
 797 device_printf(device_t dev, const char * fmt, ...)
 798 {
 799         __va_list ap;
 800         int retval;
 801
 802         retval = device_print_prettyname(dev);
 803         __va_start(ap, fmt);
 804         retval += vprintf(fmt, ap);
 805         __va_end(ap);
 806         return retval;
 807 }
 808
 809 static void
 810 device_set_desc_internal(device_t dev, const char* desc, int copy)
 811 {
 812         if (dev->desc && (dev->flags & DF_DESCMALLOCED)) {
 813                 free(dev->desc, M_BUS);
 814                 dev->flags &= ~DF_DESCMALLOCED;
 815                 dev->desc = NULL;
 816         }
 817
 818         if (copy && desc) {
 819                 dev->desc = malloc(strlen(desc) + 1, M_BUS, M_INTWAIT);
 820                 if (dev->desc) {
 821                         strcpy(dev->desc, desc);
 822                         dev->flags |= DF_DESCMALLOCED;
 823                 }
 824         } else
 825                 /* Avoid a -Wcast-qual warning */
 826                 dev->desc = (char *)(uintptr_t) desc;
 827
 828 #ifdef DEVICE_SYSCTLS
 829         {
 830                 struct sysctl_oid *oid = &dev->oid[1];
 831                 oid->oid_arg1 = dev->desc ? dev->desc : "";
 832                 oid->oid_arg2 = dev->desc ? strlen(dev->desc) : 0;
 833         }
 834 #endif
 835 }
 836
 837 void
 838 device_set_desc(device_t dev, const char* desc)
 839 {
 840         device_set_desc_internal(dev, desc, FALSE);
 841 }
 842
 843 void
 844 device_set_desc_copy(device_t dev, const char* desc)
 845 {
 846         device_set_desc_internal(dev, desc, TRUE);
 847 }
 848
 849 void
 850 device_set_flags(device_t dev, uint32_t flags)
 851 {
 852         dev->devflags = flags;
 853 }
 854
 855 void *
 856 device_get_softc(device_t dev)
 857 {
 858         return dev->softc;
 859 }
 860
 861 void
 862 device_set_softc(device_t dev, void *softc)
 863 {
 864         if (dev->softc && !(dev->flags & DF_EXTERNALSOFTC))
 865                 free(dev->softc, M_BUS);
 866         dev->softc = softc;
 867         if (dev->softc)
 868                 dev->flags |= DF_EXTERNALSOFTC;
 869         else
 870                 dev->flags &= ~DF_EXTERNALSOFTC;
 871 }
 872
 873 void *
 874 device_get_ivars(device_t dev)
 875 {
 876         return dev->ivars;
 877 }
 878
 879 void
 880 device_set_ivars(device_t dev, void * ivars)
 881 {
 882         if (!dev)
 883                 return;
 884
 885         dev->ivars = ivars;
 886 }
 887
 888 device_state_t
 889 device_get_state(device_t dev)
 890 {
 891         return(dev->state);
 892 }
 893
 894 void
 895 device_enable(device_t dev)
 896 {
 897         dev->flags |= DF_ENABLED;
 898 }
 899
 900 void
 901 device_disable(device_t dev)
 902 {
 903         dev->flags &= ~DF_ENABLED;
 904 }
 905
 906 /*
 907  * YYY cannot block
 908  */
 909 void
 910 device_busy(device_t dev)
 911 {
 912         if (dev->state < DS_ATTACHED)
 913                 panic("device_busy: called for unattached device");
 914         if (dev->busy == 0 && dev->parent)
 915                 device_busy(dev->parent);
 916         dev->busy++;
 917         dev->state = DS_BUSY;
 918 }
 919
 920 /*
 921  * YYY cannot block
 922  */
 923 void
 924 device_unbusy(device_t dev)
 925 {
 926         if (dev->state != DS_BUSY)
 927                 panic("device_unbusy: called for non-busy device");
 928         dev->busy--;
 929         if (dev->busy == 0) {
 930                 if (dev->parent)
 931                         device_unbusy(dev->parent);
 932                 dev->state = DS_ATTACHED;
 933         }
 934 }
 935
 936 void
 937 device_quiet(device_t dev)
 938 {
 939         dev->flags |= DF_QUIET;
 940 }
 941
 942 void
 943 device_verbose(device_t dev)
 944 {
 945         dev->flags &= ~DF_QUIET;
 946 }
 947
 948 int
 949 device_is_quiet(device_t dev)
 950 {
 951         return((dev->flags & DF_QUIET) != 0);
 952 }
 953
 954 int
 955 device_is_enabled(device_t dev)
 956 {
 957         return((dev->flags & DF_ENABLED) != 0);
 958 }
 959
 960 int
 961 device_is_alive(device_t dev)
 962 {
 963         return(dev->state >= DS_ALIVE);
 964 }
 965
 966 int
 967 device_is_attached(device_t dev)
 968 {
 969         return(dev->state >= DS_ATTACHED);
 970 }
 971
 972 int
 973 device_set_devclass(device_t dev, const char *classname)
 974 {
 975         devclass_t dc;
 976
 977         if (!classname) {
 978                 if (dev->devclass)
 979                         devclass_delete_device(dev->devclass, dev);
 980                 return(0);
 981         }
 982
 983         if (dev->devclass) {
 984                 printf("device_set_devclass: device class already set\n");
 985                 return(EINVAL);
 986         }
 987
 988         dc = devclass_find_internal(classname, NULL, TRUE);
 989         if (!dc)
 990                 return(ENOMEM);
 991
 992         return(devclass_add_device(dc, dev));
 993 }
 994
 995 int
 996 device_set_driver(device_t dev, driver_t *driver)
 997 {
 998         if (dev->state >= DS_ATTACHED)
 999                 return(EBUSY);
1000
1001         if (dev->driver == driver)
1002                 return(0);
1003
1004         if (dev->softc && !(dev->flags & DF_EXTERNALSOFTC)) {
1005                 free(dev->softc, M_BUS);
1006                 dev->softc = NULL;
1007         }
1008         kobj_delete((kobj_t) dev, 0);
1009         dev->driver = driver;
1010         if (driver) {
1011                 kobj_init((kobj_t) dev, (kobj_class_t) driver);
1012                 if (!(dev->flags & DF_EXTERNALSOFTC)) {
1013                         dev->softc = malloc(driver->size, M_BUS,
1014                                             M_INTWAIT | M_ZERO);
1015                         if (!dev->softc) {
1016                                 kobj_delete((kobj_t)dev, 0);
1017                                 kobj_init((kobj_t) dev, &null_class);
1018                                 dev->driver = NULL;
1019                                 return(ENOMEM);
1020                         }
1021                 }
1022         } else
1023                 kobj_init((kobj_t) dev, &null_class);
1024         return(0);
1025 }
1026
1027 int
1028 device_probe_and_attach(device_t dev)
1029 {
1030         device_t bus = dev->parent;
1031         int error = 0;
1032         int hasclass = (dev->devclass != 0);
1033
1034         if (dev->state >= DS_ALIVE)
1035                 return(0);
1036
1037         if ((dev->flags & DF_ENABLED) == 0) {
1038                 if (bootverbose) {
1039                         device_print_prettyname(dev);
1040                         printf("not probed (disabled)\n");
1041                 }
1042                 return(0);
1043         }
1044
1045         error = device_probe_child(bus, dev);
1046         if (error) {
1047                 if (!(dev->flags & DF_DONENOMATCH)) {
1048                         BUS_PROBE_NOMATCH(bus, dev);
1049                         dev->flags |= DF_DONENOMATCH;
1050                 }
1051                 return(error);
1052         }
1053
1054         if (!device_is_quiet(dev))
1055                 device_print_child(bus, dev);
1056         error = DEVICE_ATTACH(dev);
1057         if (!error)
1058                 dev->state = DS_ATTACHED;
1059         else {
1060                 printf("device_probe_and_attach: %s%d attach returned %d\n",
1061                        dev->driver->name, dev->unit, error);
1062                 /* Unset the class that was set in device_probe_child */
1063                 if (!hasclass)
1064                         device_set_devclass(dev, 0);
1065                 device_set_driver(dev, NULL);
1066                 dev->state = DS_NOTPRESENT;
1067         }
1068
1069         return(error);
1070 }
1071
1072 int
1073 device_detach(device_t dev)
1074 {
1075         int error;
1076
1077         PDEBUG(("%s", DEVICENAME(dev)));
1078         if (dev->state == DS_BUSY)
1079                 return(EBUSY);
1080         if (dev->state != DS_ATTACHED)
1081                 return(0);
1082
1083         if ((error = DEVICE_DETACH(dev)) != 0)
1084                 return(error);
1085         device_printf(dev, "detached\n");
1086         if (dev->parent)
1087                 BUS_CHILD_DETACHED(dev->parent, dev);
1088
1089         if (!(dev->flags & DF_FIXEDCLASS))
1090                 devclass_delete_device(dev->devclass, dev);
1091
1092         dev->state = DS_NOTPRESENT;
1093         device_set_driver(dev, NULL);
1094
1095         return(0);
1096 }
1097
1098 int
1099 device_shutdown(device_t dev)
1100 {
1101         if (dev->state < DS_ATTACHED)
1102                 return 0;
1103         return DEVICE_SHUTDOWN(dev);
1104 }
1105
1106 int
1107 device_set_unit(device_t dev, int unit)
1108 {
1109         devclass_t dc;
1110         int err;
1111
1112         dc = device_get_devclass(dev);
1113         if (unit < dc->maxunit && dc->devices[unit])
1114                 return(EBUSY);
1115         err = devclass_delete_device(dc, dev);
1116         if (err)
1117                 return(err);
1118         dev->unit = unit;
1119         err = devclass_add_device(dc, dev);
1120         return(err);
1121 }
1122
1123 #ifdef DEVICE_SYSCTLS
1124
1125 /*
1126  * Sysctl nodes for devices.
1127  */
1128
1129 SYSCTL_NODE(_hw, OID_AUTO, devices, CTLFLAG_RW, 0, "A list of all devices");
1130
1131 static int
1132 sysctl_handle_children(SYSCTL_HANDLER_ARGS)
1133 {
1134         device_t dev = arg1;
1135         device_t child;
1136         int first = 1, error = 0;
1137
1138         TAILQ_FOREACH(child, &dev->children, link)
1139                 if (child->nameunit) {
1140                         if (!first) {
1141                                 error = SYSCTL_OUT(req, ",", 1);
1142                                 if (error)
1143                                         return error;
1144                         } else
1145                                 first = 0;
1146                         error = SYSCTL_OUT(req, child->nameunit,
1147                                            strlen(child->nameunit));
1148                         if (error)
1149                                 return(error);
1150                 }
1151
1152         error = SYSCTL_OUT(req, "", 1);
1153
1154         return(error);
1155 }
1156
1157 static int
1158 sysctl_handle_state(SYSCTL_HANDLER_ARGS)
1159 {
1160         device_t dev = arg1;
1161
1162         switch (dev->state) {
1163         case DS_NOTPRESENT:
1164                 return SYSCTL_OUT(req, "notpresent", sizeof("notpresent"));
1165         case DS_ALIVE:
1166                 return SYSCTL_OUT(req, "alive", sizeof("alive"));
1167         case DS_ATTACHED:
1168                 return SYSCTL_OUT(req, "attached", sizeof("attached"));
1169         case DS_BUSY:
1170                 return SYSCTL_OUT(req, "busy", sizeof("busy"));
1171         default:
1172                 return (0);
1173         }
1174 }
1175
1176 static void
1177 device_register_oids(device_t dev)
1178 {
1179         struct sysctl_oid* oid;
1180
1181         oid = &dev->oid[0];
1182         bzero(oid, sizeof(*oid));
1183         oid->oid_parent = &sysctl__hw_devices_children;
1184         oid->oid_number = OID_AUTO;
1185         oid->oid_kind = CTLTYPE_NODE | CTLFLAG_RW;
1186         oid->oid_arg1 = &dev->oidlist[0];
1187         oid->oid_arg2 = 0;
1188         oid->oid_name = dev->nameunit;
1189         oid->oid_handler = 0;
1190         oid->oid_fmt = "N";
1191         SLIST_INIT(&dev->oidlist[0]);
1192         sysctl_register_oid(oid);
1193
1194         oid = &dev->oid[1];
1195         bzero(oid, sizeof(*oid));
1196         oid->oid_parent = &dev->oidlist[0];
1197         oid->oid_number = OID_AUTO;
1198         oid->oid_kind = CTLTYPE_STRING | CTLFLAG_RD;
1199         oid->oid_arg1 = dev->desc ? dev->desc : "";
1200         oid->oid_arg2 = dev->desc ? strlen(dev->desc) : 0;
1201         oid->oid_name = "desc";
1202         oid->oid_handler = sysctl_handle_string;
1203         oid->oid_fmt = "A";
1204         sysctl_register_oid(oid);
1205
1206         oid = &dev->oid[2];
1207         bzero(oid, sizeof(*oid));
1208         oid->oid_parent = &dev->oidlist[0];
1209         oid->oid_number = OID_AUTO;
1210         oid->oid_kind = CTLTYPE_INT | CTLFLAG_RD;
1211         oid->oid_arg1 = dev;
1212         oid->oid_arg2 = 0;
1213         oid->oid_name = "children";
1214         oid->oid_handler = sysctl_handle_children;
1215         oid->oid_fmt = "A";
1216         sysctl_register_oid(oid);
1217
1218         oid = &dev->oid[3];
1219         bzero(oid, sizeof(*oid));
1220         oid->oid_parent = &dev->oidlist[0];
1221         oid->oid_number = OID_AUTO;
1222         oid->oid_kind = CTLTYPE_INT | CTLFLAG_RD;
1223         oid->oid_arg1 = dev;
1224         oid->oid_arg2 = 0;
1225         oid->oid_name = "state";
1226         oid->oid_handler = sysctl_handle_state;
1227         oid->oid_fmt = "A";
1228         sysctl_register_oid(oid);
1229 }
1230
1231 static void
1232 device_unregister_oids(device_t dev)
1233 {
1234         sysctl_unregister_oid(&dev->oid[0]);
1235         sysctl_unregister_oid(&dev->oid[1]);
1236         sysctl_unregister_oid(&dev->oid[2]);
1237 }
1238
1239 #endif
1240
1241 /*======================================*/
1242 /*
1243  * Access functions for device resources.
1244  */
1245
1246 /* Supplied by config(8) in ioconf.c */
1247 extern struct config_device config_devtab[];
1248 extern int devtab_count;
1249
1250 /* Runtime version */
1251 struct config_device *devtab = config_devtab;
1252
1253 static int
1254 resource_new_name(const char *name, int unit)
1255 {
1256         struct config_device *new;
1257
1258         new = malloc((devtab_count + 1) * sizeof(*new), M_TEMP,
1259                      M_INTWAIT | M_ZERO);
1260         if (new == NULL)
1261                 return(-1);
1262         if (devtab && devtab_count > 0)
1263                 bcopy(devtab, new, devtab_count * sizeof(*new));
1264         new[devtab_count].name = malloc(strlen(name) + 1, M_TEMP, M_INTWAIT);
1265         if (new[devtab_count].name == NULL) {
1266                 free(new, M_TEMP);
1267                 return(-1);
1268         }
1269         strcpy(new[devtab_count].name, name);
1270         new[devtab_count].unit = unit;
1271         new[devtab_count].resource_count = 0;
1272         new[devtab_count].resources = NULL;
1273         devtab = new;
1274         return devtab_count++;
1275 }
1276
1277 static int
1278 resource_new_resname(int j, const char *resname, resource_type type)
1279 {
1280         struct config_resource *new;
1281         int i;
1282
1283         i = devtab[j].resource_count;
1284         new = malloc((i + 1) * sizeof(*new), M_TEMP, M_INTWAIT | M_ZERO);
1285         if (new == NULL)
1286                 return(-1);
1287         if (devtab[j].resources && i > 0)
1288                 bcopy(devtab[j].resources, new, i * sizeof(*new));
1289         new[i].name = malloc(strlen(resname) + 1, M_TEMP, M_INTWAIT);
1290         if (new[i].name == NULL) {
1291                 free(new, M_TEMP);
1292                 return(-1);
1293         }
1294         strcpy(new[i].name, resname);
1295         new[i].type = type;
1296         if (devtab[j].resources)
1297                 free(devtab[j].resources, M_TEMP);
1298         devtab[j].resources = new;
1299         devtab[j].resource_count = i + 1;
1300         return(i);
1301 }
1302
1303 static int
1304 resource_match_string(int i, const char *resname, const char *value)
1305 {
1306         int j;
1307         struct config_resource *res;
1308
1309         for (j = 0, res = devtab[i].resources;
1310              j < devtab[i].resource_count; j++, res++)
1311                 if (!strcmp(res->name, resname)
1312                     && res->type == RES_STRING
1313                     && !strcmp(res->u.stringval, value))
1314                         return(j);
1315         return(-1);
1316 }
1317
1318 static int
1319 resource_find(const char *name, int unit, const char *resname,
1320               struct config_resource **result)
1321 {
1322         int i, j;
1323         struct config_resource *res;
1324
1325         /*
1326          * First check specific instances, then generic.
1327          */
1328         for (i = 0; i < devtab_count; i++) {
1329                 if (devtab[i].unit < 0)
1330                         continue;
1331                 if (!strcmp(devtab[i].name, name) && devtab[i].unit == unit) {
1332                         res = devtab[i].resources;
1333                         for (j = 0; j < devtab[i].resource_count; j++, res++)
1334                                 if (!strcmp(res->name, resname)) {
1335                                         *result = res;
1336                                         return(0);
1337                                 }
1338                 }
1339         }
1340         for (i = 0; i < devtab_count; i++) {
1341                 if (devtab[i].unit >= 0)
1342                         continue;
1343                 /* XXX should this `&& devtab[i].unit == unit' be here? */
1344                 /* XXX if so, then the generic match does nothing */
1345                 if (!strcmp(devtab[i].name, name) && devtab[i].unit == unit) {
1346                         res = devtab[i].resources;
1347                         for (j = 0; j < devtab[i].resource_count; j++, res++)
1348                                 if (!strcmp(res->name, resname)) {
1349                                         *result = res;
1350                                         return(0);
1351                                 }
1352                 }
1353         }
1354         return(ENOENT);
1355 }
1356
1357 int
1358 resource_int_value(const char *name, int unit, const char *resname, int *result)
1359 {
1360         int error;
1361         struct config_resource *res;
1362
1363         if ((error = resource_find(name, unit, resname, &res)) != 0)
1364                 return(error);
1365         if (res->type != RES_INT)
1366                 return(EFTYPE);
1367         *result = res->u.intval;
1368         return(0);
1369 }
1370
1371 int
1372 resource_long_value(const char *name, int unit, const char *resname,
1373                     long *result)
1374 {
1375         int error;
1376         struct config_resource *res;
1377
1378         if ((error = resource_find(name, unit, resname, &res)) != 0)
1379                 return(error);
1380         if (res->type != RES_LONG)
1381                 return(EFTYPE);
1382         *result = res->u.longval;
1383         return(0);
1384 }
1385
1386 int
1387 resource_string_value(const char *name, int unit, const char *resname,
1388                       char **result)
1389 {
1390         int error;
1391         struct config_resource *res;
1392
1393         if ((error = resource_find(name, unit, resname, &res)) != 0)
1394                 return(error);
1395         if (res->type != RES_STRING)
1396                 return(EFTYPE);
1397         *result = res->u.stringval;
1398         return(0);
1399 }
1400
1401 int
1402 resource_query_string(int i, const char *resname, const char *value)
1403 {
1404         if (i < 0)
1405                 i = 0;
1406         else
1407                 i = i + 1;
1408         for (; i < devtab_count; i++)
1409                 if (resource_match_string(i, resname, value) >= 0)
1410                         return(i);
1411         return(-1);
1412 }
1413
1414 int
1415 resource_locate(int i, const char *resname)
1416 {
1417         if (i < 0)
1418                 i = 0;
1419         else
1420                 i = i + 1;
1421         for (; i < devtab_count; i++)
1422                 if (!strcmp(devtab[i].name, resname))
1423                         return(i);
1424         return(-1);
1425 }
1426
1427 int
1428 resource_count(void)
1429 {
1430         return(devtab_count);
1431 }
1432
1433 char *
1434 resource_query_name(int i)
1435 {
1436         return(devtab[i].name);
1437 }
1438
1439 int
1440 resource_query_unit(int i)
1441 {
1442         return(devtab[i].unit);
1443 }
1444
1445 static int
1446 resource_create(const char *name, int unit, const char *resname,
1447                 resource_type type, struct config_resource **result)
1448 {
1449         int i, j;
1450         struct config_resource *res = NULL;
1451
1452         for (i = 0; i < devtab_count; i++)
1453                 if (!strcmp(devtab[i].name, name) && devtab[i].unit == unit) {
1454                         res = devtab[i].resources;
1455                         break;
1456                 }
1457         if (res == NULL) {
1458                 i = resource_new_name(name, unit);
1459                 if (i < 0)
1460                         return(ENOMEM);
1461                 res = devtab[i].resources;
1462         }
1463         for (j = 0; j < devtab[i].resource_count; j++, res++)
1464                 if (!strcmp(res->name, resname)) {
1465                         *result = res;
1466                         return(0);
1467                 }
1468         j = resource_new_resname(i, resname, type);
1469         if (j < 0)
1470                 return(ENOMEM);
1471         res = &devtab[i].resources[j];
1472         *result = res;
1473         return(0);
1474 }
1475
1476 int
1477 resource_set_int(const char *name, int unit, const char *resname, int value)
1478 {
1479         int error;
1480         struct config_resource *res;
1481
1482         error = resource_create(name, unit, resname, RES_INT, &res);
1483         if (error)
1484                 return(error);
1485         if (res->type != RES_INT)
1486                 return(EFTYPE);
1487         res->u.intval = value;
1488         return(0);
1489 }
1490
1491 int
1492 resource_set_long(const char *name, int unit, const char *resname, long value)
1493 {
1494         int error;
1495         struct config_resource *res;
1496
1497         error = resource_create(name, unit, resname, RES_LONG, &res);
1498         if (error)
1499                 return(error);
1500         if (res->type != RES_LONG)
1501                 return(EFTYPE);
1502         res->u.longval = value;
1503         return(0);
1504 }
1505
1506 int
1507 resource_set_string(const char *name, int unit, const char *resname,
1508                     const char *value)
1509 {
1510         int error;
1511         struct config_resource *res;
1512
1513         error = resource_create(name, unit, resname, RES_STRING, &res);
1514         if (error)
1515                 return(error);
1516         if (res->type != RES_STRING)
1517                 return(EFTYPE);
1518         if (res->u.stringval)
1519                 free(res->u.stringval, M_TEMP);
1520         res->u.stringval = malloc(strlen(value) + 1, M_TEMP, M_INTWAIT);
1521         if (res->u.stringval == NULL)
1522                 return(ENOMEM);
1523         strcpy(res->u.stringval, value);
1524         return(0);
1525 }
1526
1527 static void
1528 resource_cfgload(void *dummy __unused)
1529 {
1530         struct config_resource *res, *cfgres;
1531         int i, j;
1532         int error;
1533         char *name, *resname;
1534         int unit;
1535         resource_type type;
1536         char *stringval;
1537         int config_devtab_count;
1538
1539         config_devtab_count = devtab_count;
1540         devtab = NULL;
1541         devtab_count = 0;
1542
1543         for (i = 0; i < config_devtab_count; i++) {
1544                 name = config_devtab[i].name;
1545                 unit = config_devtab[i].unit;
1546
1547                 for (j = 0; j < config_devtab[i].resource_count; j++) {
1548                         cfgres = config_devtab[i].resources;
1549                         resname = cfgres[j].name;
1550                         type = cfgres[j].type;
1551                         error = resource_create(name, unit, resname, type,
1552                                                 &res);
1553                         if (error) {
1554                                 printf("create resource %s%d: error %d\n",
1555                                         name, unit, error);
1556                                 continue;
1557                         }
1558                         if (res->type != type) {
1559                                 printf("type mismatch %s%d: %d != %d\n",
1560                                         name, unit, res->type, type);
1561                                 continue;
1562                         }
1563                         switch (type) {
1564                         case RES_INT:
1565                                 res->u.intval = cfgres[j].u.intval;
1566                                 break;
1567                         case RES_LONG:
1568                                 res->u.longval = cfgres[j].u.longval;
1569                                 break;
1570                         case RES_STRING:
1571                                 if (res->u.stringval)
1572                                         free(res->u.stringval, M_TEMP);
1573                                 stringval = cfgres[j].u.stringval;
1574                                 res->u.stringval = malloc(strlen(stringval) + 1,
1575                                                           M_TEMP, M_INTWAIT);
1576                                 if (res->u.stringval == NULL)
1577                                         break;
1578                                 strcpy(res->u.stringval, stringval);
1579                                 break;
1580                         default:
1581                                 panic("unknown resource type %d", type);
1582                         }
1583                 }
1584         }
1585 }
1586 SYSINIT(cfgload, SI_SUB_KMEM, SI_ORDER_ANY + 50, resource_cfgload, 0)
1587
1588
1589 /*======================================*/
1590 /*
1591  * Some useful method implementations to make life easier for bus drivers.
1592  */
1593
1594 void
1595 resource_list_init(struct resource_list *rl)
1596 {
1597         SLIST_INIT(rl);
1598 }
1599
1600 void
1601 resource_list_free(struct resource_list *rl)
1602 {
1603         struct resource_list_entry *rle;
1604
1605         while ((rle = SLIST_FIRST(rl)) != NULL) {
1606                 if (rle->res)
1607                         panic("resource_list_free: resource entry is busy");
1608                 SLIST_REMOVE_HEAD(rl, link);
1609                 free(rle, M_BUS);
1610         }
1611 }
1612
1613 void
1614 resource_list_add(struct resource_list *rl,
1615                   int type, int rid,
1616                   u_long start, u_long end, u_long count)
1617 {
1618         struct resource_list_entry *rle;
1619
1620         rle = resource_list_find(rl, type, rid);
1621         if (rle == NULL) {
1622                 rle = malloc(sizeof(struct resource_list_entry), M_BUS,
1623                              M_INTWAIT);
1624                 if (!rle)
1625                         panic("resource_list_add: can't record entry");
1626                 SLIST_INSERT_HEAD(rl, rle, link);
1627                 rle->type = type;
1628                 rle->rid = rid;
1629                 rle->res = NULL;
1630         }
1631
1632         if (rle->res)
1633                 panic("resource_list_add: resource entry is busy");
1634
1635         rle->start = start;
1636         rle->end = end;
1637         rle->count = count;
1638 }
1639
1640 struct resource_list_entry*
1641 resource_list_find(struct resource_list *rl,
1642                    int type, int rid)
1643 {
1644         struct resource_list_entry *rle;
1645
1646         SLIST_FOREACH(rle, rl, link)
1647                 if (rle->type == type && rle->rid == rid)
1648                         return(rle);
1649         return(NULL);
1650 }
1651
1652 void
1653 resource_list_delete(struct resource_list *rl,
1654                      int type, int rid)
1655 {
1656         struct resource_list_entry *rle = resource_list_find(rl, type, rid);
1657
1658         if (rle) {
1659                 SLIST_REMOVE(rl, rle, resource_list_entry, link);
1660                 free(rle, M_BUS);
1661         }
1662 }
1663
1664 struct resource *
1665 resource_list_alloc(struct resource_list *rl,
1666                     device_t bus, device_t child,
1667                     int type, int *rid,
1668                     u_long start, u_long end,
1669                     u_long count, u_int flags)
1670 {
1671         struct resource_list_entry *rle = 0;
1672         int passthrough = (device_get_parent(child) != bus);
1673         int isdefault = (start == 0UL && end == ~0UL);
1674
1675         if (passthrough) {
1676                 return(BUS_ALLOC_RESOURCE(device_get_parent(bus), child,
1677                                           type, rid,
1678                                           start, end, count, flags));
1679         }
1680
1681         rle = resource_list_find(rl, type, *rid);
1682
1683         if (!rle)
1684                 return(0);              /* no resource of that type/rid */
1685         if (rle->res)
1686                 panic("resource_list_alloc: resource entry is busy");
1687
1688         if (isdefault) {
1689                 start = rle->start;
1690                 count = max(count, rle->count);
1691                 end = max(rle->end, start + count - 1);
1692         }
1693
1694         rle->res = BUS_ALLOC_RESOURCE(device_get_parent(bus), child,
1695                                       type, rid, start, end, count, flags);
1696
1697         /*
1698          * Record the new range.
1699          */
1700         if (rle->res) {
1701                 rle->start = rman_get_start(rle->res);
1702                 rle->end = rman_get_end(rle->res);
1703                 rle->count = count;
1704         }
1705
1706         return(rle->res);
1707 }
1708
1709 int
1710 resource_list_release(struct resource_list *rl,
1711                       device_t bus, device_t child,
1712                       int type, int rid, struct resource *res)
1713 {
1714         struct resource_list_entry *rle = 0;
1715         int passthrough = (device_get_parent(child) != bus);
1716         int error;
1717
1718         if (passthrough) {
1719                 return(BUS_RELEASE_RESOURCE(device_get_parent(bus), child,
1720                                             type, rid, res));
1721         }
1722
1723         rle = resource_list_find(rl, type, rid);
1724
1725         if (!rle)
1726                 panic("resource_list_release: can't find resource");
1727         if (!rle->res)
1728                 panic("resource_list_release: resource entry is not busy");
1729
1730         error = BUS_RELEASE_RESOURCE(device_get_parent(bus), child,
1731                                      type, rid, res);
1732         if (error)
1733                 return(error);
1734
1735         rle->res = NULL;
1736         return(0);
1737 }
1738
1739 int
1740 resource_list_print_type(struct resource_list *rl, const char *name, int type,
1741                          const char *format)
1742 {
1743         struct resource_list_entry *rle;
1744         int printed, retval;
1745
1746         printed = 0;
1747         retval = 0;
1748         /* Yes, this is kinda cheating */
1749         SLIST_FOREACH(rle, rl, link) {
1750                 if (rle->type == type) {
1751                         if (printed == 0)
1752                                 retval += printf(" %s ", name);
1753                         else
1754                                 retval += printf(",");
1755                         printed++;
1756                         retval += printf(format, rle->start);
1757                         if (rle->count > 1) {
1758                                 retval += printf("-");
1759                                 retval += printf(format, rle->start +
1760                                                  rle->count - 1);
1761                         }
1762                 }
1763         }
1764         return(retval);
1765 }
1766
1767 /*
1768  * Call DEVICE_IDENTIFY for each driver.
1769  */
1770 int
1771 bus_generic_probe(device_t dev)
1772 {
1773         devclass_t dc = dev->devclass;
1774         driverlink_t dl;
1775
1776         TAILQ_FOREACH(dl, &dc->drivers, link)
1777                 DEVICE_IDENTIFY(dl->driver, dev);
1778
1779         return(0);
1780 }
1781
1782 int
1783 bus_generic_attach(device_t dev)
1784 {
1785         device_t child;
1786
1787         TAILQ_FOREACH(child, &dev->children, link)
1788                 device_probe_and_attach(child);
1789
1790         return(0);
1791 }
1792
1793 int
1794 bus_generic_detach(device_t dev)
1795 {
1796         device_t child;
1797         int error;
1798
1799         if (dev->state != DS_ATTACHED)
1800                 return(EBUSY);
1801
1802         TAILQ_FOREACH(child, &dev->children, link)
1803                 if ((error = device_detach(child)) != 0)
1804                         return(error);
1805
1806         return 0;
1807 }
1808
1809 int
1810 bus_generic_shutdown(device_t dev)
1811 {
1812         device_t child;
1813
1814         TAILQ_FOREACH(child, &dev->children, link)
1815                 device_shutdown(child);
1816
1817         return(0);
1818 }
1819
1820 int
1821 bus_generic_suspend(device_t dev)
1822 {
1823         int error;
1824         device_t child, child2;
1825
1826         TAILQ_FOREACH(child, &dev->children, link) {
1827                 error = DEVICE_SUSPEND(child);
1828                 if (error) {
1829                         for (child2 = TAILQ_FIRST(&dev->children);
1830                              child2 && child2 != child;
1831                              child2 = TAILQ_NEXT(child2, link))
1832                                 DEVICE_RESUME(child2);
1833                         return(error);
1834                 }
1835         }
1836         return(0);
1837 }
1838
1839 int
1840 bus_generic_resume(device_t dev)
1841 {
1842         device_t child;
1843
1844         TAILQ_FOREACH(child, &dev->children, link)
1845                 DEVICE_RESUME(child);
1846                 /* if resume fails, there's nothing we can usefully do... */
1847
1848         return(0);
1849 }
1850
1851 int
1852 bus_print_child_header(device_t dev, device_t child)
1853 {
1854         int retval = 0;
1855
1856         if (device_get_desc(child))
1857                 retval += device_printf(child, "<%s>", device_get_desc(child));
1858         else
1859                 retval += printf("%s", device_get_nameunit(child));
1860
1861         return(retval);
1862 }
1863
1864 int
1865 bus_print_child_footer(device_t dev, device_t child)
1866 {
1867         return(printf(" on %s\n", device_get_nameunit(dev)));
1868 }
1869
1870 int
1871 bus_generic_print_child(device_t dev, device_t child)
1872 {
1873         int retval = 0;
1874
1875         retval += bus_print_child_header(dev, child);
1876         retval += bus_print_child_footer(dev, child);
1877
1878         return(retval);
1879 }
1880
1881 int
1882 bus_generic_read_ivar(device_t dev, device_t child, int index,
1883                       uintptr_t * result)
1884 {
1885     return(ENOENT);
1886 }
1887
1888 int
1889 bus_generic_write_ivar(device_t dev, device_t child, int index,
1890                        uintptr_t value)
1891 {
1892     return(ENOENT);
1893 }
1894
1895 struct resource_list *
1896 bus_generic_get_resource_list(device_t dev, device_t child)
1897 {
1898     return(NULL);
1899 }
1900
1901 void
1902 bus_generic_driver_added(device_t dev, driver_t *driver)
1903 {
1904         device_t child;
1905
1906         DEVICE_IDENTIFY(driver, dev);
1907         TAILQ_FOREACH(child, &dev->children, link)
1908                 if (child->state == DS_NOTPRESENT)
1909                         device_probe_and_attach(child);
1910 }
1911
1912 int
1913 bus_generic_setup_intr(device_t dev, device_t child, struct resource *irq,
1914                        int flags, driver_intr_t *intr, void *arg,
1915                        void **cookiep)
1916 {
1917         /* Propagate up the bus hierarchy until someone handles it. */
1918         if (dev->parent)
1919                 return(BUS_SETUP_INTR(dev->parent, child, irq, flags,
1920                                       intr, arg, cookiep));
1921         else
1922                 return(EINVAL);
1923 }
1924
1925 int
1926 bus_generic_teardown_intr(device_t dev, device_t child, struct resource *irq,
1927                           void *cookie)
1928 {
1929         /* Propagate up the bus hierarchy until someone handles it. */
1930         if (dev->parent)
1931                 return(BUS_TEARDOWN_INTR(dev->parent, child, irq, cookie));
1932         else
1933                 return(EINVAL);
1934 }
1935
1936 struct resource *
1937 bus_generic_alloc_resource(device_t dev, device_t child, int type, int *rid,
1938                            u_long start, u_long end, u_long count, u_int flags)
1939 {
1940         /* Propagate up the bus hierarchy until someone handles it. */
1941         if (dev->parent)
1942                 return(BUS_ALLOC_RESOURCE(dev->parent, child, type, rid,
1943                                            start, end, count, flags));
1944         else
1945                 return(NULL);
1946 }
1947
1948 int
1949 bus_generic_release_resource(device_t dev, device_t child, int type, int rid,
1950                              struct resource *r)
1951 {
1952         /* Propagate up the bus hierarchy until someone handles it. */
1953         if (dev->parent)
1954                 return(BUS_RELEASE_RESOURCE(dev->parent, child, type, rid, r));
1955         else
1956                 return(EINVAL);
1957 }
1958
1959 int
1960 bus_generic_activate_resource(device_t dev, device_t child, int type, int rid,
1961                               struct resource *r)
1962 {
1963         /* Propagate up the bus hierarchy until someone handles it. */
1964         if (dev->parent)
1965                 return(BUS_ACTIVATE_RESOURCE(dev->parent, child, type, rid, r));
1966         else
1967                 return(EINVAL);
1968 }
1969
1970 int
1971 bus_generic_deactivate_resource(device_t dev, device_t child, int type,
1972                                 int rid, struct resource *r)
1973 {
1974         /* Propagate up the bus hierarchy until someone handles it. */
1975         if (dev->parent)
1976                 return(BUS_DEACTIVATE_RESOURCE(dev->parent, child, type, rid,
1977                                                r));
1978         else
1979                 return(EINVAL);
1980 }
1981
1982 int
1983 bus_generic_config_intr(device_t dev, int irq, enum intr_trigger trig,
1984     enum intr_polarity pol)
1985 {
1986         /* Propagate up the bus hierarchy until someone handles it. */
1987         if (dev->parent)
1988                 return(BUS_CONFIG_INTR(dev->parent, irq, trig, pol));
1989         else
1990                 return(EINVAL);
1991 }
1992
1993 int
1994 bus_generic_rl_get_resource(device_t dev, device_t child, int type, int rid,
1995     u_long *startp, u_long *countp)
1996 {
1997         struct resource_list *rl = NULL;
1998         struct resource_list_entry *rle = NULL;
1999
2000         rl = BUS_GET_RESOURCE_LIST(dev, child);
2001         if (!rl)
2002                 return(EINVAL);
2003
2004         rle = resource_list_find(rl, type, rid);
2005         if (!rle)
2006                 return(ENOENT);
2007
2008         if (startp)
2009                 *startp = rle->start;
2010         if (countp)
2011                 *countp = rle->count;
2012
2013         return(0);
2014 }
2015
2016 int
2017 bus_generic_rl_set_resource(device_t dev, device_t child, int type, int rid,
2018     u_long start, u_long count)
2019 {
2020         struct resource_list *rl = NULL;
2021
2022         rl = BUS_GET_RESOURCE_LIST(dev, child);
2023         if (!rl)
2024                 return(EINVAL);
2025
2026         resource_list_add(rl, type, rid, start, (start + count - 1), count);
2027
2028         return(0);
2029 }
2030
2031 void
2032 bus_generic_rl_delete_resource(device_t dev, device_t child, int type, int rid)
2033 {
2034         struct resource_list *rl = NULL;
2035
2036         rl = BUS_GET_RESOURCE_LIST(dev, child);
2037         if (!rl)
2038                 return;
2039
2040         resource_list_delete(rl, type, rid);
2041 }
2042
2043 int
2044 bus_generic_rl_release_resource(device_t dev, device_t child, int type,
2045     int rid, struct resource *r)
2046 {
2047         struct resource_list *rl = NULL;
2048
2049         rl = BUS_GET_RESOURCE_LIST(dev, child);
2050         if (!rl)
2051                 return(EINVAL);
2052
2053         return(resource_list_release(rl, dev, child, type, rid, r));
2054 }
2055
2056 struct resource *
2057 bus_generic_rl_alloc_resource(device_t dev, device_t child, int type,
2058     int *rid, u_long start, u_long end, u_long count, u_int flags)
2059 {
2060         struct resource_list *rl = NULL;
2061
2062         rl = BUS_GET_RESOURCE_LIST(dev, child);
2063         if (!rl)
2064                 return(NULL);
2065
2066         return(resource_list_alloc(rl, dev, child, type, rid,
2067             start, end, count, flags));
2068 }
2069
2070 int
2071 bus_generic_child_present(device_t bus, device_t child)
2072 {
2073         return(BUS_CHILD_PRESENT(device_get_parent(bus), bus));
2074 }
2075
2076
2077 /*
2078  * Some convenience functions to make it easier for drivers to use the
2079  * resource-management functions.  All these really do is hide the
2080  * indirection through the parent's method table, making for slightly
2081  * less-wordy code.  In the future, it might make sense for this code
2082  * to maintain some sort of a list of resources allocated by each device.
2083  */
2084 struct resource *
2085 bus_alloc_resource(device_t dev, int type, int *rid, u_long start, u_long end,
2086                    u_long count, u_int flags)
2087 {
2088         if (dev->parent == 0)
2089                 return(0);
2090         return(BUS_ALLOC_RESOURCE(dev->parent, dev, type, rid, start, end,
2091                                   count, flags));
2092 }
2093
2094 int
2095 bus_activate_resource(device_t dev, int type, int rid, struct resource *r)
2096 {
2097         if (dev->parent == 0)
2098                 return(EINVAL);
2099         return(BUS_ACTIVATE_RESOURCE(dev->parent, dev, type, rid, r));
2100 }
2101
2102 int
2103 bus_deactivate_resource(device_t dev, int type, int rid, struct resource *r)
2104 {
2105         if (dev->parent == 0)
2106                 return(EINVAL);
2107         return(BUS_DEACTIVATE_RESOURCE(dev->parent, dev, type, rid, r));
2108 }
2109
2110 int
2111 bus_release_resource(device_t dev, int type, int rid, struct resource *r)
2112 {
2113         if (dev->parent == 0)
2114                 return(EINVAL);
2115         return(BUS_RELEASE_RESOURCE(dev->parent, dev, type, rid, r));
2116 }
2117
2118 int
2119 bus_setup_intr(device_t dev, struct resource *r, int flags,
2120                driver_intr_t handler, void *arg, void **cookiep)
2121 {
2122         if (dev->parent == 0)
2123                 return(EINVAL);
2124         return(BUS_SETUP_INTR(dev->parent, dev, r, flags, handler, arg,
2125                cookiep));
2126 }
2127
2128 int
2129 bus_teardown_intr(device_t dev, struct resource *r, void *cookie)
2130 {
2131         if (dev->parent == 0)
2132                 return(EINVAL);
2133         return(BUS_TEARDOWN_INTR(dev->parent, dev, r, cookie));
2134 }
2135
2136 int
2137 bus_set_resource(device_t dev, int type, int rid,
2138                  u_long start, u_long count)
2139 {
2140         return(BUS_SET_RESOURCE(device_get_parent(dev), dev, type, rid,
2141                                 start, count));
2142 }
2143
2144 int
2145 bus_get_resource(device_t dev, int type, int rid,
2146                  u_long *startp, u_long *countp)
2147 {
2148         return(BUS_GET_RESOURCE(device_get_parent(dev), dev, type, rid,
2149                                 startp, countp));
2150 }
2151
2152 u_long
2153 bus_get_resource_start(device_t dev, int type, int rid)
2154 {
2155         u_long start, count;
2156         int error;
2157
2158         error = BUS_GET_RESOURCE(device_get_parent(dev), dev, type, rid,
2159                                  &start, &count);
2160         if (error)
2161                 return(0);
2162         return(start);
2163 }
2164
2165 u_long
2166 bus_get_resource_count(device_t dev, int type, int rid)
2167 {
2168         u_long start, count;
2169         int error;
2170
2171         error = BUS_GET_RESOURCE(device_get_parent(dev), dev, type, rid,
2172                                  &start, &count);
2173         if (error)
2174                 return(0);
2175         return(count);
2176 }
2177
2178 void
2179 bus_delete_resource(device_t dev, int type, int rid)
2180 {
2181         BUS_DELETE_RESOURCE(device_get_parent(dev), dev, type, rid);
2182 }
2183
2184 int
2185 bus_child_present(device_t child)
2186 {
2187         return (BUS_CHILD_PRESENT(device_get_parent(child), child));
2188 }
2189
2190 int
2191 bus_child_pnpinfo_str(device_t child, char *buf, size_t buflen)
2192 {
2193         device_t parent;
2194
2195         parent = device_get_parent(child);
2196         if (parent == NULL) {
2197                 *buf = '\0';
2198                 return (0);
2199         }
2200         return (BUS_CHILD_PNPINFO_STR(parent, child, buf, buflen));
2201 }
2202
2203 int
2204 bus_child_location_str(device_t child, char *buf, size_t buflen)
2205 {
2206         device_t parent;
2207
2208         parent = device_get_parent(child);
2209         if (parent == NULL) {
2210                 *buf = '\0';
2211                 return (0);
2212         }
2213         return (BUS_CHILD_LOCATION_STR(parent, child, buf, buflen));
2214 }
2215
2216 static int
2217 root_print_child(device_t dev, device_t child)
2218 {
2219         return(0);
2220 }
2221
2222 static int
2223 root_setup_intr(device_t dev, device_t child, driver_intr_t *intr, void *arg,
2224                 void **cookiep)
2225 {
2226         /*
2227          * If an interrupt mapping gets to here something bad has happened.
2228          */
2229         panic("root_setup_intr");
2230 }
2231
2232 /*
2233  * If we get here, assume that the device is permanant and really is
2234  * present in the system.  Removable bus drivers are expected to intercept
2235  * this call long before it gets here.  We return -1 so that drivers that
2236  * really care can check vs -1 or some ERRNO returned higher in the food
2237  * chain.
2238  */
2239 static int
2240 root_child_present(device_t dev, device_t child)
2241 {
2242         return(-1);
2243 }
2244
2245 /*
2246  * XXX NOTE! other defaults may be set in bus_if.m
2247  */
2248 static kobj_method_t root_methods[] = {
2249         /* Device interface */
2250         KOBJMETHOD(device_shutdown,     bus_generic_shutdown),
2251         KOBJMETHOD(device_suspend,      bus_generic_suspend),
2252         KOBJMETHOD(device_resume,       bus_generic_resume),
2253
2254         /* Bus interface */
2255         KOBJMETHOD(bus_print_child,     root_print_child),
2256         KOBJMETHOD(bus_read_ivar,       bus_generic_read_ivar),
2257         KOBJMETHOD(bus_write_ivar,      bus_generic_write_ivar),
2258         KOBJMETHOD(bus_setup_intr,      root_setup_intr),
2259         KOBJMETHOD(bus_child_present,   root_child_present),
2260
2261         { 0, 0 }
2262 };
2263
2264 static driver_t root_driver = {
2265         "root",
2266         root_methods,
2267         1,                      /* no softc */
2268 };
2269
2270 device_t        root_bus;
2271 devclass_t      root_devclass;
2272
2273 static int
2274 root_bus_module_handler(module_t mod, int what, void* arg)
2275 {
2276         switch (what) {
2277         case MOD_LOAD:
2278                 root_bus = make_device(NULL, "root", 0);
2279                 root_bus->desc = "System root bus";
2280                 kobj_init((kobj_t) root_bus, (kobj_class_t) &root_driver);
2281                 root_bus->driver = &root_driver;
2282                 root_bus->state = DS_ATTACHED;
2283                 root_devclass = devclass_find_internal("root", NULL, FALSE);
2284                 return(0);
2285
2286         case MOD_SHUTDOWN:
2287                 device_shutdown(root_bus);
2288                 return(0);
2289         default:
2290                 return(0);
2291         }
2292 }
2293
2294 static moduledata_t root_bus_mod = {
2295         "rootbus",
2296         root_bus_module_handler,
2297         0
2298 };
2299 DECLARE_MODULE(rootbus, root_bus_mod, SI_SUB_DRIVERS, SI_ORDER_FIRST);
2300
2301 void
2302 root_bus_configure(void)
2303 {
2304         device_t dev;
2305
2306         PDEBUG(("."));
2307
2308         TAILQ_FOREACH(dev, &root_bus->children, link)
2309                 device_probe_and_attach(dev);
2310 }
2311
2312 int
2313 driver_module_handler(module_t mod, int what, void *arg)
2314 {
2315         int error;
2316         struct driver_module_data *dmd;
2317         devclass_t bus_devclass;
2318         kobj_class_t driver;
2319         const char *parentname;
2320
2321         dmd = (struct driver_module_data *)arg;
2322         bus_devclass = devclass_find_internal(dmd->dmd_busname, NULL, TRUE);
2323         error = 0;
2324
2325         switch (what) {
2326         case MOD_LOAD:
2327                 if (dmd->dmd_chainevh)
2328                         error = dmd->dmd_chainevh(mod,what,dmd->dmd_chainarg);
2329
2330                 driver = dmd->dmd_driver;
2331                 PDEBUG(("Loading module: driver %s on bus %s",
2332                         DRIVERNAME(driver), dmd->dmd_busname));
2333                 error = devclass_add_driver(bus_devclass, driver);
2334                 if (error)
2335                         break;
2336
2337                 /*
2338                  * If the driver has any base classes, make the
2339                  * devclass inherit from the devclass of the driver's
2340                  * first base class. This will allow the system to
2341                  * search for drivers in both devclasses for children
2342                  * of a device using this driver.
2343                  */
2344                 if (driver->baseclasses)
2345                         parentname = driver->baseclasses[0]->name;
2346                 else
2347                         parentname = NULL;
2348                 *dmd->dmd_devclass = devclass_find_internal(driver->name,
2349                                                             parentname, TRUE);
2350                 break;
2351
2352         case MOD_UNLOAD:
2353                 PDEBUG(("Unloading module: driver %s from bus %s",
2354                         DRIVERNAME(dmd->dmd_driver), dmd->dmd_busname));
2355                 error = devclass_delete_driver(bus_devclass, dmd->dmd_driver);
2356
2357                 if (!error && dmd->dmd_chainevh)
2358                         error = dmd->dmd_chainevh(mod,what,dmd->dmd_chainarg);
2359                 break;
2360         }
2361
2362         return (error);
2363 }
2364
2365 #ifdef BUS_DEBUG
2366
2367 /*
2368  * The _short versions avoid iteration by not calling anything that prints
2369  * more than oneliners. I love oneliners.
2370  */
2371
2372 static void
2373 print_device_short(device_t dev, int indent)
2374 {
2375         if (!dev)
2376                 return;
2377
2378         indentprintf(("device %d: <%s> %sparent,%schildren,%s%s%s%s,%sivars,%ssoftc,busy=%d\n",
2379                       dev->unit, dev->desc,
2380                       (dev->parent? "":"no "),
2381                       (TAILQ_EMPTY(&dev->children)? "no ":""),
2382                       (dev->flags&DF_ENABLED? "enabled,":"disabled,"),
2383                       (dev->flags&DF_FIXEDCLASS? "fixed,":""),
2384                       (dev->flags&DF_WILDCARD? "wildcard,":""),
2385                       (dev->flags&DF_DESCMALLOCED? "descmalloced,":""),
2386                       (dev->ivars? "":"no "),
2387                       (dev->softc? "":"no "),
2388                       dev->busy));
2389 }
2390
2391 static void
2392 print_device(device_t dev, int indent)
2393 {
2394         if (!dev)
2395                 return;
2396
2397         print_device_short(dev, indent);
2398
2399         indentprintf(("Parent:\n"));
2400         print_device_short(dev->parent, indent+1);
2401         indentprintf(("Driver:\n"));
2402         print_driver_short(dev->driver, indent+1);
2403         indentprintf(("Devclass:\n"));
2404         print_devclass_short(dev->devclass, indent+1);
2405 }
2406
2407 /*
2408  * Print the device and all its children (indented).
2409  */
2410 void
2411 print_device_tree_short(device_t dev, int indent)
2412 {
2413         device_t child;
2414
2415         if (!dev)
2416                 return;
2417
2418         print_device_short(dev, indent);
2419
2420         TAILQ_FOREACH(child, &dev->children, link)
2421                 print_device_tree_short(child, indent+1);
2422 }
2423
2424 /*
2425  * Print the device and all its children (indented).
2426  */
2427 void
2428 print_device_tree(device_t dev, int indent)
2429 {
2430         device_t child;
2431
2432         if (!dev)
2433                 return;
2434
2435         print_device(dev, indent);
2436
2437         TAILQ_FOREACH(child, &dev->children, link)
2438                 print_device_tree(child, indent+1);
2439 }
2440
2441 static void
2442 print_driver_short(driver_t *driver, int indent)
2443 {
2444         if (!driver)
2445                 return;
2446
2447         indentprintf(("driver %s: softc size = %d\n",
2448                       driver->name, driver->size));
2449 }
2450
2451 static void
2452 print_driver(driver_t *driver, int indent)
2453 {
2454         if (!driver)
2455                 return;
2456
2457         print_driver_short(driver, indent);
2458 }
2459
2460
2461 static void
2462 print_driver_list(driver_list_t drivers, int indent)
2463 {
2464         driverlink_t driver;
2465
2466         TAILQ_FOREACH(driver, &drivers, link)
2467                 print_driver(driver->driver, indent);
2468 }
2469
2470 static void
2471 print_devclass_short(devclass_t dc, int indent)
2472 {
2473         if (!dc)
2474                 return;
2475
2476         indentprintf(("devclass %s: max units = %d\n", dc->name, dc->maxunit));
2477 }
2478
2479 static void
2480 print_devclass(devclass_t dc, int indent)
2481 {
2482         int i;
2483
2484         if (!dc)
2485                 return;
2486
2487         print_devclass_short(dc, indent);
2488         indentprintf(("Drivers:\n"));
2489         print_driver_list(dc->drivers, indent+1);
2490
2491         indentprintf(("Devices:\n"));
2492         for (i = 0; i < dc->maxunit; i++)
2493                 if (dc->devices[i])
2494                         print_device(dc->devices[i], indent+1);
2495 }
2496
2497 void
2498 print_devclass_list_short(void)
2499 {
2500         devclass_t dc;
2501
2502         printf("Short listing of devclasses, drivers & devices:\n");
2503         TAILQ_FOREACH(dc, &devclasses, link) {
2504                 print_devclass_short(dc, 0);
2505         }
2506 }
2507
2508 void
2509 print_devclass_list(void)
2510 {
2511         devclass_t dc;
2512
2513         printf("Full listing of devclasses, drivers & devices:\n");
2514         TAILQ_FOREACH(dc, &devclasses, link) {
2515                 print_devclass(dc, 0);
2516         }
2517 }
2518
2519 #endif
2520
2521 /*
2522  * Check to see if a device is disabled via a disabled hint.
2523  */
2524 int
2525 resource_disabled(const char *name, int unit)
2526 {
2527         int error, value;
2528
2529         error = resource_int_value(name, unit, "disabled", &value);
2530         if (error)
2531                return(0);
2532         return(value);
2533 }