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