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