Home | History | Annotate | Line # | Download | only in kern
subr_devsw.c revision 1.12.4.3
      1  1.12.4.3      mjf /*	$NetBSD: subr_devsw.c,v 1.12.4.3 2008/02/18 21:06:47 mjf 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.4.3      mjf __KERNEL_RCSID(0, "$NetBSD: subr_devsw.c,v 1.12.4.3 2008/02/18 21:06:47 mjf 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.12.4.3      mjf #include <sys/cpu.h>
     88      1.11       ad #include <sys/buf.h>
     89       1.2  gehenna 
     90       1.2  gehenna #ifdef DEVSW_DEBUG
     91       1.2  gehenna #define	DPRINTF(x)	printf x
     92       1.2  gehenna #else /* DEVSW_DEBUG */
     93       1.2  gehenna #define	DPRINTF(x)
     94       1.2  gehenna #endif /* DEVSW_DEBUG */
     95       1.2  gehenna 
     96      1.11       ad #define	MAXDEVSW	512	/* the maximum of major device number */
     97       1.2  gehenna #define	BDEVSW_SIZE	(sizeof(struct bdevsw *))
     98       1.2  gehenna #define	CDEVSW_SIZE	(sizeof(struct cdevsw *))
     99       1.2  gehenna #define	DEVSWCONV_SIZE	(sizeof(struct devsw_conv))
    100       1.2  gehenna 
    101       1.2  gehenna extern const struct bdevsw **bdevsw, *bdevsw0[];
    102       1.2  gehenna extern const struct cdevsw **cdevsw, *cdevsw0[];
    103       1.2  gehenna extern struct devsw_conv *devsw_conv, devsw_conv0[];
    104       1.2  gehenna extern const int sys_bdevsws, sys_cdevsws;
    105       1.2  gehenna extern int max_bdevsws, max_cdevsws, max_devsw_convs;
    106       1.2  gehenna 
    107  1.12.4.2      mjf static int bdevsw_attach(const struct bdevsw *, int *);
    108  1.12.4.2      mjf static int cdevsw_attach(const struct cdevsw *, int *);
    109      1.11       ad static void devsw_detach_locked(const struct bdevsw *, const struct cdevsw *);
    110      1.11       ad 
    111  1.12.4.1      mjf kmutex_t devsw_lock;
    112      1.11       ad 
    113      1.11       ad void
    114      1.11       ad devsw_init(void)
    115      1.11       ad {
    116      1.11       ad 
    117      1.11       ad 	KASSERT(sys_bdevsws < MAXDEVSW - 1);
    118      1.11       ad 	KASSERT(sys_cdevsws < MAXDEVSW - 1);
    119      1.11       ad 
    120      1.11       ad 	mutex_init(&devsw_lock, MUTEX_DEFAULT, IPL_NONE);
    121      1.11       ad }
    122       1.2  gehenna 
    123       1.2  gehenna int
    124       1.2  gehenna devsw_attach(const char *devname, const struct bdevsw *bdev, int *bmajor,
    125       1.2  gehenna 	     const struct cdevsw *cdev, int *cmajor)
    126       1.2  gehenna {
    127       1.2  gehenna 	struct devsw_conv *conv;
    128       1.2  gehenna 	char *name;
    129       1.2  gehenna 	int error, i;
    130       1.2  gehenna 
    131       1.2  gehenna 	if (devname == NULL || cdev == NULL)
    132       1.2  gehenna 		return (EINVAL);
    133       1.2  gehenna 
    134      1.11       ad 	mutex_enter(&devsw_lock);
    135      1.11       ad 
    136       1.2  gehenna 	for (i = 0 ; i < max_devsw_convs ; i++) {
    137       1.2  gehenna 		conv = &devsw_conv[i];
    138       1.2  gehenna 		if (conv->d_name == NULL || strcmp(devname, conv->d_name) != 0)
    139       1.2  gehenna 			continue;
    140       1.2  gehenna 
    141       1.2  gehenna 		if (*bmajor < 0)
    142       1.2  gehenna 			*bmajor = conv->d_bmajor;
    143       1.2  gehenna 		if (*cmajor < 0)
    144       1.2  gehenna 			*cmajor = conv->d_cmajor;
    145       1.2  gehenna 
    146      1.11       ad 		if (*bmajor != conv->d_bmajor || *cmajor != conv->d_cmajor) {
    147      1.11       ad 			error = EINVAL;
    148      1.11       ad 			goto fail;
    149      1.11       ad 		}
    150      1.11       ad 		if ((*bmajor >= 0 && bdev == NULL) || *cmajor < 0) {
    151      1.11       ad 			error = EINVAL;
    152      1.11       ad 			goto fail;
    153      1.11       ad 		}
    154       1.2  gehenna 
    155       1.2  gehenna 		if ((*bmajor >= 0 && bdevsw[*bmajor] != NULL) ||
    156      1.11       ad 		    cdevsw[*cmajor] != NULL) {
    157      1.11       ad 			error = EEXIST;
    158      1.11       ad 			goto fail;
    159      1.11       ad 		}
    160       1.2  gehenna 
    161       1.2  gehenna 		if (bdev != NULL)
    162       1.2  gehenna 			bdevsw[*bmajor] = bdev;
    163       1.2  gehenna 		cdevsw[*cmajor] = cdev;
    164       1.2  gehenna 
    165      1.11       ad 		mutex_exit(&devsw_lock);
    166       1.2  gehenna 		return (0);
    167       1.2  gehenna 	}
    168       1.2  gehenna 
    169  1.12.4.2      mjf 	error = bdevsw_attach(bdev, bmajor);
    170      1.11       ad 	if (error != 0)
    171      1.11       ad 		goto fail;
    172  1.12.4.2      mjf 	error = cdevsw_attach(cdev, cmajor);
    173       1.2  gehenna 	if (error != 0) {
    174      1.11       ad 		devsw_detach_locked(bdev, NULL);
    175      1.11       ad 		goto fail;
    176       1.2  gehenna 	}
    177       1.2  gehenna 
    178       1.2  gehenna 	for (i = 0 ; i < max_devsw_convs ; i++) {
    179       1.2  gehenna 		if (devsw_conv[i].d_name == NULL)
    180       1.2  gehenna 			break;
    181       1.2  gehenna 	}
    182       1.2  gehenna 	if (i == max_devsw_convs) {
    183       1.2  gehenna 		struct devsw_conv *newptr;
    184       1.2  gehenna 		int old, new;
    185       1.2  gehenna 
    186       1.2  gehenna 		old = max_devsw_convs;
    187       1.2  gehenna 		new = old + 1;
    188       1.2  gehenna 
    189      1.11       ad 		newptr = kmem_zalloc(new * DEVSWCONV_SIZE, KM_NOSLEEP);
    190       1.2  gehenna 		if (newptr == NULL) {
    191      1.11       ad 			devsw_detach_locked(bdev, cdev);
    192      1.11       ad 			error = ENOMEM;
    193      1.11       ad 			goto fail;
    194       1.2  gehenna 		}
    195       1.2  gehenna 		newptr[old].d_name = NULL;
    196       1.2  gehenna 		newptr[old].d_bmajor = -1;
    197       1.2  gehenna 		newptr[old].d_cmajor = -1;
    198       1.2  gehenna 		memcpy(newptr, devsw_conv, old * DEVSWCONV_SIZE);
    199       1.2  gehenna 		if (devsw_conv != devsw_conv0)
    200      1.11       ad 			kmem_free(devsw_conv, old * DEVSWCONV_SIZE);
    201       1.2  gehenna 		devsw_conv = newptr;
    202       1.2  gehenna 		max_devsw_convs = new;
    203       1.2  gehenna 	}
    204       1.2  gehenna 
    205       1.6   itojun 	i = strlen(devname) + 1;
    206      1.11       ad 	name = kmem_alloc(i, KM_NOSLEEP);
    207       1.2  gehenna 	if (name == NULL) {
    208      1.11       ad 		devsw_detach_locked(bdev, cdev);
    209      1.11       ad 		goto fail;
    210       1.2  gehenna 	}
    211       1.6   itojun 	strlcpy(name, devname, i);
    212       1.2  gehenna 
    213       1.2  gehenna 	devsw_conv[i].d_name = name;
    214       1.2  gehenna 	devsw_conv[i].d_bmajor = *bmajor;
    215       1.2  gehenna 	devsw_conv[i].d_cmajor = *cmajor;
    216       1.2  gehenna 
    217      1.11       ad 	mutex_exit(&devsw_lock);
    218       1.2  gehenna 	return (0);
    219      1.11       ad  fail:
    220      1.11       ad 	mutex_exit(&devsw_lock);
    221      1.11       ad 	return (error);
    222       1.2  gehenna }
    223       1.2  gehenna 
    224       1.2  gehenna static int
    225  1.12.4.2      mjf bdevsw_attach(const struct bdevsw *devsw, int *devmajor)
    226       1.2  gehenna {
    227      1.11       ad 	const struct bdevsw **newptr;
    228       1.2  gehenna 	int bmajor, i;
    229       1.2  gehenna 
    230      1.11       ad 	KASSERT(mutex_owned(&devsw_lock));
    231      1.11       ad 
    232       1.2  gehenna 	if (devsw == NULL)
    233       1.2  gehenna 		return (0);
    234       1.2  gehenna 
    235       1.2  gehenna 	if (*devmajor < 0) {
    236       1.2  gehenna 		for (bmajor = sys_bdevsws ; bmajor < max_bdevsws ; bmajor++) {
    237       1.2  gehenna 			if (bdevsw[bmajor] != NULL)
    238       1.2  gehenna 				continue;
    239       1.2  gehenna 			for (i = 0 ; i < max_devsw_convs ; i++) {
    240       1.2  gehenna 				if (devsw_conv[i].d_bmajor == bmajor)
    241       1.2  gehenna 					break;
    242       1.2  gehenna 			}
    243       1.2  gehenna 			if (i != max_devsw_convs)
    244       1.2  gehenna 				continue;
    245       1.2  gehenna 			break;
    246       1.2  gehenna 		}
    247       1.3  gehenna 		*devmajor = bmajor;
    248       1.2  gehenna 	}
    249      1.11       ad 
    250       1.2  gehenna 	if (*devmajor >= MAXDEVSW) {
    251      1.11       ad 		printf("bdevsw_attach: block majors exhausted");
    252       1.2  gehenna 		return (ENOMEM);
    253       1.2  gehenna 	}
    254       1.2  gehenna 
    255       1.2  gehenna 	if (*devmajor >= max_bdevsws) {
    256      1.11       ad 		KASSERT(bdevsw == bdevsw0);
    257      1.11       ad 		newptr = kmem_zalloc(MAXDEVSW * BDEVSW_SIZE, KM_NOSLEEP);
    258       1.2  gehenna 		if (newptr == NULL)
    259       1.2  gehenna 			return (ENOMEM);
    260      1.11       ad 		memcpy(newptr, bdevsw, max_bdevsws * BDEVSW_SIZE);
    261       1.2  gehenna 		bdevsw = newptr;
    262      1.11       ad 		max_bdevsws = MAXDEVSW;
    263       1.2  gehenna 	}
    264       1.2  gehenna 
    265       1.2  gehenna 	if (bdevsw[*devmajor] != NULL)
    266       1.2  gehenna 		return (EEXIST);
    267       1.2  gehenna 
    268       1.2  gehenna 	bdevsw[*devmajor] = devsw;
    269       1.2  gehenna 
    270       1.2  gehenna 	return (0);
    271       1.2  gehenna }
    272       1.2  gehenna 
    273       1.2  gehenna static int
    274  1.12.4.2      mjf cdevsw_attach(const struct cdevsw *devsw, int *devmajor)
    275       1.2  gehenna {
    276      1.11       ad 	const struct cdevsw **newptr;
    277       1.2  gehenna 	int cmajor, i;
    278       1.2  gehenna 
    279      1.11       ad 	KASSERT(mutex_owned(&devsw_lock));
    280      1.11       ad 
    281       1.2  gehenna 	if (*devmajor < 0) {
    282       1.2  gehenna 		for (cmajor = sys_cdevsws ; cmajor < max_cdevsws ; cmajor++) {
    283       1.2  gehenna 			if (cdevsw[cmajor] != NULL)
    284       1.2  gehenna 				continue;
    285       1.2  gehenna 			for (i = 0 ; i < max_devsw_convs ; i++) {
    286       1.2  gehenna 				if (devsw_conv[i].d_cmajor == cmajor)
    287       1.2  gehenna 					break;
    288       1.2  gehenna 			}
    289       1.2  gehenna 			if (i != max_devsw_convs)
    290       1.2  gehenna 				continue;
    291       1.2  gehenna 			break;
    292       1.2  gehenna 		}
    293       1.3  gehenna 		*devmajor = cmajor;
    294       1.2  gehenna 	}
    295      1.11       ad 
    296       1.2  gehenna 	if (*devmajor >= MAXDEVSW) {
    297      1.11       ad 		printf("cdevsw_attach: character majors exhausted");
    298       1.2  gehenna 		return (ENOMEM);
    299       1.2  gehenna 	}
    300       1.2  gehenna 
    301       1.2  gehenna 	if (*devmajor >= max_cdevsws) {
    302      1.11       ad 		KASSERT(cdevsw == cdevsw0);
    303      1.11       ad 		newptr = kmem_zalloc(MAXDEVSW * CDEVSW_SIZE, KM_NOSLEEP);
    304       1.2  gehenna 		if (newptr == NULL)
    305       1.2  gehenna 			return (ENOMEM);
    306      1.11       ad 		memcpy(newptr, cdevsw, max_cdevsws * CDEVSW_SIZE);
    307       1.2  gehenna 		cdevsw = newptr;
    308      1.11       ad 		max_cdevsws = MAXDEVSW;
    309       1.2  gehenna 	}
    310       1.2  gehenna 
    311       1.2  gehenna 	if (cdevsw[*devmajor] != NULL)
    312       1.2  gehenna 		return (EEXIST);
    313       1.2  gehenna 
    314       1.2  gehenna 	cdevsw[*devmajor] = devsw;
    315       1.2  gehenna 
    316       1.2  gehenna 	return (0);
    317       1.2  gehenna }
    318       1.2  gehenna 
    319      1.11       ad static void
    320      1.11       ad devsw_detach_locked(const struct bdevsw *bdev, const struct cdevsw *cdev)
    321       1.2  gehenna {
    322       1.2  gehenna 	int i;
    323       1.2  gehenna 
    324      1.11       ad 	KASSERT(mutex_owned(&devsw_lock));
    325      1.11       ad 
    326       1.2  gehenna 	if (bdev != NULL) {
    327       1.2  gehenna 		for (i = 0 ; i < max_bdevsws ; i++) {
    328       1.2  gehenna 			if (bdevsw[i] != bdev)
    329       1.2  gehenna 				continue;
    330       1.2  gehenna 			bdevsw[i] = NULL;
    331       1.2  gehenna 			break;
    332       1.2  gehenna 		}
    333       1.2  gehenna 	}
    334       1.2  gehenna 	if (cdev != NULL) {
    335       1.2  gehenna 		for (i = 0 ; i < max_cdevsws ; i++) {
    336       1.2  gehenna 			if (cdevsw[i] != cdev)
    337       1.2  gehenna 				continue;
    338       1.2  gehenna 			cdevsw[i] = NULL;
    339       1.2  gehenna 			break;
    340       1.2  gehenna 		}
    341       1.2  gehenna 	}
    342       1.2  gehenna }
    343       1.2  gehenna 
    344      1.11       ad void
    345      1.11       ad devsw_detach(const struct bdevsw *bdev, const struct cdevsw *cdev)
    346      1.11       ad {
    347      1.11       ad 
    348      1.11       ad 	mutex_enter(&devsw_lock);
    349      1.11       ad 	devsw_detach_locked(bdev, cdev);
    350      1.11       ad 	mutex_exit(&devsw_lock);
    351      1.11       ad }
    352      1.11       ad 
    353      1.11       ad /*
    354      1.11       ad  * Look up a block device by number.
    355      1.11       ad  *
    356      1.11       ad  * => Caller must ensure that the device is attached.
    357      1.11       ad  */
    358       1.2  gehenna const struct bdevsw *
    359       1.2  gehenna bdevsw_lookup(dev_t dev)
    360       1.2  gehenna {
    361       1.2  gehenna 	int bmajor;
    362       1.2  gehenna 
    363       1.2  gehenna 	if (dev == NODEV)
    364       1.2  gehenna 		return (NULL);
    365       1.2  gehenna 	bmajor = major(dev);
    366       1.2  gehenna 	if (bmajor < 0 || bmajor >= max_bdevsws)
    367       1.2  gehenna 		return (NULL);
    368       1.2  gehenna 
    369       1.2  gehenna 	return (bdevsw[bmajor]);
    370       1.2  gehenna }
    371       1.2  gehenna 
    372      1.11       ad /*
    373      1.11       ad  * Look up a character device by number.
    374      1.11       ad  *
    375      1.11       ad  * => Caller must ensure that the device is attached.
    376      1.11       ad  */
    377       1.2  gehenna const struct cdevsw *
    378       1.2  gehenna cdevsw_lookup(dev_t dev)
    379       1.2  gehenna {
    380       1.2  gehenna 	int cmajor;
    381       1.2  gehenna 
    382       1.2  gehenna 	if (dev == NODEV)
    383       1.2  gehenna 		return (NULL);
    384       1.2  gehenna 	cmajor = major(dev);
    385       1.2  gehenna 	if (cmajor < 0 || cmajor >= max_cdevsws)
    386       1.2  gehenna 		return (NULL);
    387       1.2  gehenna 
    388       1.2  gehenna 	return (cdevsw[cmajor]);
    389       1.2  gehenna }
    390       1.2  gehenna 
    391      1.11       ad /*
    392      1.11       ad  * Look up a block device by reference to its operations set.
    393      1.11       ad  *
    394      1.11       ad  * => Caller must ensure that the device is not detached, and therefore
    395      1.11       ad  *    that the returned major is still valid when dereferenced.
    396      1.11       ad  */
    397       1.2  gehenna int
    398       1.2  gehenna bdevsw_lookup_major(const struct bdevsw *bdev)
    399       1.2  gehenna {
    400       1.2  gehenna 	int bmajor;
    401       1.2  gehenna 
    402       1.2  gehenna 	for (bmajor = 0 ; bmajor < max_bdevsws ; bmajor++) {
    403       1.2  gehenna 		if (bdevsw[bmajor] == bdev)
    404       1.2  gehenna 			return (bmajor);
    405       1.2  gehenna 	}
    406       1.2  gehenna 
    407       1.2  gehenna 	return (-1);
    408       1.2  gehenna }
    409       1.2  gehenna 
    410      1.11       ad /*
    411      1.11       ad  * Look up a character device by reference to its operations set.
    412      1.11       ad  *
    413      1.11       ad  * => Caller must ensure that the device is not detached, and therefore
    414      1.11       ad  *    that the returned major is still valid when dereferenced.
    415      1.11       ad  */
    416       1.2  gehenna int
    417       1.2  gehenna cdevsw_lookup_major(const struct cdevsw *cdev)
    418       1.2  gehenna {
    419       1.2  gehenna 	int cmajor;
    420       1.2  gehenna 
    421       1.2  gehenna 	for (cmajor = 0 ; cmajor < max_cdevsws ; cmajor++) {
    422       1.2  gehenna 		if (cdevsw[cmajor] == cdev)
    423       1.2  gehenna 			return (cmajor);
    424       1.2  gehenna 	}
    425       1.2  gehenna 
    426       1.2  gehenna 	return (-1);
    427       1.2  gehenna }
    428       1.2  gehenna 
    429       1.2  gehenna /*
    430       1.2  gehenna  * Convert from block major number to name.
    431      1.11       ad  *
    432      1.11       ad  * => Caller must ensure that the device is not detached, and therefore
    433      1.11       ad  *    that the name pointer is still valid when dereferenced.
    434       1.2  gehenna  */
    435       1.2  gehenna const char *
    436       1.2  gehenna devsw_blk2name(int bmajor)
    437       1.2  gehenna {
    438      1.11       ad 	const char *name;
    439       1.2  gehenna 	int cmajor, i;
    440       1.2  gehenna 
    441      1.11       ad 	name = NULL;
    442      1.11       ad 	cmajor = -1;
    443      1.11       ad 
    444      1.11       ad 	mutex_enter(&devsw_lock);
    445      1.11       ad 	if (bmajor < 0 || bmajor >= max_bdevsws || bdevsw[bmajor] == NULL) {
    446      1.11       ad 		mutex_exit(&devsw_lock);
    447       1.2  gehenna 		return (NULL);
    448       1.2  gehenna 	}
    449      1.11       ad 	for (i = 0 ; i < max_devsw_convs; i++) {
    450      1.11       ad 		if (devsw_conv[i].d_bmajor == bmajor) {
    451      1.11       ad 			cmajor = devsw_conv[i].d_cmajor;
    452      1.11       ad 			break;
    453      1.11       ad 		}
    454      1.11       ad 	}
    455      1.11       ad 	if (cmajor >= 0 && cmajor < max_cdevsws && cdevsw[cmajor] != NULL)
    456      1.11       ad 		name = devsw_conv[i].d_name;
    457      1.11       ad 	mutex_exit(&devsw_lock);
    458       1.2  gehenna 
    459      1.11       ad 	return (name);
    460       1.2  gehenna }
    461       1.2  gehenna 
    462       1.2  gehenna /*
    463       1.2  gehenna  * Convert from device name to block major number.
    464      1.11       ad  *
    465      1.11       ad  * => Caller must ensure that the device is not detached, and therefore
    466      1.11       ad  *    that the major number is still valid when dereferenced.
    467       1.2  gehenna  */
    468       1.2  gehenna int
    469       1.2  gehenna devsw_name2blk(const char *name, char *devname, size_t devnamelen)
    470       1.2  gehenna {
    471       1.2  gehenna 	struct devsw_conv *conv;
    472       1.2  gehenna 	int bmajor, i;
    473       1.2  gehenna 
    474       1.2  gehenna 	if (name == NULL)
    475       1.2  gehenna 		return (-1);
    476       1.2  gehenna 
    477      1.11       ad 	mutex_enter(&devsw_lock);
    478       1.2  gehenna 	for (i = 0 ; i < max_devsw_convs ; i++) {
    479       1.5      mrg 		size_t len;
    480       1.5      mrg 
    481       1.2  gehenna 		conv = &devsw_conv[i];
    482       1.2  gehenna 		if (conv->d_name == NULL)
    483       1.2  gehenna 			continue;
    484       1.5      mrg 		len = strlen(conv->d_name);
    485       1.5      mrg 		if (strncmp(conv->d_name, name, len) != 0)
    486       1.5      mrg 			continue;
    487       1.5      mrg 		if (*(name +len) && !isdigit(*(name + len)))
    488       1.2  gehenna 			continue;
    489       1.2  gehenna 		bmajor = conv->d_bmajor;
    490       1.2  gehenna 		if (bmajor < 0 || bmajor >= max_bdevsws ||
    491       1.2  gehenna 		    bdevsw[bmajor] == NULL)
    492       1.5      mrg 			break;
    493       1.2  gehenna 		if (devname != NULL) {
    494       1.2  gehenna #ifdef DEVSW_DEBUG
    495       1.2  gehenna 			if (strlen(conv->d_name) >= devnamelen)
    496       1.2  gehenna 				printf("devsw_name2blk: too short buffer");
    497       1.2  gehenna #endif /* DEVSW_DEBUG */
    498       1.4  tsutsui 			strncpy(devname, conv->d_name, devnamelen);
    499       1.2  gehenna 			devname[devnamelen - 1] = '\0';
    500       1.2  gehenna 		}
    501      1.11       ad 		mutex_exit(&devsw_lock);
    502       1.2  gehenna 		return (bmajor);
    503       1.2  gehenna 	}
    504       1.2  gehenna 
    505      1.11       ad 	mutex_exit(&devsw_lock);
    506       1.2  gehenna 	return (-1);
    507       1.2  gehenna }
    508       1.2  gehenna 
    509       1.2  gehenna /*
    510       1.2  gehenna  * Convert from character dev_t to block dev_t.
    511      1.11       ad  *
    512      1.11       ad  * => Caller must ensure that the device is not detached, and therefore
    513      1.11       ad  *    that the major number is still valid when dereferenced.
    514       1.2  gehenna  */
    515       1.2  gehenna dev_t
    516       1.2  gehenna devsw_chr2blk(dev_t cdev)
    517       1.2  gehenna {
    518       1.2  gehenna 	int bmajor, cmajor, i;
    519      1.11       ad 	dev_t rv;
    520       1.2  gehenna 
    521       1.2  gehenna 	cmajor = major(cdev);
    522      1.11       ad 	bmajor = -1;
    523      1.11       ad 	rv = NODEV;
    524       1.2  gehenna 
    525      1.11       ad 	mutex_enter(&devsw_lock);
    526      1.11       ad 	if (cmajor < 0 || cmajor >= max_cdevsws || cdevsw[cmajor] == NULL) {
    527      1.11       ad 		mutex_exit(&devsw_lock);
    528      1.11       ad 		return (NODEV);
    529      1.11       ad 	}
    530       1.2  gehenna 	for (i = 0 ; i < max_devsw_convs ; i++) {
    531      1.11       ad 		if (devsw_conv[i].d_cmajor == cmajor) {
    532      1.11       ad 			bmajor = devsw_conv[i].d_bmajor;
    533      1.11       ad 			break;
    534      1.11       ad 		}
    535       1.2  gehenna 	}
    536      1.11       ad 	if (bmajor >= 0 && bmajor < max_bdevsws && bdevsw[bmajor] != NULL)
    537      1.11       ad 		rv = makedev(bmajor, minor(cdev));
    538      1.11       ad 	mutex_exit(&devsw_lock);
    539       1.2  gehenna 
    540      1.11       ad 	return (rv);
    541       1.2  gehenna }
    542       1.2  gehenna 
    543       1.2  gehenna /*
    544       1.2  gehenna  * Convert from block dev_t to character dev_t.
    545      1.11       ad  *
    546      1.11       ad  * => Caller must ensure that the device is not detached, and therefore
    547      1.11       ad  *    that the major number is still valid when dereferenced.
    548       1.2  gehenna  */
    549       1.2  gehenna dev_t
    550       1.2  gehenna devsw_blk2chr(dev_t bdev)
    551       1.2  gehenna {
    552       1.2  gehenna 	int bmajor, cmajor, i;
    553      1.11       ad 	dev_t rv;
    554       1.2  gehenna 
    555      1.11       ad 	bmajor = major(bdev);
    556      1.11       ad 	cmajor = -1;
    557      1.11       ad 	rv = NODEV;
    558      1.11       ad 
    559      1.11       ad 	mutex_enter(&devsw_lock);
    560      1.11       ad 	if (bmajor < 0 || bmajor >= max_bdevsws || bdevsw[bmajor] == NULL) {
    561      1.11       ad 		mutex_exit(&devsw_lock);
    562       1.2  gehenna 		return (NODEV);
    563      1.11       ad 	}
    564      1.11       ad 	for (i = 0 ; i < max_devsw_convs ; i++) {
    565      1.11       ad 		if (devsw_conv[i].d_bmajor == bmajor) {
    566      1.11       ad 			cmajor = devsw_conv[i].d_cmajor;
    567      1.11       ad 			break;
    568      1.11       ad 		}
    569      1.11       ad 	}
    570      1.11       ad 	if (cmajor >= 0 && cmajor < max_cdevsws && cdevsw[cmajor] != NULL)
    571      1.11       ad 		rv = makedev(cmajor, minor(bdev));
    572      1.11       ad 	mutex_exit(&devsw_lock);
    573       1.2  gehenna 
    574      1.11       ad 	return (rv);
    575      1.11       ad }
    576      1.11       ad 
    577      1.11       ad /*
    578      1.11       ad  * Device access methods.
    579      1.11       ad  */
    580      1.11       ad 
    581      1.11       ad #define	DEV_LOCK(d)						\
    582      1.11       ad 	if ((d->d_flag & D_MPSAFE) == 0) {			\
    583      1.11       ad 		KERNEL_LOCK(1, curlwp);				\
    584      1.11       ad 	}
    585       1.2  gehenna 
    586      1.11       ad #define	DEV_UNLOCK(d)						\
    587      1.11       ad 	if ((d->d_flag & D_MPSAFE) == 0) {			\
    588      1.11       ad 		KERNEL_UNLOCK_ONE(curlwp);			\
    589       1.2  gehenna 	}
    590       1.2  gehenna 
    591      1.11       ad int
    592      1.11       ad bdev_open(dev_t dev, int flag, int devtype, lwp_t *l)
    593      1.11       ad {
    594      1.11       ad 	const struct bdevsw *d;
    595      1.11       ad 	int rv;
    596      1.11       ad 
    597      1.11       ad 	/*
    598      1.11       ad 	 * For open we need to lock, in order to synchronize
    599      1.11       ad 	 * with attach/detach.
    600      1.11       ad 	 */
    601      1.11       ad 	mutex_enter(&devsw_lock);
    602      1.11       ad 	d = bdevsw_lookup(dev);
    603      1.11       ad 	mutex_exit(&devsw_lock);
    604      1.11       ad 	if (d == NULL)
    605      1.11       ad 		return ENXIO;
    606      1.11       ad 
    607      1.11       ad 	DEV_LOCK(d);
    608      1.11       ad 	rv = (*d->d_open)(dev, flag, devtype, l);
    609      1.11       ad 	DEV_UNLOCK(d);
    610      1.11       ad 
    611      1.11       ad 	return rv;
    612      1.11       ad }
    613      1.11       ad 
    614      1.11       ad int
    615      1.11       ad bdev_close(dev_t dev, int flag, int devtype, lwp_t *l)
    616      1.11       ad {
    617      1.11       ad 	const struct bdevsw *d;
    618      1.11       ad 	int rv;
    619      1.11       ad 
    620      1.11       ad 	if ((d = bdevsw_lookup(dev)) == NULL)
    621      1.11       ad 		return ENXIO;
    622      1.11       ad 
    623      1.11       ad 	DEV_LOCK(d);
    624      1.11       ad 	rv = (*d->d_close)(dev, flag, devtype, l);
    625      1.11       ad 	DEV_UNLOCK(d);
    626      1.11       ad 
    627      1.11       ad 	return rv;
    628      1.11       ad }
    629      1.11       ad 
    630      1.11       ad void
    631      1.11       ad bdev_strategy(struct buf *bp)
    632      1.11       ad {
    633      1.11       ad 	const struct bdevsw *d;
    634      1.11       ad 
    635      1.11       ad 	if ((d = bdevsw_lookup(bp->b_dev)) == NULL)
    636      1.11       ad 		panic("bdev_strategy");
    637      1.11       ad 
    638      1.11       ad 	DEV_LOCK(d);
    639      1.11       ad 	(*d->d_strategy)(bp);
    640      1.11       ad 	DEV_UNLOCK(d);
    641      1.11       ad }
    642      1.11       ad 
    643      1.11       ad int
    644      1.11       ad bdev_ioctl(dev_t dev, u_long cmd, void *data, int flag, lwp_t *l)
    645      1.11       ad {
    646      1.11       ad 	const struct bdevsw *d;
    647      1.11       ad 	int rv;
    648      1.11       ad 
    649      1.11       ad 	if ((d = bdevsw_lookup(dev)) == NULL)
    650      1.11       ad 		return ENXIO;
    651      1.11       ad 
    652      1.11       ad 	DEV_LOCK(d);
    653      1.11       ad 	rv = (*d->d_ioctl)(dev, cmd, data, flag, l);
    654      1.11       ad 	DEV_UNLOCK(d);
    655      1.11       ad 
    656      1.11       ad 	return rv;
    657      1.11       ad }
    658      1.11       ad 
    659      1.11       ad int
    660      1.11       ad bdev_dump(dev_t dev, daddr_t addr, void *data, size_t sz)
    661      1.11       ad {
    662      1.11       ad 	const struct bdevsw *d;
    663      1.11       ad 	int rv;
    664      1.11       ad 
    665      1.11       ad 	/*
    666      1.11       ad 	 * Dump can be called without the device open.  Since it can
    667      1.11       ad 	 * currently only be called with the system paused (and in a
    668      1.11       ad 	 * potentially unstable state), we don't perform any locking.
    669      1.11       ad 	 */
    670      1.11       ad 	if ((d = bdevsw_lookup(dev)) == NULL)
    671      1.11       ad 		return ENXIO;
    672      1.11       ad 
    673      1.11       ad 	/* DEV_LOCK(d); */
    674      1.11       ad 	rv = (*d->d_dump)(dev, addr, data, sz);
    675      1.11       ad 	/* DEV_UNLOCK(d); */
    676      1.11       ad 
    677      1.11       ad 	return rv;
    678      1.11       ad }
    679      1.11       ad 
    680      1.11       ad int
    681      1.11       ad bdev_type(dev_t dev)
    682      1.11       ad {
    683      1.11       ad 	const struct bdevsw *d;
    684      1.11       ad 
    685      1.11       ad 	if ((d = bdevsw_lookup(dev)) == NULL)
    686      1.11       ad 		return D_OTHER;
    687      1.11       ad 	return d->d_flag & D_TYPEMASK;
    688      1.11       ad }
    689      1.11       ad 
    690      1.11       ad int
    691      1.11       ad cdev_open(dev_t dev, int flag, int devtype, lwp_t *l)
    692      1.11       ad {
    693      1.11       ad 	const struct cdevsw *d;
    694      1.11       ad 	int rv;
    695      1.11       ad 
    696      1.11       ad 	/*
    697      1.11       ad 	 * For open we need to lock, in order to synchronize
    698      1.11       ad 	 * with attach/detach.
    699      1.11       ad 	 */
    700      1.11       ad 	mutex_enter(&devsw_lock);
    701      1.11       ad 	d = cdevsw_lookup(dev);
    702      1.11       ad 	mutex_exit(&devsw_lock);
    703      1.11       ad 	if (d == NULL)
    704      1.11       ad 		return ENXIO;
    705      1.11       ad 
    706      1.11       ad 	DEV_LOCK(d);
    707      1.11       ad 	rv = (*d->d_open)(dev, flag, devtype, l);
    708      1.11       ad 	DEV_UNLOCK(d);
    709      1.11       ad 
    710      1.11       ad 	return rv;
    711      1.11       ad }
    712      1.11       ad 
    713      1.11       ad int
    714      1.11       ad cdev_close(dev_t dev, int flag, int devtype, lwp_t *l)
    715      1.11       ad {
    716      1.11       ad 	const struct cdevsw *d;
    717      1.11       ad 	int rv;
    718      1.11       ad 
    719      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    720      1.11       ad 		return ENXIO;
    721      1.11       ad 
    722      1.11       ad 	DEV_LOCK(d);
    723      1.11       ad 	rv = (*d->d_close)(dev, flag, devtype, l);
    724      1.11       ad 	DEV_UNLOCK(d);
    725      1.11       ad 
    726      1.11       ad 	return rv;
    727      1.11       ad }
    728      1.11       ad 
    729      1.11       ad int
    730      1.11       ad cdev_read(dev_t dev, struct uio *uio, int flag)
    731      1.11       ad {
    732      1.11       ad 	const struct cdevsw *d;
    733      1.11       ad 	int rv;
    734      1.11       ad 
    735      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    736      1.11       ad 		return ENXIO;
    737      1.11       ad 
    738      1.11       ad 	DEV_LOCK(d);
    739      1.11       ad 	rv = (*d->d_read)(dev, uio, flag);
    740      1.11       ad 	DEV_UNLOCK(d);
    741      1.11       ad 
    742      1.11       ad 	return rv;
    743      1.11       ad }
    744      1.11       ad 
    745      1.11       ad int
    746      1.11       ad cdev_write(dev_t dev, struct uio *uio, int flag)
    747      1.11       ad {
    748      1.11       ad 	const struct cdevsw *d;
    749      1.11       ad 	int rv;
    750      1.11       ad 
    751      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    752      1.11       ad 		return ENXIO;
    753      1.11       ad 
    754      1.11       ad 	DEV_LOCK(d);
    755      1.11       ad 	rv = (*d->d_write)(dev, uio, flag);
    756      1.11       ad 	DEV_UNLOCK(d);
    757      1.11       ad 
    758      1.11       ad 	return rv;
    759      1.11       ad }
    760      1.11       ad 
    761      1.11       ad int
    762      1.11       ad cdev_ioctl(dev_t dev, u_long cmd, void *data, int flag, lwp_t *l)
    763      1.11       ad {
    764      1.11       ad 	const struct cdevsw *d;
    765      1.11       ad 	int rv;
    766      1.11       ad 
    767      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    768      1.11       ad 		return ENXIO;
    769      1.11       ad 
    770      1.11       ad 	DEV_LOCK(d);
    771      1.11       ad 	rv = (*d->d_ioctl)(dev, cmd, data, flag, l);
    772      1.11       ad 	DEV_UNLOCK(d);
    773      1.11       ad 
    774      1.11       ad 	return rv;
    775      1.11       ad }
    776      1.11       ad 
    777      1.11       ad void
    778      1.11       ad cdev_stop(struct tty *tp, int flag)
    779      1.11       ad {
    780      1.11       ad 	const struct cdevsw *d;
    781      1.11       ad 
    782      1.11       ad 	if ((d = cdevsw_lookup(tp->t_dev)) == NULL)
    783      1.11       ad 		return;
    784      1.11       ad 
    785      1.11       ad 	DEV_LOCK(d);
    786      1.11       ad 	(*d->d_stop)(tp, flag);
    787      1.11       ad 	DEV_UNLOCK(d);
    788      1.11       ad }
    789      1.11       ad 
    790      1.11       ad struct tty *
    791      1.11       ad cdev_tty(dev_t dev)
    792      1.11       ad {
    793      1.11       ad 	const struct cdevsw *d;
    794      1.11       ad 	struct tty * rv;
    795      1.11       ad 
    796      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    797      1.11       ad 		return NULL;
    798      1.11       ad 
    799      1.12       ad 	/* XXX Check if necessary. */
    800      1.12       ad 	if (d->d_tty == NULL)
    801      1.12       ad 		return NULL;
    802      1.12       ad 
    803      1.11       ad 	DEV_LOCK(d);
    804      1.11       ad 	rv = (*d->d_tty)(dev);
    805      1.11       ad 	DEV_UNLOCK(d);
    806      1.11       ad 
    807      1.11       ad 	return rv;
    808      1.11       ad }
    809      1.11       ad 
    810      1.11       ad int
    811      1.11       ad cdev_poll(dev_t dev, int flag, lwp_t *l)
    812      1.11       ad {
    813      1.11       ad 	const struct cdevsw *d;
    814      1.11       ad 	int rv;
    815      1.11       ad 
    816      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    817      1.11       ad 		return POLLERR;
    818      1.11       ad 
    819      1.11       ad 	DEV_LOCK(d);
    820      1.11       ad 	rv = (*d->d_poll)(dev, flag, l);
    821      1.11       ad 	DEV_UNLOCK(d);
    822      1.11       ad 
    823      1.11       ad 	return rv;
    824      1.11       ad }
    825      1.11       ad 
    826      1.11       ad paddr_t
    827      1.11       ad cdev_mmap(dev_t dev, off_t off, int flag)
    828      1.11       ad {
    829      1.11       ad 	const struct cdevsw *d;
    830      1.11       ad 	paddr_t rv;
    831      1.11       ad 
    832      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    833      1.11       ad 		return (paddr_t)-1LL;
    834      1.11       ad 
    835      1.11       ad 	DEV_LOCK(d);
    836      1.11       ad 	rv = (*d->d_mmap)(dev, off, flag);
    837      1.11       ad 	DEV_UNLOCK(d);
    838      1.11       ad 
    839      1.11       ad 	return rv;
    840      1.11       ad }
    841      1.11       ad 
    842      1.11       ad int
    843      1.11       ad cdev_kqfilter(dev_t dev, struct knote *kn)
    844      1.11       ad {
    845      1.11       ad 	const struct cdevsw *d;
    846      1.11       ad 	int rv;
    847      1.11       ad 
    848      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    849      1.11       ad 		return ENXIO;
    850      1.11       ad 
    851      1.11       ad 	DEV_LOCK(d);
    852      1.11       ad 	rv = (*d->d_kqfilter)(dev, kn);
    853      1.11       ad 	DEV_UNLOCK(d);
    854      1.11       ad 
    855      1.11       ad 	return rv;
    856      1.11       ad }
    857      1.11       ad 
    858      1.11       ad int
    859      1.11       ad cdev_type(dev_t dev)
    860      1.11       ad {
    861      1.11       ad 	const struct cdevsw *d;
    862      1.11       ad 
    863      1.11       ad 	if ((d = cdevsw_lookup(dev)) == NULL)
    864      1.11       ad 		return D_OTHER;
    865      1.11       ad 	return d->d_flag & D_TYPEMASK;
    866       1.2  gehenna }
    867