subr_devsw.c revision 1.7.16.5 1 1.7.16.5 yamt /* $NetBSD: subr_devsw.c,v 1.7.16.5 2008/02/27 08:36:56 yamt Exp $ */
2 1.7.16.1 yamt
3 1.2 gehenna /*-
4 1.7.16.1 yamt * 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.7.16.1 yamt * 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.7.16.1 yamt
39 1.2 gehenna /*
40 1.7.16.1 yamt * Overview
41 1.7.16.1 yamt *
42 1.7.16.1 yamt * subr_devsw.c: registers device drivers by name and by major
43 1.7.16.1 yamt * number, and provides wrapper methods for performing I/O and
44 1.7.16.1 yamt * other tasks on device drivers, keying on the device number
45 1.7.16.1 yamt * (dev_t).
46 1.7.16.1 yamt *
47 1.7.16.1 yamt * When the system is built, the config(8) command generates
48 1.7.16.1 yamt * static tables of device drivers built into the kernel image
49 1.7.16.1 yamt * along with their associated methods. These are recorded in
50 1.7.16.1 yamt * the cdevsw0 and bdevsw0 tables. Drivers can also be added to
51 1.7.16.1 yamt * and removed from the system dynamically.
52 1.7.16.1 yamt *
53 1.7.16.1 yamt * Allocation
54 1.7.16.1 yamt *
55 1.7.16.1 yamt * When the system initially boots only the statically allocated
56 1.7.16.1 yamt * indexes (bdevsw0, cdevsw0) are used. If these overflow due to
57 1.7.16.1 yamt * allocation, we allocate a fixed block of memory to hold the new,
58 1.7.16.1 yamt * expanded index. This "fork" of the table is only ever performed
59 1.7.16.1 yamt * once in order to guarantee that other threads may safely access
60 1.7.16.1 yamt * the device tables:
61 1.7.16.1 yamt *
62 1.7.16.1 yamt * o Once a thread has a "reference" to the table via an earlier
63 1.7.16.1 yamt * open() call, we know that the entry in the table must exist
64 1.7.16.1 yamt * and so it is safe to access it.
65 1.7.16.1 yamt *
66 1.7.16.1 yamt * o Regardless of whether other threads see the old or new
67 1.7.16.1 yamt * pointers, they will point to a correct device switch
68 1.7.16.1 yamt * structure for the operation being performed.
69 1.7.16.1 yamt *
70 1.7.16.1 yamt * XXX Currently, the wrapper methods such as cdev_read() verify
71 1.7.16.1 yamt * that a device driver does in fact exist before calling the
72 1.7.16.1 yamt * associated driver method. This should be changed so that
73 1.7.16.1 yamt * once the device is has been referenced by a vnode (opened),
74 1.7.16.1 yamt * calling the other methods should be valid until that reference
75 1.7.16.1 yamt * is dropped.
76 1.2 gehenna */
77 1.7.16.1 yamt
78 1.7.16.1 yamt #include <sys/cdefs.h>
79 1.7.16.5 yamt __KERNEL_RCSID(0, "$NetBSD: subr_devsw.c,v 1.7.16.5 2008/02/27 08:36:56 yamt Exp $");
80 1.2 gehenna
81 1.2 gehenna #include <sys/param.h>
82 1.2 gehenna #include <sys/conf.h>
83 1.7.16.1 yamt #include <sys/kmem.h>
84 1.2 gehenna #include <sys/systm.h>
85 1.7.16.1 yamt #include <sys/poll.h>
86 1.7.16.1 yamt #include <sys/tty.h>
87 1.7.16.5 yamt #include <sys/cpu.h>
88 1.7.16.1 yamt #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.7.16.1 yamt #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.7.16.4 yamt static int bdevsw_attach(const struct bdevsw *, int *);
108 1.7.16.4 yamt static int cdevsw_attach(const struct cdevsw *, int *);
109 1.7.16.1 yamt static void devsw_detach_locked(const struct bdevsw *, const struct cdevsw *);
110 1.7.16.1 yamt
111 1.7.16.3 yamt kmutex_t devsw_lock;
112 1.7.16.1 yamt
113 1.7.16.1 yamt void
114 1.7.16.1 yamt devsw_init(void)
115 1.7.16.1 yamt {
116 1.7.16.1 yamt
117 1.7.16.1 yamt KASSERT(sys_bdevsws < MAXDEVSW - 1);
118 1.7.16.1 yamt KASSERT(sys_cdevsws < MAXDEVSW - 1);
119 1.7.16.1 yamt
120 1.7.16.1 yamt mutex_init(&devsw_lock, MUTEX_DEFAULT, IPL_NONE);
121 1.7.16.1 yamt }
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.7.16.1 yamt mutex_enter(&devsw_lock);
135 1.7.16.1 yamt
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.7.16.1 yamt if (*bmajor != conv->d_bmajor || *cmajor != conv->d_cmajor) {
147 1.7.16.1 yamt error = EINVAL;
148 1.7.16.1 yamt goto fail;
149 1.7.16.1 yamt }
150 1.7.16.1 yamt if ((*bmajor >= 0 && bdev == NULL) || *cmajor < 0) {
151 1.7.16.1 yamt error = EINVAL;
152 1.7.16.1 yamt goto fail;
153 1.7.16.1 yamt }
154 1.2 gehenna
155 1.2 gehenna if ((*bmajor >= 0 && bdevsw[*bmajor] != NULL) ||
156 1.7.16.1 yamt cdevsw[*cmajor] != NULL) {
157 1.7.16.1 yamt error = EEXIST;
158 1.7.16.1 yamt goto fail;
159 1.7.16.1 yamt }
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.7.16.1 yamt mutex_exit(&devsw_lock);
166 1.2 gehenna return (0);
167 1.2 gehenna }
168 1.2 gehenna
169 1.7.16.4 yamt error = bdevsw_attach(bdev, bmajor);
170 1.7.16.1 yamt if (error != 0)
171 1.7.16.1 yamt goto fail;
172 1.7.16.4 yamt error = cdevsw_attach(cdev, cmajor);
173 1.2 gehenna if (error != 0) {
174 1.7.16.1 yamt devsw_detach_locked(bdev, NULL);
175 1.7.16.1 yamt 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.7.16.1 yamt newptr = kmem_zalloc(new * DEVSWCONV_SIZE, KM_NOSLEEP);
190 1.2 gehenna if (newptr == NULL) {
191 1.7.16.1 yamt devsw_detach_locked(bdev, cdev);
192 1.7.16.1 yamt error = ENOMEM;
193 1.7.16.1 yamt 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.7.16.1 yamt 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.7.16.1 yamt name = kmem_alloc(i, KM_NOSLEEP);
207 1.2 gehenna if (name == NULL) {
208 1.7.16.1 yamt devsw_detach_locked(bdev, cdev);
209 1.7.16.1 yamt 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.7.16.1 yamt mutex_exit(&devsw_lock);
218 1.2 gehenna return (0);
219 1.7.16.1 yamt fail:
220 1.7.16.1 yamt mutex_exit(&devsw_lock);
221 1.7.16.1 yamt return (error);
222 1.2 gehenna }
223 1.2 gehenna
224 1.2 gehenna static int
225 1.7.16.4 yamt bdevsw_attach(const struct bdevsw *devsw, int *devmajor)
226 1.2 gehenna {
227 1.7.16.1 yamt const struct bdevsw **newptr;
228 1.2 gehenna int bmajor, i;
229 1.2 gehenna
230 1.7.16.1 yamt KASSERT(mutex_owned(&devsw_lock));
231 1.7.16.1 yamt
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.7.16.1 yamt
250 1.2 gehenna if (*devmajor >= MAXDEVSW) {
251 1.7.16.1 yamt 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.7.16.1 yamt KASSERT(bdevsw == bdevsw0);
257 1.7.16.1 yamt newptr = kmem_zalloc(MAXDEVSW * BDEVSW_SIZE, KM_NOSLEEP);
258 1.2 gehenna if (newptr == NULL)
259 1.2 gehenna return (ENOMEM);
260 1.7.16.1 yamt memcpy(newptr, bdevsw, max_bdevsws * BDEVSW_SIZE);
261 1.2 gehenna bdevsw = newptr;
262 1.7.16.1 yamt 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.7.16.4 yamt cdevsw_attach(const struct cdevsw *devsw, int *devmajor)
275 1.2 gehenna {
276 1.7.16.1 yamt const struct cdevsw **newptr;
277 1.2 gehenna int cmajor, i;
278 1.2 gehenna
279 1.7.16.1 yamt KASSERT(mutex_owned(&devsw_lock));
280 1.7.16.1 yamt
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.7.16.1 yamt
296 1.2 gehenna if (*devmajor >= MAXDEVSW) {
297 1.7.16.1 yamt 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.7.16.1 yamt KASSERT(cdevsw == cdevsw0);
303 1.7.16.1 yamt newptr = kmem_zalloc(MAXDEVSW * CDEVSW_SIZE, KM_NOSLEEP);
304 1.2 gehenna if (newptr == NULL)
305 1.2 gehenna return (ENOMEM);
306 1.7.16.1 yamt memcpy(newptr, cdevsw, max_cdevsws * CDEVSW_SIZE);
307 1.2 gehenna cdevsw = newptr;
308 1.7.16.1 yamt 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.7.16.1 yamt static void
320 1.7.16.1 yamt 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.7.16.1 yamt KASSERT(mutex_owned(&devsw_lock));
325 1.7.16.1 yamt
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.7.16.1 yamt void
345 1.7.16.1 yamt devsw_detach(const struct bdevsw *bdev, const struct cdevsw *cdev)
346 1.7.16.1 yamt {
347 1.7.16.1 yamt
348 1.7.16.1 yamt mutex_enter(&devsw_lock);
349 1.7.16.1 yamt devsw_detach_locked(bdev, cdev);
350 1.7.16.1 yamt mutex_exit(&devsw_lock);
351 1.7.16.1 yamt }
352 1.7.16.1 yamt
353 1.7.16.1 yamt /*
354 1.7.16.1 yamt * Look up a block device by number.
355 1.7.16.1 yamt *
356 1.7.16.1 yamt * => Caller must ensure that the device is attached.
357 1.7.16.1 yamt */
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.7.16.1 yamt /*
373 1.7.16.1 yamt * Look up a character device by number.
374 1.7.16.1 yamt *
375 1.7.16.1 yamt * => Caller must ensure that the device is attached.
376 1.7.16.1 yamt */
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.7.16.1 yamt /*
392 1.7.16.1 yamt * Look up a block device by reference to its operations set.
393 1.7.16.1 yamt *
394 1.7.16.1 yamt * => Caller must ensure that the device is not detached, and therefore
395 1.7.16.1 yamt * that the returned major is still valid when dereferenced.
396 1.7.16.1 yamt */
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.7.16.1 yamt /*
411 1.7.16.1 yamt * Look up a character device by reference to its operations set.
412 1.7.16.1 yamt *
413 1.7.16.1 yamt * => Caller must ensure that the device is not detached, and therefore
414 1.7.16.1 yamt * that the returned major is still valid when dereferenced.
415 1.7.16.1 yamt */
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.7.16.1 yamt *
432 1.7.16.1 yamt * => Caller must ensure that the device is not detached, and therefore
433 1.7.16.1 yamt * 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.7.16.1 yamt const char *name;
439 1.2 gehenna int cmajor, i;
440 1.2 gehenna
441 1.7.16.1 yamt name = NULL;
442 1.7.16.1 yamt cmajor = -1;
443 1.2 gehenna
444 1.7.16.1 yamt mutex_enter(&devsw_lock);
445 1.7.16.1 yamt if (bmajor < 0 || bmajor >= max_bdevsws || bdevsw[bmajor] == NULL) {
446 1.7.16.1 yamt mutex_exit(&devsw_lock);
447 1.7.16.1 yamt return (NULL);
448 1.7.16.1 yamt }
449 1.7.16.1 yamt for (i = 0 ; i < max_devsw_convs; i++) {
450 1.7.16.1 yamt if (devsw_conv[i].d_bmajor == bmajor) {
451 1.7.16.1 yamt cmajor = devsw_conv[i].d_cmajor;
452 1.7.16.1 yamt break;
453 1.7.16.1 yamt }
454 1.2 gehenna }
455 1.7.16.1 yamt if (cmajor >= 0 && cmajor < max_cdevsws && cdevsw[cmajor] != NULL)
456 1.7.16.1 yamt name = devsw_conv[i].d_name;
457 1.7.16.1 yamt mutex_exit(&devsw_lock);
458 1.2 gehenna
459 1.7.16.1 yamt 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.7.16.1 yamt *
465 1.7.16.1 yamt * => Caller must ensure that the device is not detached, and therefore
466 1.7.16.1 yamt * 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.7.16.1 yamt 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.7.16.1 yamt mutex_exit(&devsw_lock);
502 1.2 gehenna return (bmajor);
503 1.2 gehenna }
504 1.2 gehenna
505 1.7.16.1 yamt 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.7.16.1 yamt *
512 1.7.16.1 yamt * => Caller must ensure that the device is not detached, and therefore
513 1.7.16.1 yamt * 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.7.16.1 yamt dev_t rv;
520 1.2 gehenna
521 1.2 gehenna cmajor = major(cdev);
522 1.7.16.1 yamt bmajor = -1;
523 1.7.16.1 yamt rv = NODEV;
524 1.2 gehenna
525 1.7.16.1 yamt mutex_enter(&devsw_lock);
526 1.7.16.1 yamt if (cmajor < 0 || cmajor >= max_cdevsws || cdevsw[cmajor] == NULL) {
527 1.7.16.1 yamt mutex_exit(&devsw_lock);
528 1.7.16.1 yamt return (NODEV);
529 1.7.16.1 yamt }
530 1.2 gehenna for (i = 0 ; i < max_devsw_convs ; i++) {
531 1.7.16.1 yamt if (devsw_conv[i].d_cmajor == cmajor) {
532 1.7.16.1 yamt bmajor = devsw_conv[i].d_bmajor;
533 1.7.16.1 yamt break;
534 1.7.16.1 yamt }
535 1.2 gehenna }
536 1.7.16.1 yamt if (bmajor >= 0 && bmajor < max_bdevsws && bdevsw[bmajor] != NULL)
537 1.7.16.1 yamt rv = makedev(bmajor, minor(cdev));
538 1.7.16.1 yamt mutex_exit(&devsw_lock);
539 1.2 gehenna
540 1.7.16.1 yamt 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.7.16.1 yamt *
546 1.7.16.1 yamt * => Caller must ensure that the device is not detached, and therefore
547 1.7.16.1 yamt * 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.7.16.1 yamt dev_t rv;
554 1.2 gehenna
555 1.2 gehenna bmajor = major(bdev);
556 1.7.16.1 yamt cmajor = -1;
557 1.7.16.1 yamt rv = NODEV;
558 1.2 gehenna
559 1.7.16.1 yamt mutex_enter(&devsw_lock);
560 1.7.16.1 yamt if (bmajor < 0 || bmajor >= max_bdevsws || bdevsw[bmajor] == NULL) {
561 1.7.16.1 yamt mutex_exit(&devsw_lock);
562 1.7.16.1 yamt return (NODEV);
563 1.7.16.1 yamt }
564 1.2 gehenna for (i = 0 ; i < max_devsw_convs ; i++) {
565 1.7.16.1 yamt if (devsw_conv[i].d_bmajor == bmajor) {
566 1.7.16.1 yamt cmajor = devsw_conv[i].d_cmajor;
567 1.7.16.1 yamt break;
568 1.7.16.1 yamt }
569 1.2 gehenna }
570 1.7.16.1 yamt if (cmajor >= 0 && cmajor < max_cdevsws && cdevsw[cmajor] != NULL)
571 1.7.16.1 yamt rv = makedev(cmajor, minor(bdev));
572 1.7.16.1 yamt mutex_exit(&devsw_lock);
573 1.7.16.1 yamt
574 1.7.16.1 yamt return (rv);
575 1.7.16.1 yamt }
576 1.7.16.1 yamt
577 1.7.16.1 yamt /*
578 1.7.16.1 yamt * Device access methods.
579 1.7.16.1 yamt */
580 1.7.16.1 yamt
581 1.7.16.1 yamt #define DEV_LOCK(d) \
582 1.7.16.1 yamt if ((d->d_flag & D_MPSAFE) == 0) { \
583 1.7.16.1 yamt KERNEL_LOCK(1, curlwp); \
584 1.7.16.1 yamt }
585 1.7.16.1 yamt
586 1.7.16.1 yamt #define DEV_UNLOCK(d) \
587 1.7.16.1 yamt if ((d->d_flag & D_MPSAFE) == 0) { \
588 1.7.16.1 yamt KERNEL_UNLOCK_ONE(curlwp); \
589 1.7.16.1 yamt }
590 1.7.16.1 yamt
591 1.7.16.1 yamt int
592 1.7.16.1 yamt bdev_open(dev_t dev, int flag, int devtype, lwp_t *l)
593 1.7.16.1 yamt {
594 1.7.16.1 yamt const struct bdevsw *d;
595 1.7.16.1 yamt int rv;
596 1.7.16.1 yamt
597 1.7.16.1 yamt /*
598 1.7.16.1 yamt * For open we need to lock, in order to synchronize
599 1.7.16.1 yamt * with attach/detach.
600 1.7.16.1 yamt */
601 1.7.16.1 yamt mutex_enter(&devsw_lock);
602 1.7.16.1 yamt d = bdevsw_lookup(dev);
603 1.7.16.1 yamt mutex_exit(&devsw_lock);
604 1.7.16.1 yamt if (d == NULL)
605 1.7.16.1 yamt return ENXIO;
606 1.7.16.1 yamt
607 1.7.16.1 yamt DEV_LOCK(d);
608 1.7.16.1 yamt rv = (*d->d_open)(dev, flag, devtype, l);
609 1.7.16.1 yamt DEV_UNLOCK(d);
610 1.7.16.1 yamt
611 1.7.16.1 yamt return rv;
612 1.7.16.1 yamt }
613 1.7.16.1 yamt
614 1.7.16.1 yamt int
615 1.7.16.1 yamt bdev_close(dev_t dev, int flag, int devtype, lwp_t *l)
616 1.7.16.1 yamt {
617 1.7.16.1 yamt const struct bdevsw *d;
618 1.7.16.1 yamt int rv;
619 1.7.16.1 yamt
620 1.7.16.1 yamt if ((d = bdevsw_lookup(dev)) == NULL)
621 1.7.16.1 yamt return ENXIO;
622 1.7.16.1 yamt
623 1.7.16.1 yamt DEV_LOCK(d);
624 1.7.16.1 yamt rv = (*d->d_close)(dev, flag, devtype, l);
625 1.7.16.1 yamt DEV_UNLOCK(d);
626 1.7.16.1 yamt
627 1.7.16.1 yamt return rv;
628 1.7.16.1 yamt }
629 1.7.16.1 yamt
630 1.7.16.1 yamt void
631 1.7.16.1 yamt bdev_strategy(struct buf *bp)
632 1.7.16.1 yamt {
633 1.7.16.1 yamt const struct bdevsw *d;
634 1.7.16.1 yamt
635 1.7.16.1 yamt if ((d = bdevsw_lookup(bp->b_dev)) == NULL)
636 1.7.16.1 yamt panic("bdev_strategy");
637 1.7.16.1 yamt
638 1.7.16.1 yamt DEV_LOCK(d);
639 1.7.16.1 yamt (*d->d_strategy)(bp);
640 1.7.16.1 yamt DEV_UNLOCK(d);
641 1.7.16.1 yamt }
642 1.7.16.1 yamt
643 1.7.16.1 yamt int
644 1.7.16.1 yamt bdev_ioctl(dev_t dev, u_long cmd, void *data, int flag, lwp_t *l)
645 1.7.16.1 yamt {
646 1.7.16.1 yamt const struct bdevsw *d;
647 1.7.16.1 yamt int rv;
648 1.7.16.1 yamt
649 1.7.16.1 yamt if ((d = bdevsw_lookup(dev)) == NULL)
650 1.7.16.1 yamt return ENXIO;
651 1.7.16.1 yamt
652 1.7.16.1 yamt DEV_LOCK(d);
653 1.7.16.1 yamt rv = (*d->d_ioctl)(dev, cmd, data, flag, l);
654 1.7.16.1 yamt DEV_UNLOCK(d);
655 1.7.16.1 yamt
656 1.7.16.1 yamt return rv;
657 1.7.16.1 yamt }
658 1.7.16.1 yamt
659 1.7.16.1 yamt int
660 1.7.16.1 yamt bdev_dump(dev_t dev, daddr_t addr, void *data, size_t sz)
661 1.7.16.1 yamt {
662 1.7.16.1 yamt const struct bdevsw *d;
663 1.7.16.1 yamt int rv;
664 1.7.16.1 yamt
665 1.7.16.1 yamt /*
666 1.7.16.1 yamt * Dump can be called without the device open. Since it can
667 1.7.16.1 yamt * currently only be called with the system paused (and in a
668 1.7.16.1 yamt * potentially unstable state), we don't perform any locking.
669 1.7.16.1 yamt */
670 1.7.16.1 yamt if ((d = bdevsw_lookup(dev)) == NULL)
671 1.7.16.1 yamt return ENXIO;
672 1.7.16.1 yamt
673 1.7.16.1 yamt /* DEV_LOCK(d); */
674 1.7.16.1 yamt rv = (*d->d_dump)(dev, addr, data, sz);
675 1.7.16.1 yamt /* DEV_UNLOCK(d); */
676 1.7.16.1 yamt
677 1.7.16.1 yamt return rv;
678 1.7.16.1 yamt }
679 1.7.16.1 yamt
680 1.7.16.1 yamt int
681 1.7.16.1 yamt bdev_type(dev_t dev)
682 1.7.16.1 yamt {
683 1.7.16.1 yamt const struct bdevsw *d;
684 1.7.16.1 yamt
685 1.7.16.1 yamt if ((d = bdevsw_lookup(dev)) == NULL)
686 1.7.16.1 yamt return D_OTHER;
687 1.7.16.1 yamt return d->d_flag & D_TYPEMASK;
688 1.7.16.1 yamt }
689 1.7.16.1 yamt
690 1.7.16.1 yamt int
691 1.7.16.1 yamt cdev_open(dev_t dev, int flag, int devtype, lwp_t *l)
692 1.7.16.1 yamt {
693 1.7.16.1 yamt const struct cdevsw *d;
694 1.7.16.1 yamt int rv;
695 1.7.16.1 yamt
696 1.7.16.1 yamt /*
697 1.7.16.1 yamt * For open we need to lock, in order to synchronize
698 1.7.16.1 yamt * with attach/detach.
699 1.7.16.1 yamt */
700 1.7.16.1 yamt mutex_enter(&devsw_lock);
701 1.7.16.1 yamt d = cdevsw_lookup(dev);
702 1.7.16.1 yamt mutex_exit(&devsw_lock);
703 1.7.16.1 yamt if (d == NULL)
704 1.7.16.1 yamt return ENXIO;
705 1.7.16.1 yamt
706 1.7.16.1 yamt DEV_LOCK(d);
707 1.7.16.1 yamt rv = (*d->d_open)(dev, flag, devtype, l);
708 1.7.16.1 yamt DEV_UNLOCK(d);
709 1.7.16.1 yamt
710 1.7.16.1 yamt return rv;
711 1.7.16.1 yamt }
712 1.7.16.1 yamt
713 1.7.16.1 yamt int
714 1.7.16.1 yamt cdev_close(dev_t dev, int flag, int devtype, lwp_t *l)
715 1.7.16.1 yamt {
716 1.7.16.1 yamt const struct cdevsw *d;
717 1.7.16.1 yamt int rv;
718 1.7.16.1 yamt
719 1.7.16.1 yamt if ((d = cdevsw_lookup(dev)) == NULL)
720 1.7.16.1 yamt return ENXIO;
721 1.7.16.1 yamt
722 1.7.16.1 yamt DEV_LOCK(d);
723 1.7.16.1 yamt rv = (*d->d_close)(dev, flag, devtype, l);
724 1.7.16.1 yamt DEV_UNLOCK(d);
725 1.7.16.1 yamt
726 1.7.16.1 yamt return rv;
727 1.7.16.1 yamt }
728 1.7.16.1 yamt
729 1.7.16.1 yamt int
730 1.7.16.1 yamt cdev_read(dev_t dev, struct uio *uio, int flag)
731 1.7.16.1 yamt {
732 1.7.16.1 yamt const struct cdevsw *d;
733 1.7.16.1 yamt int rv;
734 1.7.16.1 yamt
735 1.7.16.1 yamt if ((d = cdevsw_lookup(dev)) == NULL)
736 1.7.16.1 yamt return ENXIO;
737 1.7.16.1 yamt
738 1.7.16.1 yamt DEV_LOCK(d);
739 1.7.16.1 yamt rv = (*d->d_read)(dev, uio, flag);
740 1.7.16.1 yamt DEV_UNLOCK(d);
741 1.7.16.1 yamt
742 1.7.16.1 yamt return rv;
743 1.7.16.1 yamt }
744 1.7.16.1 yamt
745 1.7.16.1 yamt int
746 1.7.16.1 yamt cdev_write(dev_t dev, struct uio *uio, int flag)
747 1.7.16.1 yamt {
748 1.7.16.1 yamt const struct cdevsw *d;
749 1.7.16.1 yamt int rv;
750 1.7.16.1 yamt
751 1.7.16.1 yamt if ((d = cdevsw_lookup(dev)) == NULL)
752 1.7.16.1 yamt return ENXIO;
753 1.7.16.1 yamt
754 1.7.16.1 yamt DEV_LOCK(d);
755 1.7.16.1 yamt rv = (*d->d_write)(dev, uio, flag);
756 1.7.16.1 yamt DEV_UNLOCK(d);
757 1.7.16.1 yamt
758 1.7.16.1 yamt return rv;
759 1.7.16.1 yamt }
760 1.7.16.1 yamt
761 1.7.16.1 yamt int
762 1.7.16.1 yamt cdev_ioctl(dev_t dev, u_long cmd, void *data, int flag, lwp_t *l)
763 1.7.16.1 yamt {
764 1.7.16.1 yamt const struct cdevsw *d;
765 1.7.16.1 yamt int rv;
766 1.7.16.1 yamt
767 1.7.16.1 yamt if ((d = cdevsw_lookup(dev)) == NULL)
768 1.7.16.1 yamt return ENXIO;
769 1.7.16.1 yamt
770 1.7.16.1 yamt DEV_LOCK(d);
771 1.7.16.1 yamt rv = (*d->d_ioctl)(dev, cmd, data, flag, l);
772 1.7.16.1 yamt DEV_UNLOCK(d);
773 1.7.16.1 yamt
774 1.7.16.1 yamt return rv;
775 1.7.16.1 yamt }
776 1.7.16.1 yamt
777 1.7.16.1 yamt void
778 1.7.16.1 yamt cdev_stop(struct tty *tp, int flag)
779 1.7.16.1 yamt {
780 1.7.16.1 yamt const struct cdevsw *d;
781 1.7.16.1 yamt
782 1.7.16.1 yamt if ((d = cdevsw_lookup(tp->t_dev)) == NULL)
783 1.7.16.1 yamt return;
784 1.7.16.1 yamt
785 1.7.16.1 yamt DEV_LOCK(d);
786 1.7.16.1 yamt (*d->d_stop)(tp, flag);
787 1.7.16.1 yamt DEV_UNLOCK(d);
788 1.7.16.1 yamt }
789 1.7.16.1 yamt
790 1.7.16.1 yamt struct tty *
791 1.7.16.1 yamt cdev_tty(dev_t dev)
792 1.7.16.1 yamt {
793 1.7.16.1 yamt const struct cdevsw *d;
794 1.7.16.1 yamt struct tty * rv;
795 1.7.16.1 yamt
796 1.7.16.1 yamt if ((d = cdevsw_lookup(dev)) == NULL)
797 1.7.16.1 yamt return NULL;
798 1.7.16.1 yamt
799 1.7.16.2 yamt /* XXX Check if necessary. */
800 1.7.16.2 yamt if (d->d_tty == NULL)
801 1.7.16.2 yamt return NULL;
802 1.7.16.2 yamt
803 1.7.16.1 yamt DEV_LOCK(d);
804 1.7.16.1 yamt rv = (*d->d_tty)(dev);
805 1.7.16.1 yamt DEV_UNLOCK(d);
806 1.7.16.1 yamt
807 1.7.16.1 yamt return rv;
808 1.7.16.1 yamt }
809 1.7.16.1 yamt
810 1.7.16.1 yamt int
811 1.7.16.1 yamt cdev_poll(dev_t dev, int flag, lwp_t *l)
812 1.7.16.1 yamt {
813 1.7.16.1 yamt const struct cdevsw *d;
814 1.7.16.1 yamt int rv;
815 1.7.16.1 yamt
816 1.7.16.1 yamt if ((d = cdevsw_lookup(dev)) == NULL)
817 1.7.16.1 yamt return POLLERR;
818 1.7.16.1 yamt
819 1.7.16.1 yamt DEV_LOCK(d);
820 1.7.16.1 yamt rv = (*d->d_poll)(dev, flag, l);
821 1.7.16.1 yamt DEV_UNLOCK(d);
822 1.7.16.1 yamt
823 1.7.16.1 yamt return rv;
824 1.7.16.1 yamt }
825 1.7.16.1 yamt
826 1.7.16.1 yamt paddr_t
827 1.7.16.1 yamt cdev_mmap(dev_t dev, off_t off, int flag)
828 1.7.16.1 yamt {
829 1.7.16.1 yamt const struct cdevsw *d;
830 1.7.16.1 yamt paddr_t rv;
831 1.7.16.1 yamt
832 1.7.16.1 yamt if ((d = cdevsw_lookup(dev)) == NULL)
833 1.7.16.1 yamt return (paddr_t)-1LL;
834 1.7.16.1 yamt
835 1.7.16.1 yamt DEV_LOCK(d);
836 1.7.16.1 yamt rv = (*d->d_mmap)(dev, off, flag);
837 1.7.16.1 yamt DEV_UNLOCK(d);
838 1.7.16.1 yamt
839 1.7.16.1 yamt return rv;
840 1.7.16.1 yamt }
841 1.7.16.1 yamt
842 1.7.16.1 yamt int
843 1.7.16.1 yamt cdev_kqfilter(dev_t dev, struct knote *kn)
844 1.7.16.1 yamt {
845 1.7.16.1 yamt const struct cdevsw *d;
846 1.7.16.1 yamt int rv;
847 1.7.16.1 yamt
848 1.7.16.1 yamt if ((d = cdevsw_lookup(dev)) == NULL)
849 1.7.16.1 yamt return ENXIO;
850 1.7.16.1 yamt
851 1.7.16.1 yamt DEV_LOCK(d);
852 1.7.16.1 yamt rv = (*d->d_kqfilter)(dev, kn);
853 1.7.16.1 yamt DEV_UNLOCK(d);
854 1.7.16.1 yamt
855 1.7.16.1 yamt return rv;
856 1.7.16.1 yamt }
857 1.7.16.1 yamt
858 1.7.16.1 yamt int
859 1.7.16.1 yamt cdev_type(dev_t dev)
860 1.7.16.1 yamt {
861 1.7.16.1 yamt const struct cdevsw *d;
862 1.2 gehenna
863 1.7.16.1 yamt if ((d = cdevsw_lookup(dev)) == NULL)
864 1.7.16.1 yamt return D_OTHER;
865 1.7.16.1 yamt return d->d_flag & D_TYPEMASK;
866 1.2 gehenna }
867