Home | History | Annotate | Line # | Download | only in kern
subr_devsw.c revision 1.15
      1  1.15     matt /*	$NetBSD: subr_devsw.c,v 1.15 2008/02/13 18:43:16 matt 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.15     matt __KERNEL_RCSID(0, "$NetBSD: subr_devsw.c,v 1.15 2008/02/13 18:43:16 matt 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.15     matt #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.14    pooka static int bdevsw_attach(const struct bdevsw *, int *);
    108  1.14    pooka 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.13       ad 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.14    pooka 	error = bdevsw_attach(bdev, bmajor);
    170  1.11       ad 	if (error != 0)
    171  1.11       ad 		goto fail;
    172  1.14    pooka 	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.14    pooka 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.14    pooka 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