Home | History | Annotate | Line # | Download | only in kern
subr_devsw.c revision 1.12.2.1
      1  1.12.2.1   bouyer /*	$NetBSD: subr_devsw.c,v 1.12.2.1 2007/11/13 16:02:17 bouyer Exp $	*/
      2      1.11       ad 
      3       1.2  gehenna /*-
      4      1.11       ad  * Copyright (c) 2001, 2002, 2007 The NetBSD Foundation, Inc.
      5       1.2  gehenna  * All rights reserved.
      6       1.2  gehenna  *
      7       1.2  gehenna  * This code is derived from software contributed to The NetBSD Foundation
      8      1.11       ad  * by MAEKAWA Masahide <gehenna (at) NetBSD.org>, and by Andrew Doran.
      9       1.2  gehenna  *
     10       1.2  gehenna  * Redistribution and use in source and binary forms, with or without
     11       1.2  gehenna  * modification, are permitted provided that the following conditions
     12       1.2  gehenna  * are met:
     13       1.2  gehenna  * 1. Redistributions of source code must retain the above copyright
     14       1.2  gehenna  *    notice, this list of conditions and the following disclaimer.
     15       1.2  gehenna  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.2  gehenna  *    notice, this list of conditions and the following disclaimer in the
     17       1.2  gehenna  *    documentation and/or other materials provided with the distribution.
     18       1.2  gehenna  * 3. All advertising materials mentioning features or use of this software
     19       1.2  gehenna  *    must display the following acknowledgement:
     20       1.2  gehenna  *	This product includes software developed by the NetBSD
     21       1.2  gehenna  *	Foundation, Inc. and its contributors.
     22       1.2  gehenna  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23       1.2  gehenna  *    contributors may be used to endorse or promote products derived
     24       1.2  gehenna  *    from this software without specific prior written permission.
     25       1.2  gehenna  *
     26       1.2  gehenna  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27       1.2  gehenna  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28       1.2  gehenna  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29       1.2  gehenna  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30       1.2  gehenna  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31       1.2  gehenna  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32       1.2  gehenna  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33       1.2  gehenna  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34       1.2  gehenna  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35       1.2  gehenna  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36       1.2  gehenna  * POSSIBILITY OF SUCH DAMAGE.
     37       1.2  gehenna  */
     38      1.11       ad 
     39      1.11       ad /*
     40      1.11       ad  * Overview
     41      1.11       ad  *
     42      1.11       ad  *	subr_devsw.c: registers device drivers by name and by major
     43      1.11       ad  *	number, and provides wrapper methods for performing I/O and
     44      1.11       ad  *	other tasks on device drivers, keying on the device number
     45      1.11       ad  *	(dev_t).
     46      1.11       ad  *
     47      1.11       ad  *	When the system is built, the config(8) command generates
     48      1.11       ad  *	static tables of device drivers built into the kernel image
     49      1.11       ad  *	along with their associated methods.  These are recorded in
     50      1.11       ad  *	the cdevsw0 and bdevsw0 tables.  Drivers can also be added to
     51      1.11       ad  *	and removed from the system dynamically.
     52      1.11       ad  *
     53      1.11       ad  * Allocation
     54      1.11       ad  *
     55      1.11       ad  *	When the system initially boots only the statically allocated
     56      1.11       ad  *	indexes (bdevsw0, cdevsw0) are used.  If these overflow due to
     57      1.11       ad  *	allocation, we allocate a fixed block of memory to hold the new,
     58      1.11       ad  *	expanded index.  This "fork" of the table is only ever performed
     59      1.11       ad  *	once in order to guarantee that other threads may safely access
     60      1.11       ad  *	the device tables:
     61      1.11       ad  *
     62      1.11       ad  *	o Once a thread has a "reference" to the table via an earlier
     63      1.11       ad  *	  open() call, we know that the entry in the table must exist
     64      1.11       ad  *	  and so it is safe to access it.
     65      1.11       ad  *
     66      1.11       ad  *	o Regardless of whether other threads see the old or new
     67      1.11       ad  *	  pointers, they will point to a correct device switch
     68      1.11       ad  *	  structure for the operation being performed.
     69      1.11       ad  *
     70      1.11       ad  *	XXX Currently, the wrapper methods such as cdev_read() verify
     71      1.11       ad  *	that a device driver does in fact exist before calling the
     72      1.11       ad  *	associated driver method.  This should be changed so that
     73      1.11       ad  *	once the device is has been referenced by a vnode (opened),
     74      1.11       ad  *	calling	the other methods should be valid until that reference
     75      1.11       ad  *	is dropped.
     76      1.11       ad  */
     77       1.7    lukem 
     78       1.7    lukem #include <sys/cdefs.h>
     79  1.12.2.1   bouyer __KERNEL_RCSID(0, "$NetBSD: subr_devsw.c,v 1.12.2.1 2007/11/13 16:02:17 bouyer Exp $");
     80       1.2  gehenna 
     81       1.2  gehenna #include <sys/param.h>
     82       1.2  gehenna #include <sys/conf.h>
     83      1.11       ad #include <sys/kmem.h>
     84       1.2  gehenna #include <sys/systm.h>
     85      1.11       ad #include <sys/poll.h>
     86      1.11       ad #include <sys/tty.h>
     87      1.11       ad #include <sys/buf.h>
     88       1.2  gehenna 
     89       1.2  gehenna #ifdef DEVSW_DEBUG
     90       1.2  gehenna #define	DPRINTF(x)	printf x
     91       1.2  gehenna #else /* DEVSW_DEBUG */
     92       1.2  gehenna #define	DPRINTF(x)
     93       1.2  gehenna #endif /* DEVSW_DEBUG */
     94       1.2  gehenna 
     95      1.11       ad #define	MAXDEVSW	512	/* the maximum of major device number */
     96       1.2  gehenna #define	BDEVSW_SIZE	(sizeof(struct bdevsw *))
     97       1.2  gehenna #define	CDEVSW_SIZE	(sizeof(struct cdevsw *))
     98       1.2  gehenna #define	DEVSWCONV_SIZE	(sizeof(struct devsw_conv))
     99       1.2  gehenna 
    100       1.2  gehenna extern const struct bdevsw **bdevsw, *bdevsw0[];
    101       1.2  gehenna extern const struct cdevsw **cdevsw, *cdevsw0[];
    102       1.2  gehenna extern struct devsw_conv *devsw_conv, devsw_conv0[];
    103       1.2  gehenna extern const int sys_bdevsws, sys_cdevsws;
    104       1.2  gehenna extern int max_bdevsws, max_cdevsws, max_devsw_convs;
    105       1.2  gehenna 
    106       1.2  gehenna static int bdevsw_attach(const char *, const struct bdevsw *, int *);
    107       1.2  gehenna static int cdevsw_attach(const char *, const struct cdevsw *, int *);
    108      1.11       ad static void devsw_detach_locked(const struct bdevsw *, const struct cdevsw *);
    109      1.11       ad 
    110  1.12.2.1   bouyer kmutex_t devsw_lock;
    111      1.11       ad 
    112      1.11       ad void
    113      1.11       ad devsw_init(void)
    114      1.11       ad {
    115      1.11       ad 
    116      1.11       ad 	KASSERT(sys_bdevsws < MAXDEVSW - 1);
    117      1.11       ad 	KASSERT(sys_cdevsws < MAXDEVSW - 1);
    118      1.11       ad 
    119      1.11       ad 	mutex_init(&devsw_lock, MUTEX_DEFAULT, IPL_NONE);
    120      1.11       ad }
    121       1.2  gehenna 
    122       1.2  gehenna int
    123       1.2  gehenna devsw_attach(const char *devname, const struct bdevsw *bdev, int *bmajor,
    124       1.2  gehenna 	     const struct cdevsw *cdev, int *cmajor)
    125       1.2  gehenna {
    126       1.2  gehenna 	struct devsw_conv *conv;
    127       1.2  gehenna 	char *name;
    128       1.2  gehenna 	int error, i;
    129       1.2  gehenna 
    130       1.2  gehenna 	if (devname == NULL || cdev == NULL)
    131       1.2  gehenna 		return (EINVAL);
    132       1.2  gehenna 
    133      1.11       ad 	mutex_enter(&devsw_lock);
    134      1.11       ad 
    135       1.2  gehenna 	for (i = 0 ; i < max_devsw_convs ; i++) {
    136       1.2  gehenna 		conv = &devsw_conv[i];
    137       1.2  gehenna 		if (conv->d_name == NULL || strcmp(devname, conv->d_name) != 0)
    138       1.2  gehenna 			continue;
    139       1.2  gehenna 
    140       1.2  gehenna 		if (*bmajor < 0)
    141       1.2  gehenna 			*bmajor = conv->d_bmajor;
    142       1.2  gehenna 		if (*cmajor < 0)
    143       1.2  gehenna 			*cmajor = conv->d_cmajor;
    144       1.2  gehenna 
    145      1.11       ad 		if (*bmajor != conv->d_bmajor || *cmajor != conv->d_cmajor) {
    146      1.11       ad 			error = EINVAL;
    147      1.11       ad 			goto fail;
    148      1.11       ad 		}
    149      1.11       ad 		if ((*bmajor >= 0 && bdev == NULL) || *cmajor < 0) {
    150      1.11       ad 			error = EINVAL;
    151      1.11       ad 			goto fail;
    152      1.11       ad 		}
    153       1.2  gehenna 
    154       1.2  gehenna 		if ((*bmajor >= 0 && bdevsw[*bmajor] != NULL) ||
    155      1.11       ad 		    cdevsw[*cmajor] != NULL) {
    156      1.11       ad 			error = EEXIST;
    157      1.11       ad 			goto fail;
    158      1.11       ad 		}
    159       1.2  gehenna 
    160       1.2  gehenna 		if (bdev != NULL)
    161       1.2  gehenna 			bdevsw[*bmajor] = bdev;
    162       1.2  gehenna 		cdevsw[*cmajor] = cdev;
    163       1.2  gehenna 
    164      1.11       ad 		mutex_exit(&devsw_lock);
    165       1.2  gehenna 		return (0);
    166       1.2  gehenna 	}
    167       1.2  gehenna 
    168       1.2  gehenna 	error = bdevsw_attach(devname, bdev, bmajor);
    169      1.11       ad 	if (error != 0)
    170      1.11       ad 		goto fail;
    171       1.2  gehenna 	error = cdevsw_attach(devname, cdev, cmajor);
    172       1.2  gehenna 	if (error != 0) {
    173      1.11       ad 		devsw_detach_locked(bdev, NULL);
    174      1.11       ad 		goto fail;
    175       1.2  gehenna 	}
    176       1.2  gehenna 
    177       1.2  gehenna 	for (i = 0 ; i < max_devsw_convs ; i++) {
    178       1.2  gehenna 		if (devsw_conv[i].d_name == NULL)
    179       1.2  gehenna 			break;
    180       1.2  gehenna 	}
    181       1.2  gehenna 	if (i == max_devsw_convs) {
    182       1.2  gehenna 		struct devsw_conv *newptr;
    183       1.2  gehenna 		int old, new;
    184       1.2  gehenna 
    185       1.2  gehenna 		old = max_devsw_convs;
    186       1.2  gehenna 		new = old + 1;
    187       1.2  gehenna 
    188      1.11       ad 		newptr = kmem_zalloc(new * DEVSWCONV_SIZE, KM_NOSLEEP);
    189       1.2  gehenna 		if (newptr == NULL) {
    190      1.11       ad 			devsw_detach_locked(bdev, cdev);
    191      1.11       ad 			error = ENOMEM;
    192      1.11       ad 			goto fail;
    193       1.2  gehenna 		}
    194       1.2  gehenna 		newptr[old].d_name = NULL;
    195       1.2  gehenna 		newptr[old].d_bmajor = -1;
    196       1.2  gehenna 		newptr[old].d_cmajor = -1;
    197       1.2  gehenna 		memcpy(newptr, devsw_conv, old * DEVSWCONV_SIZE);
    198       1.2  gehenna 		if (devsw_conv != devsw_conv0)
    199      1.11       ad 			kmem_free(devsw_conv, old * DEVSWCONV_SIZE);
    200       1.2  gehenna 		devsw_conv = newptr;
    201       1.2  gehenna 		max_devsw_convs = new;
    202       1.2  gehenna 	}
    203       1.2  gehenna 
    204       1.6   itojun 	i = strlen(devname) + 1;
    205      1.11       ad 	name = kmem_alloc(i, KM_NOSLEEP);
    206       1.2  gehenna 	if (name == NULL) {
    207      1.11       ad 		devsw_detach_locked(bdev, cdev);
    208      1.11       ad 		goto fail;
    209       1.2  gehenna 	}
    210       1.6   itojun 	strlcpy(name, devname, i);
    211       1.2  gehenna 
    212       1.2  gehenna 	devsw_conv[i].d_name = name;
    213       1.2  gehenna 	devsw_conv[i].d_bmajor = *bmajor;
    214       1.2  gehenna 	devsw_conv[i].d_cmajor = *cmajor;
    215       1.2  gehenna 
    216      1.11       ad 	mutex_exit(&devsw_lock);
    217       1.2  gehenna 	return (0);
    218      1.11       ad  fail:
    219      1.11       ad 	mutex_exit(&devsw_lock);
    220      1.11       ad 	return (error);
    221       1.2  gehenna }
    222       1.2  gehenna 
    223       1.2  gehenna static int
    224      1.10     yamt bdevsw_attach(const char *devname, const struct bdevsw *devsw, int *devmajor)
    225       1.2  gehenna {
    226      1.11       ad 	const struct bdevsw **newptr;
    227       1.2  gehenna 	int bmajor, i;
    228       1.2  gehenna 
    229      1.11       ad 	KASSERT(mutex_owned(&devsw_lock));
    230      1.11       ad 
    231       1.2  gehenna 	if (devsw == NULL)
    232       1.2  gehenna 		return (0);
    233       1.2  gehenna 
    234       1.2  gehenna 	if (*devmajor < 0) {
    235       1.2  gehenna 		for (bmajor = sys_bdevsws ; bmajor < max_bdevsws ; bmajor++) {
    236       1.2  gehenna 			if (bdevsw[bmajor] != NULL)
    237       1.2  gehenna 				continue;
    238       1.2  gehenna 			for (i = 0 ; i < max_devsw_convs ; i++) {
    239       1.2  gehenna 				if (devsw_conv[i].d_bmajor == bmajor)
    240       1.2  gehenna 					break;
    241       1.2  gehenna 			}
    242       1.2  gehenna 			if (i != max_devsw_convs)
    243       1.2  gehenna 				continue;
    244       1.2  gehenna 			break;
    245       1.2  gehenna 		}
    246       1.3  gehenna 		*devmajor = bmajor;
    247       1.2  gehenna 	}
    248      1.11       ad 
    249       1.2  gehenna 	if (*devmajor >= MAXDEVSW) {
    250      1.11       ad 		printf("bdevsw_attach: block majors exhausted");
    251       1.2  gehenna 		return (ENOMEM);
    252       1.2  gehenna 	}
    253       1.2  gehenna 
    254       1.2  gehenna 	if (*devmajor >= max_bdevsws) {
    255      1.11       ad 		KASSERT(bdevsw == bdevsw0);
    256      1.11       ad 		newptr = kmem_zalloc(MAXDEVSW * BDEVSW_SIZE, KM_NOSLEEP);
    257       1.2  gehenna 		if (newptr == NULL)
    258       1.2  gehenna 			return (ENOMEM);
    259      1.11       ad 		memcpy(newptr, bdevsw, max_bdevsws * BDEVSW_SIZE);
    260       1.2  gehenna 		bdevsw = newptr;
    261      1.11       ad 		max_bdevsws = MAXDEVSW;
    262       1.2  gehenna 	}
    263       1.2  gehenna 
    264       1.2  gehenna 	if (bdevsw[*devmajor] != NULL)
    265       1.2  gehenna 		return (EEXIST);
    266       1.2  gehenna 
    267       1.2  gehenna 	bdevsw[*devmajor] = devsw;
    268       1.2  gehenna 
    269       1.2  gehenna 	return (0);
    270       1.2  gehenna }
    271       1.2  gehenna 
    272       1.2  gehenna static int
    273      1.10     yamt cdevsw_attach(const char *devname, const struct cdevsw *devsw, int *devmajor)
    274       1.2  gehenna {
    275      1.11       ad 	const struct cdevsw **newptr;
    276       1.2  gehenna 	int cmajor, i;
    277       1.2  gehenna 
    278      1.11       ad 	KASSERT(mutex_owned(&devsw_lock));
    279      1.11       ad 
    280       1.2  gehenna 	if (*devmajor < 0) {
    281       1.2  gehenna 		for (cmajor = sys_cdevsws ; cmajor < max_cdevsws ; cmajor++) {
    282       1.2  gehenna 			if (cdevsw[cmajor] != NULL)
    283       1.2  gehenna 				continue;
    284       1.2  gehenna 			for (i = 0 ; i < max_devsw_convs ; i++) {
    285       1.2  gehenna 				if (devsw_conv[i].d_cmajor == cmajor)
    286       1.2  gehenna 					break;
    287       1.2  gehenna 			}
    288       1.2  gehenna 			if (i != max_devsw_convs)
    289       1.2  gehenna 				continue;
    290       1.2  gehenna 			break;
    291       1.2  gehenna 		}
    292       1.3  gehenna 		*devmajor = cmajor;
    293       1.2  gehenna 	}
    294      1.11       ad 
    295       1.2  gehenna 	if (*devmajor >= MAXDEVSW) {
    296      1.11       ad 		printf("cdevsw_attach: character majors exhausted");
    297       1.2  gehenna 		return (ENOMEM);
    298       1.2  gehenna 	}
    299       1.2  gehenna 
    300       1.2  gehenna 	if (*devmajor >= max_cdevsws) {
    301      1.11       ad 		KASSERT(cdevsw == cdevsw0);
    302      1.11       ad 		newptr = kmem_zalloc(MAXDEVSW * CDEVSW_SIZE, KM_NOSLEEP);
    303       1.2  gehenna 		if (newptr == NULL)
    304       1.2  gehenna 			return (ENOMEM);
    305      1.11       ad 		memcpy(newptr, cdevsw, max_cdevsws * CDEVSW_SIZE);
    306       1.2  gehenna 		cdevsw = newptr;
    307      1.11       ad 		max_cdevsws = MAXDEVSW;
    308       1.2  gehenna 	}
    309       1.2  gehenna 
    310       1.2  gehenna 	if (cdevsw[*devmajor] != NULL)
    311       1.2  gehenna 		return (EEXIST);
    312       1.2  gehenna 
    313       1.2  gehenna 	cdevsw[*devmajor] = devsw;
    314       1.2  gehenna 
    315       1.2  gehenna 	return (0);
    316       1.2  gehenna }
    317       1.2  gehenna 
    318      1.11       ad static void
    319      1.11       ad devsw_detach_locked(const struct bdevsw *bdev, const struct cdevsw *cdev)
    320       1.2  gehenna {
    321       1.2  gehenna 	int i;
    322       1.2  gehenna 
    323      1.11       ad 	KASSERT(mutex_owned(&devsw_lock));
    324      1.11       ad 
    325       1.2  gehenna 	if (bdev != NULL) {
    326       1.2  gehenna 		for (i = 0 ; i < max_bdevsws ; i++) {
    327       1.2  gehenna 			if (bdevsw[i] != bdev)
    328       1.2  gehenna 				continue;
    329       1.2  gehenna 			bdevsw[i] = NULL;
    330       1.2  gehenna 			break;
    331       1.2  gehenna 		}
    332       1.2  gehenna 	}
    333       1.2  gehenna 	if (cdev != NULL) {
    334       1.2  gehenna 		for (i = 0 ; i < max_cdevsws ; i++) {
    335       1.2  gehenna 			if (cdevsw[i] != cdev)
    336       1.2  gehenna 				continue;
    337       1.2  gehenna 			cdevsw[i] = NULL;
    338       1.2  gehenna 			break;
    339       1.2  gehenna 		}
    340       1.2  gehenna 	}
    341       1.2  gehenna }
    342       1.2  gehenna 
    343      1.11       ad void
    344      1.11       ad devsw_detach(const struct bdevsw *bdev, const struct cdevsw *cdev)
    345      1.11       ad {
    346      1.11       ad 
    347      1.11       ad 	mutex_enter(&devsw_lock);
    348      1.11       ad 	devsw_detach_locked(bdev, cdev);
    349      1.11       ad 	mutex_exit(&devsw_lock);
    350      1.11       ad }
    351      1.11       ad 
    352      1.11       ad /*
    353      1.11       ad  * Look up a block device by number.
    354      1.11       ad  *
    355      1.11       ad  * => Caller must ensure that the device is attached.
    356      1.11       ad  */
    357       1.2  gehenna const struct bdevsw *
    358       1.2  gehenna bdevsw_lookup(dev_t dev)
    359       1.2  gehenna {
    360       1.2  gehenna 	int bmajor;
    361       1.2  gehenna 
    362       1.2  gehenna 	if (dev == NODEV)
    363       1.2  gehenna 		return (NULL);
    364       1.2  gehenna 	bmajor = major(dev);
    365       1.2  gehenna 	if (bmajor < 0 || bmajor >= max_bdevsws)
    366       1.2  gehenna 		return (NULL);
    367       1.2  gehenna 
    368       1.2  gehenna 	return (bdevsw[bmajor]);
    369       1.2  gehenna }
    370       1.2  gehenna 
    371      1.11       ad /*
    372      1.11       ad  * Look up a character device by number.
    373      1.11       ad  *
    374      1.11       ad  * => Caller must ensure that the device is attached.
    375      1.11       ad  */
    376       1.2  gehenna const struct cdevsw *
    377       1.2  gehenna cdevsw_lookup(dev_t dev)
    378       1.2  gehenna {
    379       1.2  gehenna 	int cmajor;
    380       1.2  gehenna 
    381       1.2  gehenna 	if (dev == NODEV)
    382       1.2  gehenna 		return (NULL);
    383       1.2  gehenna 	cmajor = major(dev);
    384       1.2  gehenna 	if (cmajor < 0 || cmajor >= max_cdevsws)
    385       1.2  gehenna 		return (NULL);
    386       1.2  gehenna 
    387       1.2  gehenna 	return (cdevsw[cmajor]);
    388       1.2  gehenna }
    389       1.2  gehenna 
    390      1.11       ad /*
    391      1.11       ad  * Look up a block device by reference to its operations set.
    392      1.11       ad  *
    393      1.11       ad  * => Caller must ensure that the device is not detached, and therefore
    394      1.11       ad  *    that the returned major is still valid when dereferenced.
    395      1.11       ad  */
    396       1.2  gehenna int
    397       1.2  gehenna bdevsw_lookup_major(const struct bdevsw *bdev)
    398       1.2  gehenna {
    399       1.2  gehenna 	int bmajor;
    400       1.2  gehenna 
    401       1.2  gehenna 	for (bmajor = 0 ; bmajor < max_bdevsws ; bmajor++) {
    402       1.2  gehenna 		if (bdevsw[bmajor] == bdev)
    403       1.2  gehenna 			return (bmajor);
    404       1.2  gehenna 	}
    405       1.2  gehenna 
    406       1.2  gehenna 	return (-1);
    407       1.2  gehenna }
    408       1.2  gehenna 
    409      1.11       ad /*
    410      1.11       ad  * Look up a character device by reference to its operations set.
    411      1.11       ad  *
    412      1.11       ad  * => Caller must ensure that the device is not detached, and therefore
    413      1.11       ad  *    that the returned major is still valid when dereferenced.
    414      1.11       ad  */
    415       1.2  gehenna int
    416       1.2  gehenna cdevsw_lookup_major(const struct cdevsw *cdev)
    417       1.2  gehenna {
    418       1.2  gehenna 	int cmajor;
    419       1.2  gehenna 
    420       1.2  gehenna 	for (cmajor = 0 ; cmajor < max_cdevsws ; cmajor++) {
    421       1.2  gehenna 		if (cdevsw[cmajor] == cdev)
    422       1.2  gehenna 			return (cmajor);
    423       1.2  gehenna 	}
    424       1.2  gehenna 
    425       1.2  gehenna 	return (-1);
    426       1.2  gehenna }
    427       1.2  gehenna 
    428       1.2  gehenna /*
    429       1.2  gehenna  * Convert from block major number to name.
    430      1.11       ad  *
    431      1.11       ad  * => Caller must ensure that the device is not detached, and therefore
    432      1.11       ad  *    that the name pointer is still valid when dereferenced.
    433       1.2  gehenna  */
    434       1.2  gehenna const char *
    435       1.2  gehenna devsw_blk2name(int bmajor)
    436       1.2  gehenna {
    437      1.11       ad 	const char *name;
    438       1.2  gehenna 	int cmajor, i;
    439       1.2  gehenna 
    440      1.11       ad 	name = NULL;
    441      1.11       ad 	cmajor = -1;
    442      1.11       ad 
    443      1.11       ad 	mutex_enter(&devsw_lock);
    444      1.11       ad 	if (bmajor < 0 || bmajor >= max_bdevsws || bdevsw[bmajor] == NULL) {
    445      1.11       ad 		mutex_exit(&devsw_lock);
    446       1.2  gehenna 		return (NULL);
    447       1.2  gehenna 	}
    448      1.11       ad 	for (i = 0 ; i < max_devsw_convs; i++) {
    449      1.11       ad 		if (devsw_conv[i].d_bmajor == bmajor) {
    450      1.11       ad 			cmajor = devsw_conv[i].d_cmajor;
    451      1.11       ad 			break;
    452      1.11       ad 		}
    453      1.11       ad 	}
    454      1.11       ad 	if (cmajor >= 0 && cmajor < max_cdevsws && cdevsw[cmajor] != NULL)
    455      1.11       ad 		name = devsw_conv[i].d_name;
    456      1.11       ad 	mutex_exit(&devsw_lock);
    457       1.2  gehenna 
    458      1.11       ad 	return (name);
    459       1.2  gehenna }
    460       1.2  gehenna 
    461       1.2  gehenna /*
    462       1.2  gehenna  * Convert from device name to block major number.
    463      1.11       ad  *
    464      1.11       ad  * => Caller must ensure that the device is not detached, and therefore
    465      1.11       ad  *    that the major number is still valid when dereferenced.
    466       1.2  gehenna  */
    467       1.2  gehenna int
    468       1.2  gehenna devsw_name2blk(const char *name, char *devname, size_t devnamelen)
    469       1.2  gehenna {
    470       1.2  gehenna 	struct devsw_conv *conv;
    471       1.2  gehenna 	int bmajor, i;
    472       1.2  gehenna 
    473       1.2  gehenna 	if (name == NULL)
    474       1.2  gehenna 		return (-1);
    475       1.2  gehenna 
    476      1.11       ad 	mutex_enter(&devsw_lock);
    477       1.2  gehenna 	for (i = 0 ; i < max_devsw_convs ; i++) {
    478       1.5      mrg 		size_t len;
    479       1.5      mrg 
    480       1.2  gehenna 		conv = &devsw_conv[i];
    481       1.2  gehenna 		if (conv->d_name == NULL)
    482       1.2  gehenna 			continue;
    483       1.5      mrg 		len = strlen(conv->d_name);
    484       1.5      mrg 		if (strncmp(conv->d_name, name, len) != 0)
    485       1.5      mrg 			continue;
    486       1.5      mrg 		if (*(name +len) && !isdigit(*(name + len)))
    487       1.2  gehenna 			continue;
    488       1.2  gehenna 		bmajor = conv->d_bmajor;
    489       1.2  gehenna 		if (bmajor < 0 || bmajor >= max_bdevsws ||
    490       1.2  gehenna 		    bdevsw[bmajor] == NULL)
    491       1.5      mrg 			break;
    492       1.2  gehenna 		if (devname != NULL) {
    493       1.2  gehenna #ifdef DEVSW_DEBUG
    494       1.2  gehenna 			if (strlen(conv->d_name) >= devnamelen)
    495       1.2  gehenna 				printf("devsw_name2blk: too short buffer");
    496       1.2  gehenna #endif /* DEVSW_DEBUG */
    497       1.4  tsutsui 			strncpy(devname, conv->d_name, devnamelen);
    498       1.2  gehenna 			devname[devnamelen - 1] = '\0';
    499       1.2  gehenna 		}
    500      1.11       ad 		mutex_exit(&devsw_lock);
    501       1.2  gehenna 		return (bmajor);
    502       1.2  gehenna 	}
    503       1.2  gehenna 
    504      1.11       ad 	mutex_exit(&devsw_lock);
    505       1.2  gehenna 	return (-1);
    506       1.2  gehenna }
    507       1.2  gehenna 
    508       1.2  gehenna /*
    509       1.2  gehenna  * Convert from character dev_t to block dev_t.
    510      1.11       ad  *
    511      1.11       ad  * => Caller must ensure that the device is not detached, and therefore
    512      1.11       ad  *    that the major number is still valid when dereferenced.
    513       1.2  gehenna  */
    514       1.2  gehenna dev_t
    515       1.2  gehenna devsw_chr2blk(dev_t cdev)
    516       1.2  gehenna {
    517       1.2  gehenna 	int bmajor, cmajor, i;
    518      1.11       ad 	dev_t rv;
    519       1.2  gehenna 
    520       1.2  gehenna 	cmajor = major(cdev);
    521      1.11       ad 	bmajor = -1;
    522      1.11       ad 	rv = NODEV;
    523       1.2  gehenna 
    524      1.11       ad 	mutex_enter(&devsw_lock);
    525      1.11       ad 	if (cmajor < 0 || cmajor >= max_cdevsws || cdevsw[cmajor] == NULL) {
    526      1.11       ad 		mutex_exit(&devsw_lock);
    527      1.11       ad 		return (NODEV);
    528      1.11       ad 	}
    529       1.2  gehenna 	for (i = 0 ; i < max_devsw_convs ; i++) {
    530      1.11       ad 		if (devsw_conv[i].d_cmajor == cmajor) {
    531      1.11       ad 			bmajor = devsw_conv[i].d_bmajor;
    532      1.11       ad 			break;
    533      1.11       ad 		}
    534       1.2  gehenna 	}
    535      1.11       ad 	if (bmajor >= 0 && bmajor < max_bdevsws && bdevsw[bmajor] != NULL)
    536      1.11       ad 		rv = makedev(bmajor, minor(cdev));
    537      1.11       ad 	mutex_exit(&devsw_lock);
    538       1.2  gehenna 
    539      1.11       ad 	return (rv);
    540       1.2  gehenna }
    541       1.2  gehenna 
    542       1.2  gehenna /*
    543       1.2  gehenna  * Convert from block dev_t to character dev_t.
    544      1.11       ad  *
    545      1.11       ad  * => Caller must ensure that the device is not detached, and therefore
    546      1.11       ad  *    that the major number is still valid when dereferenced.
    547       1.2  gehenna  */
    548       1.2  gehenna dev_t
    549       1.2  gehenna devsw_blk2chr(dev_t bdev)
    550       1.2  gehenna {
    551       1.2  gehenna 	int bmajor, cmajor, i;
    552      1.11       ad 	dev_t rv;
    553       1.2  gehenna 
    554      1.11       ad 	bmajor = major(bdev);
    555      1.11       ad 	cmajor = -1;
    556      1.11       ad 	rv = NODEV;
    557      1.11       ad 
    558      1.11       ad 	mutex_enter(&devsw_lock);
    559      1.11       ad 	if (bmajor < 0 || bmajor >= max_bdevsws || bdevsw[bmajor] == NULL) {
    560      1.11       ad 		mutex_exit(&devsw_lock);
    561       1.2  gehenna 		return (NODEV);
    562      1.11       ad 	}
    563      1.11       ad 	for (i = 0 ; i < max_devsw_convs ; i++) {
    564      1.11       ad 		if (devsw_conv[i].d_bmajor == bmajor) {
    565      1.11       ad 			cmajor = devsw_conv[i].d_cmajor;
    566      1.11       ad 			break;
    567      1.11       ad 		}
    568      1.11       ad 	}
    569      1.11       ad 	if (cmajor >= 0 && cmajor < max_cdevsws && cdevsw[cmajor] != NULL)
    570      1.11       ad 		rv = makedev(cmajor, minor(bdev));
    571      1.11       ad 	mutex_exit(&devsw_lock);
    572       1.2  gehenna 
    573      1.11       ad 	return (rv);
    574      1.11       ad }
    575      1.11       ad 
    576      1.11       ad /*
    577      1.11       ad  * Device access methods.
    578      1.11       ad  */
    579      1.11       ad 
    580      1.11       ad #define	DEV_LOCK(d)						\
    581      1.11       ad 	if ((d->d_flag & D_MPSAFE) == 0) {			\
    582      1.11       ad 		KERNEL_LOCK(1, curlwp);				\
    583      1.11       ad 	}
    584       1.2  gehenna 
    585      1.11       ad #define	DEV_UNLOCK(d)						\
    586      1.11       ad 	if ((d->d_flag & D_MPSAFE) == 0) {			\
    587      1.11       ad 		KERNEL_UNLOCK_ONE(curlwp);			\
    588       1.2  gehenna 	}
    589       1.2  gehenna 
    590      1.11       ad int
    591      1.11       ad bdev_open(dev_t dev, int flag, int devtype, lwp_t *l)
    592      1.11       ad {
    593      1.11       ad 	const struct bdevsw *d;
    594      1.11       ad 	int rv;
    595      1.11       ad 
    596      1.11       ad 	/*
    597      1.11       ad 	 * For open we need to lock, in order to synchronize
    598      1.11       ad 	 * with attach/detach.
    599      1.11       ad 	 */
    600      1.11       ad 	mutex_enter(&devsw_lock);
    601      1.11       ad 	d = bdevsw_lookup(dev);
    602      1.11       ad 	mutex_exit(&devsw_lock);
    603      1.11       ad 	if (d == NULL)
    604      1.11       ad 		return ENXIO;
    605      1.11       ad 
    606      1.11       ad 	DEV_LOCK(d);
    607      1.11       ad 	rv = (*d->d_open)(dev, flag, devtype, l);
    608      1.11       ad 	DEV_UNLOCK(d);
    609      1.11       ad 
    610      1.11       ad 	return rv;
    611      1.11       ad }
    612      1.11       ad 
    613      1.11       ad int
    614      1.11       ad bdev_close(dev_t dev, int flag, int devtype, lwp_t *l)
    615      1.11       ad {
    616      1.11       ad 	const struct bdevsw *d;
    617      1.11       ad 	int rv;
    618      1.11       ad 
    619      1.11       ad 	if ((d = bdevsw_lookup(dev)) == NULL)
    620      1.11       ad 		return ENXIO;
    621      1.11       ad 
    622      1.11       ad 	DEV_LOCK(d);
    623      1.11       ad 	rv = (*d->d_close)(dev, flag, devtype, l);
    624      1.11       ad 	DEV_UNLOCK(d);
    625      1.11       ad 
    626      1.11       ad 	return rv;
    627      1.11       ad }
    628      1.11       ad 
    629      1.11       ad void
    630      1.11       ad bdev_strategy(struct buf *bp)
    631      1.11       ad {
    632      1.11       ad 	const struct bdevsw *d;
    633      1.11       ad 
    634      1.11       ad 	if ((d = bdevsw_lookup(bp->b_dev)) == NULL)
    635      1.11       ad 		panic("bdev_strategy");
    636      1.11       ad 
    637      1.11       ad 	DEV_LOCK(d);
    638      1.11       ad 	(*d->d_strategy)(bp);
    639      1.11       ad 	DEV_UNLOCK(d);
    640      1.11       ad }
    641      1.11       ad 
    642      1.11       ad int
    643      1.11       ad bdev_ioctl(dev_t dev, u_long cmd, void *data, int flag, lwp_t *l)
    644      1.11       ad {
    645      1.11       ad 	const struct bdevsw *d;
    646      1.11       ad 	int rv;
    647      1.11       ad 
    648      1.11       ad 	if ((d = bdevsw_lookup(dev)) == NULL)
    649      1.11       ad 		return ENXIO;
    650      1.11       ad 
    651      1.11       ad 	DEV_LOCK(d);
    652      1.11       ad 	rv = (*d->d_ioctl)(dev, cmd, data, flag, l);
    653      1.11       ad 	DEV_UNLOCK(d);
    654      1.11       ad 
    655      1.11       ad 	return rv;
    656      1.11       ad }
    657      1.11       ad 
    658      1.11       ad int
    659      1.11       ad bdev_dump(dev_t dev, daddr_t addr, void *data, size_t sz)
    660      1.11       ad {
    661      1.11       ad 	const struct bdevsw *d;
    662      1.11       ad 	int rv;
    663      1.11       ad 
    664      1.11       ad 	/*
    665      1.11       ad 	 * Dump can be called without the device open.  Since it can
    666      1.11       ad 	 * currently only be called with the system paused (and in a
    667      1.11       ad 	 * potentially unstable state), we don't perform any locking.
    668      1.11       ad 	 */
    669      1.11       ad 	if ((d = bdevsw_lookup(dev)) == NULL)
    670      1.11       ad 		return ENXIO;
    671      1.11       ad 
    672      1.11       ad 	/* DEV_LOCK(d); */
    673      1.11       ad 	rv = (*d->d_dump)(dev, addr, data, sz);
    674      1.11       ad 	/* DEV_UNLOCK(d); */
    675      1.11       ad 
    676      1.11       ad 	return rv;
    677      1.11       ad }
    678      1.11       ad 
    679      1.11       ad int
    680      1.11       ad bdev_type(dev_t dev)
    681      1.11       ad {
    682      1.11       ad 	const struct bdevsw *d;
    683      1.11       ad 
    684      1.11       ad 	if ((d = bdevsw_lookup(dev)) == NULL)
    685      1.11       ad 		return D_OTHER;
    686      1.11       ad 	return d->d_flag & D_TYPEMASK;
    687      1.11       ad }
    688      1.11       ad 
    689      1.11       ad int
    690      1.11       ad cdev_open(dev_t dev, int flag, int devtype, lwp_t *l)
    691      1.11       ad {
    692      1.11       ad 	const struct cdevsw *d;
    693      1.11       ad 	int rv;
    694      1.11       ad 
    695      1.11       ad 	/*
    696      1.11       ad 	 * For open we need to lock, in order to synchronize
    697      1.11       ad 	 * with attach/detach.
    698      1.11       ad 	 */
    699      1.11       ad 	mutex_enter(&devsw_lock);
    700      1.11       ad 	d = cdevsw_lookup(dev);
    701      1.11       ad 	mutex_exit(&devsw_lock);
    702      1.11       ad 	if (d == NULL)
    703      1.11       ad 		return ENXIO;
    704      1.11       ad 
    705      1.11       ad 	DEV_LOCK(d);
    706      1.11       ad 	rv = (*d->d_open)(dev, flag, devtype, l);
    707      1.11       ad 	DEV_UNLOCK(d);
    708      1.11       ad 
    709      1.11       ad 	return rv;
    710      1.11       ad }
    711      1.11       ad 
    712      1.11       ad int
    713      1.11       ad cdev_close(dev_t dev, int flag, int devtype, lwp_t *l)
    714      1.11       ad {
    715      1.11       ad 	const struct cdevsw *d;
    716      1.11       ad 	int rv;
    717      1.11       ad 
    718      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    719      1.11       ad 		return ENXIO;
    720      1.11       ad 
    721      1.11       ad 	DEV_LOCK(d);
    722      1.11       ad 	rv = (*d->d_close)(dev, flag, devtype, l);
    723      1.11       ad 	DEV_UNLOCK(d);
    724      1.11       ad 
    725      1.11       ad 	return rv;
    726      1.11       ad }
    727      1.11       ad 
    728      1.11       ad int
    729      1.11       ad cdev_read(dev_t dev, struct uio *uio, int flag)
    730      1.11       ad {
    731      1.11       ad 	const struct cdevsw *d;
    732      1.11       ad 	int rv;
    733      1.11       ad 
    734      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    735      1.11       ad 		return ENXIO;
    736      1.11       ad 
    737      1.11       ad 	DEV_LOCK(d);
    738      1.11       ad 	rv = (*d->d_read)(dev, uio, flag);
    739      1.11       ad 	DEV_UNLOCK(d);
    740      1.11       ad 
    741      1.11       ad 	return rv;
    742      1.11       ad }
    743      1.11       ad 
    744      1.11       ad int
    745      1.11       ad cdev_write(dev_t dev, struct uio *uio, int flag)
    746      1.11       ad {
    747      1.11       ad 	const struct cdevsw *d;
    748      1.11       ad 	int rv;
    749      1.11       ad 
    750      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    751      1.11       ad 		return ENXIO;
    752      1.11       ad 
    753      1.11       ad 	DEV_LOCK(d);
    754      1.11       ad 	rv = (*d->d_write)(dev, uio, flag);
    755      1.11       ad 	DEV_UNLOCK(d);
    756      1.11       ad 
    757      1.11       ad 	return rv;
    758      1.11       ad }
    759      1.11       ad 
    760      1.11       ad int
    761      1.11       ad cdev_ioctl(dev_t dev, u_long cmd, void *data, int flag, lwp_t *l)
    762      1.11       ad {
    763      1.11       ad 	const struct cdevsw *d;
    764      1.11       ad 	int rv;
    765      1.11       ad 
    766      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    767      1.11       ad 		return ENXIO;
    768      1.11       ad 
    769      1.11       ad 	DEV_LOCK(d);
    770      1.11       ad 	rv = (*d->d_ioctl)(dev, cmd, data, flag, l);
    771      1.11       ad 	DEV_UNLOCK(d);
    772      1.11       ad 
    773      1.11       ad 	return rv;
    774      1.11       ad }
    775      1.11       ad 
    776      1.11       ad void
    777      1.11       ad cdev_stop(struct tty *tp, int flag)
    778      1.11       ad {
    779      1.11       ad 	const struct cdevsw *d;
    780      1.11       ad 
    781      1.11       ad 	if ((d = cdevsw_lookup(tp->t_dev)) == NULL)
    782      1.11       ad 		return;
    783      1.11       ad 
    784      1.11       ad 	DEV_LOCK(d);
    785      1.11       ad 	(*d->d_stop)(tp, flag);
    786      1.11       ad 	DEV_UNLOCK(d);
    787      1.11       ad }
    788      1.11       ad 
    789      1.11       ad struct tty *
    790      1.11       ad cdev_tty(dev_t dev)
    791      1.11       ad {
    792      1.11       ad 	const struct cdevsw *d;
    793      1.11       ad 	struct tty * rv;
    794      1.11       ad 
    795      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    796      1.11       ad 		return NULL;
    797      1.11       ad 
    798      1.12       ad 	/* XXX Check if necessary. */
    799      1.12       ad 	if (d->d_tty == NULL)
    800      1.12       ad 		return NULL;
    801      1.12       ad 
    802      1.11       ad 	DEV_LOCK(d);
    803      1.11       ad 	rv = (*d->d_tty)(dev);
    804      1.11       ad 	DEV_UNLOCK(d);
    805      1.11       ad 
    806      1.11       ad 	return rv;
    807      1.11       ad }
    808      1.11       ad 
    809      1.11       ad int
    810      1.11       ad cdev_poll(dev_t dev, int flag, lwp_t *l)
    811      1.11       ad {
    812      1.11       ad 	const struct cdevsw *d;
    813      1.11       ad 	int rv;
    814      1.11       ad 
    815      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    816      1.11       ad 		return POLLERR;
    817      1.11       ad 
    818      1.11       ad 	DEV_LOCK(d);
    819      1.11       ad 	rv = (*d->d_poll)(dev, flag, l);
    820      1.11       ad 	DEV_UNLOCK(d);
    821      1.11       ad 
    822      1.11       ad 	return rv;
    823      1.11       ad }
    824      1.11       ad 
    825      1.11       ad paddr_t
    826      1.11       ad cdev_mmap(dev_t dev, off_t off, int flag)
    827      1.11       ad {
    828      1.11       ad 	const struct cdevsw *d;
    829      1.11       ad 	paddr_t rv;
    830      1.11       ad 
    831      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    832      1.11       ad 		return (paddr_t)-1LL;
    833      1.11       ad 
    834      1.11       ad 	DEV_LOCK(d);
    835      1.11       ad 	rv = (*d->d_mmap)(dev, off, flag);
    836      1.11       ad 	DEV_UNLOCK(d);
    837      1.11       ad 
    838      1.11       ad 	return rv;
    839      1.11       ad }
    840      1.11       ad 
    841      1.11       ad int
    842      1.11       ad cdev_kqfilter(dev_t dev, struct knote *kn)
    843      1.11       ad {
    844      1.11       ad 	const struct cdevsw *d;
    845      1.11       ad 	int rv;
    846      1.11       ad 
    847      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    848      1.11       ad 		return ENXIO;
    849      1.11       ad 
    850      1.11       ad 	DEV_LOCK(d);
    851      1.11       ad 	rv = (*d->d_kqfilter)(dev, kn);
    852      1.11       ad 	DEV_UNLOCK(d);
    853      1.11       ad 
    854      1.11       ad 	return rv;
    855      1.11       ad }
    856      1.11       ad 
    857      1.11       ad int
    858      1.11       ad cdev_type(dev_t dev)
    859      1.11       ad {
    860      1.11       ad 	const struct cdevsw *d;
    861      1.11       ad 
    862      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    863      1.11       ad 		return D_OTHER;
    864      1.11       ad 	return d->d_flag & D_TYPEMASK;
    865       1.2  gehenna }
    866