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