Home | History | Annotate | Line # | Download | only in kern
subr_devsw.c revision 1.11.10.1
      1  1.11.10.1     yamt /*	$NetBSD: subr_devsw.c,v 1.11.10.1 2007/10/14 11:48:45 yamt 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.11.10.1     yamt __KERNEL_RCSID(0, "$NetBSD: subr_devsw.c,v 1.11.10.1 2007/10/14 11:48:45 yamt 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.11       ad static 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.11.10.1     yamt 	/* XXX Check if necessary. */
    799  1.11.10.1     yamt 	if (d->d_tty == NULL)
    800  1.11.10.1     yamt 		return NULL;
    801  1.11.10.1     yamt 
    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