subr_devsw.c revision 1.34.2.2 1 1.34.2.2 pgoyette /* $NetBSD: subr_devsw.c,v 1.34.2.2 2016/07/16 22:35:34 pgoyette 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.34.2.2 pgoyette __KERNEL_RCSID(0, "$NetBSD: subr_devsw.c,v 1.34.2.2 2016/07/16 22:35:34 pgoyette Exp $");
73 1.34 riz
74 1.34 riz #ifdef _KERNEL_OPT
75 1.34 riz #include "opt_dtrace.h"
76 1.34 riz #endif
77 1.2 gehenna
78 1.2 gehenna #include <sys/param.h>
79 1.2 gehenna #include <sys/conf.h>
80 1.11 ad #include <sys/kmem.h>
81 1.2 gehenna #include <sys/systm.h>
82 1.11 ad #include <sys/poll.h>
83 1.11 ad #include <sys/tty.h>
84 1.15 matt #include <sys/cpu.h>
85 1.11 ad #include <sys/buf.h>
86 1.29 mrg #include <sys/reboot.h>
87 1.34 riz #include <sys/sdt.h>
88 1.34.2.2 pgoyette #include <sys/atomic.h>
89 1.34.2.1 pgoyette #include <sys/condvar.h>
90 1.34.2.1 pgoyette #include <sys/localcount.h>
91 1.34.2.2 pgoyette #include <sys/pserialize.h>
92 1.2 gehenna
93 1.2 gehenna #ifdef DEVSW_DEBUG
94 1.2 gehenna #define DPRINTF(x) printf x
95 1.2 gehenna #else /* DEVSW_DEBUG */
96 1.2 gehenna #define DPRINTF(x)
97 1.2 gehenna #endif /* DEVSW_DEBUG */
98 1.2 gehenna
99 1.11 ad #define MAXDEVSW 512 /* the maximum of major device number */
100 1.2 gehenna #define BDEVSW_SIZE (sizeof(struct bdevsw *))
101 1.2 gehenna #define CDEVSW_SIZE (sizeof(struct cdevsw *))
102 1.2 gehenna #define DEVSWCONV_SIZE (sizeof(struct devsw_conv))
103 1.2 gehenna
104 1.2 gehenna extern const struct bdevsw **bdevsw, *bdevsw0[];
105 1.2 gehenna extern const struct cdevsw **cdevsw, *cdevsw0[];
106 1.2 gehenna extern struct devsw_conv *devsw_conv, devsw_conv0[];
107 1.2 gehenna extern const int sys_bdevsws, sys_cdevsws;
108 1.2 gehenna extern int max_bdevsws, max_cdevsws, max_devsw_convs;
109 1.2 gehenna
110 1.24 drochner static int bdevsw_attach(const struct bdevsw *, devmajor_t *);
111 1.24 drochner static int cdevsw_attach(const struct cdevsw *, devmajor_t *);
112 1.11 ad static void devsw_detach_locked(const struct bdevsw *, const struct cdevsw *);
113 1.11 ad
114 1.34.2.1 pgoyette kmutex_t device_lock;
115 1.34.2.1 pgoyette kcondvar_t device_cv;
116 1.23 pooka
117 1.31 pooka void (*biodone_vfs)(buf_t *) = (void *)nullop;
118 1.31 pooka
119 1.11 ad void
120 1.11 ad devsw_init(void)
121 1.11 ad {
122 1.11 ad
123 1.11 ad KASSERT(sys_bdevsws < MAXDEVSW - 1);
124 1.11 ad KASSERT(sys_cdevsws < MAXDEVSW - 1);
125 1.23 pooka mutex_init(&device_lock, MUTEX_DEFAULT, IPL_NONE);
126 1.34.2.1 pgoyette cv_init(&device_cv, "devsw");
127 1.11 ad }
128 1.2 gehenna
129 1.2 gehenna int
130 1.24 drochner devsw_attach(const char *devname,
131 1.24 drochner const struct bdevsw *bdev, devmajor_t *bmajor,
132 1.24 drochner const struct cdevsw *cdev, devmajor_t *cmajor)
133 1.2 gehenna {
134 1.2 gehenna struct devsw_conv *conv;
135 1.2 gehenna char *name;
136 1.2 gehenna int error, i;
137 1.25 enami size_t len;
138 1.2 gehenna
139 1.2 gehenna if (devname == NULL || cdev == NULL)
140 1.2 gehenna return (EINVAL);
141 1.2 gehenna
142 1.23 pooka mutex_enter(&device_lock);
143 1.11 ad
144 1.34.2.2 pgoyette if (bdev != NULL) {
145 1.34.2.2 pgoyette KASSERT(bdev->d_localcount != NULL);
146 1.34.2.2 pgoyette KASSERT(bdev->d_localcount != cdev->d_localcount);
147 1.34.2.2 pgoyette }
148 1.34.2.2 pgoyette if (cdev != NULL)
149 1.34.2.2 pgoyette KASSERT(cdev->d_localcount != NULL);
150 1.34.2.2 pgoyette
151 1.2 gehenna for (i = 0 ; i < max_devsw_convs ; i++) {
152 1.2 gehenna conv = &devsw_conv[i];
153 1.2 gehenna if (conv->d_name == NULL || strcmp(devname, conv->d_name) != 0)
154 1.2 gehenna continue;
155 1.2 gehenna
156 1.2 gehenna if (*bmajor < 0)
157 1.2 gehenna *bmajor = conv->d_bmajor;
158 1.2 gehenna if (*cmajor < 0)
159 1.2 gehenna *cmajor = conv->d_cmajor;
160 1.2 gehenna
161 1.11 ad if (*bmajor != conv->d_bmajor || *cmajor != conv->d_cmajor) {
162 1.11 ad error = EINVAL;
163 1.11 ad goto fail;
164 1.11 ad }
165 1.11 ad if ((*bmajor >= 0 && bdev == NULL) || *cmajor < 0) {
166 1.11 ad error = EINVAL;
167 1.11 ad goto fail;
168 1.11 ad }
169 1.2 gehenna
170 1.2 gehenna if ((*bmajor >= 0 && bdevsw[*bmajor] != NULL) ||
171 1.11 ad cdevsw[*cmajor] != NULL) {
172 1.11 ad error = EEXIST;
173 1.11 ad goto fail;
174 1.11 ad }
175 1.2 gehenna
176 1.34.2.2 pgoyette /* use membar_producer() to ensure visibility of the xdevsw */
177 1.34.2.1 pgoyette if (bdev != NULL) {
178 1.34.2.1 pgoyette localcount_init(bdev->d_localcount);
179 1.34.2.2 pgoyette membar_producer();
180 1.2 gehenna bdevsw[*bmajor] = bdev;
181 1.34.2.1 pgoyette }
182 1.34.2.1 pgoyette localcount_init(cdev->d_localcount);
183 1.34.2.2 pgoyette membar_producer();
184 1.2 gehenna cdevsw[*cmajor] = cdev;
185 1.2 gehenna
186 1.23 pooka mutex_exit(&device_lock);
187 1.2 gehenna return (0);
188 1.2 gehenna }
189 1.2 gehenna
190 1.14 pooka error = bdevsw_attach(bdev, bmajor);
191 1.11 ad if (error != 0)
192 1.11 ad goto fail;
193 1.14 pooka error = cdevsw_attach(cdev, cmajor);
194 1.2 gehenna if (error != 0) {
195 1.11 ad devsw_detach_locked(bdev, NULL);
196 1.11 ad goto fail;
197 1.2 gehenna }
198 1.2 gehenna
199 1.2 gehenna for (i = 0 ; i < max_devsw_convs ; i++) {
200 1.2 gehenna if (devsw_conv[i].d_name == NULL)
201 1.2 gehenna break;
202 1.2 gehenna }
203 1.2 gehenna if (i == max_devsw_convs) {
204 1.2 gehenna struct devsw_conv *newptr;
205 1.33 matt int old_convs, new_convs;
206 1.2 gehenna
207 1.33 matt old_convs = max_devsw_convs;
208 1.33 matt new_convs = old_convs + 1;
209 1.2 gehenna
210 1.33 matt newptr = kmem_zalloc(new_convs * DEVSWCONV_SIZE, KM_NOSLEEP);
211 1.2 gehenna if (newptr == NULL) {
212 1.11 ad devsw_detach_locked(bdev, cdev);
213 1.11 ad error = ENOMEM;
214 1.11 ad goto fail;
215 1.2 gehenna }
216 1.33 matt newptr[old_convs].d_name = NULL;
217 1.33 matt newptr[old_convs].d_bmajor = -1;
218 1.33 matt newptr[old_convs].d_cmajor = -1;
219 1.33 matt memcpy(newptr, devsw_conv, old_convs * DEVSWCONV_SIZE);
220 1.2 gehenna if (devsw_conv != devsw_conv0)
221 1.33 matt kmem_free(devsw_conv, old_convs * DEVSWCONV_SIZE);
222 1.2 gehenna devsw_conv = newptr;
223 1.33 matt max_devsw_convs = new_convs;
224 1.2 gehenna }
225 1.2 gehenna
226 1.25 enami len = strlen(devname) + 1;
227 1.25 enami name = kmem_alloc(len, KM_NOSLEEP);
228 1.2 gehenna if (name == NULL) {
229 1.11 ad devsw_detach_locked(bdev, cdev);
230 1.25 enami error = ENOMEM;
231 1.11 ad goto fail;
232 1.2 gehenna }
233 1.25 enami strlcpy(name, devname, len);
234 1.2 gehenna
235 1.2 gehenna devsw_conv[i].d_name = name;
236 1.2 gehenna devsw_conv[i].d_bmajor = *bmajor;
237 1.2 gehenna devsw_conv[i].d_cmajor = *cmajor;
238 1.2 gehenna
239 1.23 pooka mutex_exit(&device_lock);
240 1.2 gehenna return (0);
241 1.11 ad fail:
242 1.23 pooka mutex_exit(&device_lock);
243 1.11 ad return (error);
244 1.2 gehenna }
245 1.2 gehenna
246 1.2 gehenna static int
247 1.24 drochner bdevsw_attach(const struct bdevsw *devsw, devmajor_t *devmajor)
248 1.2 gehenna {
249 1.11 ad const struct bdevsw **newptr;
250 1.24 drochner devmajor_t bmajor;
251 1.24 drochner int i;
252 1.2 gehenna
253 1.23 pooka KASSERT(mutex_owned(&device_lock));
254 1.11 ad
255 1.2 gehenna if (devsw == NULL)
256 1.2 gehenna return (0);
257 1.2 gehenna
258 1.2 gehenna if (*devmajor < 0) {
259 1.2 gehenna for (bmajor = sys_bdevsws ; bmajor < max_bdevsws ; bmajor++) {
260 1.2 gehenna if (bdevsw[bmajor] != NULL)
261 1.2 gehenna continue;
262 1.2 gehenna for (i = 0 ; i < max_devsw_convs ; i++) {
263 1.2 gehenna if (devsw_conv[i].d_bmajor == bmajor)
264 1.2 gehenna break;
265 1.2 gehenna }
266 1.2 gehenna if (i != max_devsw_convs)
267 1.2 gehenna continue;
268 1.2 gehenna break;
269 1.2 gehenna }
270 1.3 gehenna *devmajor = bmajor;
271 1.2 gehenna }
272 1.11 ad
273 1.2 gehenna if (*devmajor >= MAXDEVSW) {
274 1.11 ad printf("bdevsw_attach: block majors exhausted");
275 1.2 gehenna return (ENOMEM);
276 1.2 gehenna }
277 1.2 gehenna
278 1.2 gehenna if (*devmajor >= max_bdevsws) {
279 1.11 ad KASSERT(bdevsw == bdevsw0);
280 1.11 ad newptr = kmem_zalloc(MAXDEVSW * BDEVSW_SIZE, KM_NOSLEEP);
281 1.2 gehenna if (newptr == NULL)
282 1.2 gehenna return (ENOMEM);
283 1.11 ad memcpy(newptr, bdevsw, max_bdevsws * BDEVSW_SIZE);
284 1.2 gehenna bdevsw = newptr;
285 1.11 ad max_bdevsws = MAXDEVSW;
286 1.2 gehenna }
287 1.2 gehenna
288 1.2 gehenna if (bdevsw[*devmajor] != NULL)
289 1.2 gehenna return (EEXIST);
290 1.2 gehenna
291 1.34.2.2 pgoyette /* ensure visibility of the bdevsw */
292 1.34.2.2 pgoyette membar_producer();
293 1.34.2.2 pgoyette
294 1.2 gehenna bdevsw[*devmajor] = devsw;
295 1.34.2.1 pgoyette KASSERT(devsw->d_localcount != NULL);
296 1.34.2.1 pgoyette localcount_init(devsw->d_localcount);
297 1.2 gehenna
298 1.2 gehenna return (0);
299 1.2 gehenna }
300 1.2 gehenna
301 1.2 gehenna static int
302 1.24 drochner cdevsw_attach(const struct cdevsw *devsw, devmajor_t *devmajor)
303 1.2 gehenna {
304 1.11 ad const struct cdevsw **newptr;
305 1.24 drochner devmajor_t cmajor;
306 1.24 drochner int i;
307 1.2 gehenna
308 1.23 pooka KASSERT(mutex_owned(&device_lock));
309 1.11 ad
310 1.2 gehenna if (*devmajor < 0) {
311 1.2 gehenna for (cmajor = sys_cdevsws ; cmajor < max_cdevsws ; cmajor++) {
312 1.2 gehenna if (cdevsw[cmajor] != NULL)
313 1.2 gehenna continue;
314 1.2 gehenna for (i = 0 ; i < max_devsw_convs ; i++) {
315 1.2 gehenna if (devsw_conv[i].d_cmajor == cmajor)
316 1.2 gehenna break;
317 1.2 gehenna }
318 1.2 gehenna if (i != max_devsw_convs)
319 1.2 gehenna continue;
320 1.2 gehenna break;
321 1.2 gehenna }
322 1.3 gehenna *devmajor = cmajor;
323 1.2 gehenna }
324 1.11 ad
325 1.2 gehenna if (*devmajor >= MAXDEVSW) {
326 1.11 ad printf("cdevsw_attach: character majors exhausted");
327 1.2 gehenna return (ENOMEM);
328 1.2 gehenna }
329 1.2 gehenna
330 1.2 gehenna if (*devmajor >= max_cdevsws) {
331 1.11 ad KASSERT(cdevsw == cdevsw0);
332 1.11 ad newptr = kmem_zalloc(MAXDEVSW * CDEVSW_SIZE, KM_NOSLEEP);
333 1.2 gehenna if (newptr == NULL)
334 1.2 gehenna return (ENOMEM);
335 1.11 ad memcpy(newptr, cdevsw, max_cdevsws * CDEVSW_SIZE);
336 1.2 gehenna cdevsw = newptr;
337 1.11 ad max_cdevsws = MAXDEVSW;
338 1.2 gehenna }
339 1.2 gehenna
340 1.2 gehenna if (cdevsw[*devmajor] != NULL)
341 1.2 gehenna return (EEXIST);
342 1.2 gehenna
343 1.34.2.2 pgoyette /* ensure visibility of the bdevsw */
344 1.34.2.2 pgoyette membar_producer();
345 1.34.2.2 pgoyette
346 1.2 gehenna cdevsw[*devmajor] = devsw;
347 1.34.2.1 pgoyette KASSERT(devsw->d_localcount != NULL);
348 1.34.2.1 pgoyette localcount_init(devsw->d_localcount);
349 1.2 gehenna
350 1.2 gehenna return (0);
351 1.2 gehenna }
352 1.2 gehenna
353 1.34.2.1 pgoyette /*
354 1.34.2.2 pgoyette * First, look up both bdev and cdev indices, and remove the
355 1.34.2.2 pgoyette * {b,c]devsw[] entries so no new references can be taken. Then
356 1.34.2.2 pgoyette * drain any existing references.
357 1.34.2.1 pgoyette */
358 1.34.2.1 pgoyette
359 1.11 ad static void
360 1.11 ad devsw_detach_locked(const struct bdevsw *bdev, const struct cdevsw *cdev)
361 1.2 gehenna {
362 1.34.2.2 pgoyette int i, j, s;
363 1.2 gehenna
364 1.23 pooka KASSERT(mutex_owned(&device_lock));
365 1.11 ad
366 1.34.2.1 pgoyette i = max_bdevsws;
367 1.2 gehenna if (bdev != NULL) {
368 1.2 gehenna for (i = 0 ; i < max_bdevsws ; i++) {
369 1.2 gehenna if (bdevsw[i] != bdev)
370 1.2 gehenna continue;
371 1.34.2.1 pgoyette
372 1.34.2.1 pgoyette KASSERTMSG(bdev->d_localcount != NULL,
373 1.34.2.1 pgoyette "%s: no bdev localcount", __func__);
374 1.2 gehenna break;
375 1.2 gehenna }
376 1.2 gehenna }
377 1.34.2.1 pgoyette j = max_cdevsws;
378 1.2 gehenna if (cdev != NULL) {
379 1.34.2.1 pgoyette for (j = 0 ; j < max_cdevsws ; j++) {
380 1.34.2.1 pgoyette if (cdevsw[j] != cdev)
381 1.2 gehenna continue;
382 1.34.2.1 pgoyette
383 1.34.2.1 pgoyette KASSERTMSG(cdev->d_localcount != NULL,
384 1.34.2.1 pgoyette "%s: no cdev localcount", __func__);
385 1.2 gehenna break;
386 1.2 gehenna }
387 1.2 gehenna }
388 1.34.2.2 pgoyette if (i < max_bdevsws)
389 1.34.2.2 pgoyette bdevsw[i] = NULL;
390 1.34.2.2 pgoyette if (j < max_cdevsws )
391 1.34.2.2 pgoyette cdevsw[j] = NULL;
392 1.34.2.2 pgoyette
393 1.34.2.2 pgoyette s = pserialize_read_enter();
394 1.34.2.2 pgoyette if (i < max_bdevsws && bdev->d_localcount != NULL) {
395 1.34.2.1 pgoyette localcount_drain(bdev->d_localcount, &device_cv, &device_lock);
396 1.34.2.1 pgoyette localcount_fini(bdev->d_localcount);
397 1.34.2.1 pgoyette }
398 1.34.2.2 pgoyette if (j < max_cdevsws && cdev->d_localcount != NULL ) {
399 1.34.2.2 pgoyette localcount_drain(cdev->d_localcount, &device_cv, &device_lock);
400 1.34.2.2 pgoyette localcount_fini(cdev->d_localcount);
401 1.34.2.1 pgoyette }
402 1.34.2.2 pgoyette pserialize_read_exit(s);
403 1.2 gehenna }
404 1.2 gehenna
405 1.19 ad int
406 1.11 ad devsw_detach(const struct bdevsw *bdev, const struct cdevsw *cdev)
407 1.11 ad {
408 1.11 ad
409 1.23 pooka mutex_enter(&device_lock);
410 1.11 ad devsw_detach_locked(bdev, cdev);
411 1.23 pooka mutex_exit(&device_lock);
412 1.19 ad return 0;
413 1.11 ad }
414 1.11 ad
415 1.11 ad /*
416 1.11 ad * Look up a block device by number.
417 1.11 ad *
418 1.11 ad * => Caller must ensure that the device is attached.
419 1.11 ad */
420 1.2 gehenna const struct bdevsw *
421 1.2 gehenna bdevsw_lookup(dev_t dev)
422 1.2 gehenna {
423 1.24 drochner devmajor_t bmajor;
424 1.2 gehenna
425 1.2 gehenna if (dev == NODEV)
426 1.2 gehenna return (NULL);
427 1.2 gehenna bmajor = major(dev);
428 1.2 gehenna if (bmajor < 0 || bmajor >= max_bdevsws)
429 1.2 gehenna return (NULL);
430 1.2 gehenna
431 1.2 gehenna return (bdevsw[bmajor]);
432 1.2 gehenna }
433 1.2 gehenna
434 1.34.2.1 pgoyette const struct bdevsw *
435 1.34.2.1 pgoyette bdevsw_lookup_acquire(dev_t dev)
436 1.34.2.1 pgoyette {
437 1.34.2.1 pgoyette devmajor_t bmajor;
438 1.34.2.2 pgoyette const struct bdevsw *bdev = NULL;
439 1.34.2.2 pgoyette int s;
440 1.34.2.1 pgoyette
441 1.34.2.1 pgoyette if (dev == NODEV)
442 1.34.2.1 pgoyette return (NULL);
443 1.34.2.1 pgoyette bmajor = major(dev);
444 1.34.2.1 pgoyette if (bmajor < 0 || bmajor >= max_bdevsws)
445 1.34.2.1 pgoyette return (NULL);
446 1.34.2.1 pgoyette
447 1.34.2.2 pgoyette /* Prevent any concurrent attempts to detach the device */
448 1.34.2.2 pgoyette mutex_enter(&device_lock);
449 1.34.2.2 pgoyette
450 1.34.2.2 pgoyette /* Start a read transaction to block localcount_drain() */
451 1.34.2.2 pgoyette s = pserialize_read_enter();
452 1.34.2.2 pgoyette
453 1.34.2.2 pgoyette /* Get the struct bdevsw pointer */
454 1.34.2.2 pgoyette bdev = bdevsw[bmajor];
455 1.34.2.2 pgoyette if (bdev == NULL)
456 1.34.2.2 pgoyette goto out;
457 1.34.2.2 pgoyette
458 1.34.2.2 pgoyette /* Wait for the content of the struct bdevsw to become visible */
459 1.34.2.2 pgoyette membar_datadep_consumer();
460 1.34.2.2 pgoyette
461 1.34.2.2 pgoyette /* If the devsw is not statically linked, acquire a reference */
462 1.34.2.1 pgoyette if (bdevsw[bmajor]->d_localcount != NULL)
463 1.34.2.1 pgoyette localcount_acquire(bdevsw[bmajor]->d_localcount);
464 1.34.2.1 pgoyette
465 1.34.2.2 pgoyette out: pserialize_read_exit(s);
466 1.34.2.2 pgoyette mutex_exit(&device_lock);
467 1.34.2.2 pgoyette
468 1.34.2.2 pgoyette return bdev;
469 1.34.2.1 pgoyette }
470 1.34.2.1 pgoyette
471 1.34.2.1 pgoyette void
472 1.34.2.1 pgoyette bdevsw_release(const struct bdevsw *bd)
473 1.34.2.1 pgoyette {
474 1.34.2.1 pgoyette
475 1.34.2.2 pgoyette KASSERT(bd != NULL);
476 1.34.2.1 pgoyette if (bd->d_localcount != NULL)
477 1.34.2.1 pgoyette localcount_release(bd->d_localcount, &device_cv, &device_lock);
478 1.34.2.1 pgoyette }
479 1.34.2.1 pgoyette
480 1.11 ad /*
481 1.11 ad * Look up a character device by number.
482 1.11 ad *
483 1.11 ad * => Caller must ensure that the device is attached.
484 1.11 ad */
485 1.2 gehenna const struct cdevsw *
486 1.2 gehenna cdevsw_lookup(dev_t dev)
487 1.2 gehenna {
488 1.24 drochner devmajor_t cmajor;
489 1.2 gehenna
490 1.2 gehenna if (dev == NODEV)
491 1.2 gehenna return (NULL);
492 1.2 gehenna cmajor = major(dev);
493 1.2 gehenna if (cmajor < 0 || cmajor >= max_cdevsws)
494 1.2 gehenna return (NULL);
495 1.2 gehenna
496 1.2 gehenna return (cdevsw[cmajor]);
497 1.2 gehenna }
498 1.2 gehenna
499 1.34.2.1 pgoyette const struct cdevsw *
500 1.34.2.1 pgoyette cdevsw_lookup_acquire(dev_t dev)
501 1.34.2.1 pgoyette {
502 1.34.2.1 pgoyette devmajor_t cmajor;
503 1.34.2.2 pgoyette const struct cdevsw *cdev = NULL;
504 1.34.2.2 pgoyette int s;
505 1.34.2.1 pgoyette
506 1.34.2.1 pgoyette if (dev == NODEV)
507 1.34.2.1 pgoyette return (NULL);
508 1.34.2.1 pgoyette cmajor = major(dev);
509 1.34.2.1 pgoyette if (cmajor < 0 || cmajor >= max_cdevsws)
510 1.34.2.1 pgoyette return (NULL);
511 1.34.2.1 pgoyette
512 1.34.2.2 pgoyette /* Prevent any concurrent attempts to detach the device */
513 1.34.2.2 pgoyette mutex_enter(&device_lock);
514 1.34.2.2 pgoyette
515 1.34.2.2 pgoyette /* Start a read transaction to block localcount_drain() */
516 1.34.2.2 pgoyette s = pserialize_read_enter();
517 1.34.2.2 pgoyette
518 1.34.2.2 pgoyette /* Get the struct bdevsw pointer */
519 1.34.2.2 pgoyette cdev = cdevsw[cmajor];
520 1.34.2.2 pgoyette if (cdev == NULL)
521 1.34.2.2 pgoyette goto out;
522 1.34.2.2 pgoyette
523 1.34.2.2 pgoyette /* Wait for the content of the struct bdevsw to become visible */
524 1.34.2.2 pgoyette membar_datadep_consumer();
525 1.34.2.2 pgoyette
526 1.34.2.2 pgoyette /* If the devsw is not statically linked, acquire a reference */
527 1.34.2.1 pgoyette if (cdevsw[cmajor]->d_localcount != NULL)
528 1.34.2.1 pgoyette localcount_acquire(cdevsw[cmajor]->d_localcount);
529 1.34.2.1 pgoyette
530 1.34.2.2 pgoyette out: pserialize_read_exit(s);
531 1.34.2.2 pgoyette mutex_exit(&device_lock);
532 1.34.2.2 pgoyette
533 1.34.2.2 pgoyette return cdev;
534 1.34.2.1 pgoyette }
535 1.34.2.1 pgoyette
536 1.34.2.1 pgoyette void
537 1.34.2.1 pgoyette cdevsw_release(const struct cdevsw *cd)
538 1.34.2.1 pgoyette {
539 1.34.2.1 pgoyette
540 1.34.2.2 pgoyette KASSERT(cd != NULL);
541 1.34.2.1 pgoyette if (cd->d_localcount != NULL)
542 1.34.2.1 pgoyette localcount_release(cd->d_localcount, &device_cv, &device_lock);
543 1.34.2.1 pgoyette }
544 1.34.2.1 pgoyette
545 1.11 ad /*
546 1.11 ad * Look up a block device by reference to its operations set.
547 1.11 ad *
548 1.11 ad * => Caller must ensure that the device is not detached, and therefore
549 1.11 ad * that the returned major is still valid when dereferenced.
550 1.11 ad */
551 1.24 drochner devmajor_t
552 1.2 gehenna bdevsw_lookup_major(const struct bdevsw *bdev)
553 1.2 gehenna {
554 1.24 drochner devmajor_t bmajor;
555 1.2 gehenna
556 1.2 gehenna for (bmajor = 0 ; bmajor < max_bdevsws ; bmajor++) {
557 1.2 gehenna if (bdevsw[bmajor] == bdev)
558 1.2 gehenna return (bmajor);
559 1.2 gehenna }
560 1.2 gehenna
561 1.24 drochner return (NODEVMAJOR);
562 1.2 gehenna }
563 1.2 gehenna
564 1.11 ad /*
565 1.11 ad * Look up a character device by reference to its operations set.
566 1.11 ad *
567 1.11 ad * => Caller must ensure that the device is not detached, and therefore
568 1.11 ad * that the returned major is still valid when dereferenced.
569 1.11 ad */
570 1.24 drochner devmajor_t
571 1.2 gehenna cdevsw_lookup_major(const struct cdevsw *cdev)
572 1.2 gehenna {
573 1.24 drochner devmajor_t cmajor;
574 1.2 gehenna
575 1.2 gehenna for (cmajor = 0 ; cmajor < max_cdevsws ; cmajor++) {
576 1.2 gehenna if (cdevsw[cmajor] == cdev)
577 1.2 gehenna return (cmajor);
578 1.2 gehenna }
579 1.2 gehenna
580 1.24 drochner return (NODEVMAJOR);
581 1.2 gehenna }
582 1.2 gehenna
583 1.2 gehenna /*
584 1.2 gehenna * Convert from block major number to name.
585 1.11 ad *
586 1.11 ad * => Caller must ensure that the device is not detached, and therefore
587 1.11 ad * that the name pointer is still valid when dereferenced.
588 1.2 gehenna */
589 1.2 gehenna const char *
590 1.24 drochner devsw_blk2name(devmajor_t bmajor)
591 1.2 gehenna {
592 1.11 ad const char *name;
593 1.24 drochner devmajor_t cmajor;
594 1.24 drochner int i;
595 1.2 gehenna
596 1.11 ad name = NULL;
597 1.11 ad cmajor = -1;
598 1.11 ad
599 1.23 pooka mutex_enter(&device_lock);
600 1.11 ad if (bmajor < 0 || bmajor >= max_bdevsws || bdevsw[bmajor] == NULL) {
601 1.23 pooka mutex_exit(&device_lock);
602 1.2 gehenna return (NULL);
603 1.2 gehenna }
604 1.11 ad for (i = 0 ; i < max_devsw_convs; i++) {
605 1.11 ad if (devsw_conv[i].d_bmajor == bmajor) {
606 1.11 ad cmajor = devsw_conv[i].d_cmajor;
607 1.11 ad break;
608 1.11 ad }
609 1.11 ad }
610 1.11 ad if (cmajor >= 0 && cmajor < max_cdevsws && cdevsw[cmajor] != NULL)
611 1.11 ad name = devsw_conv[i].d_name;
612 1.23 pooka mutex_exit(&device_lock);
613 1.2 gehenna
614 1.11 ad return (name);
615 1.2 gehenna }
616 1.2 gehenna
617 1.2 gehenna /*
618 1.26 haad * Convert char major number to device driver name.
619 1.26 haad */
620 1.27 yamt const char *
621 1.26 haad cdevsw_getname(devmajor_t major)
622 1.26 haad {
623 1.26 haad const char *name;
624 1.26 haad int i;
625 1.26 haad
626 1.26 haad name = NULL;
627 1.26 haad
628 1.26 haad if (major < 0)
629 1.26 haad return (NULL);
630 1.26 haad
631 1.26 haad mutex_enter(&device_lock);
632 1.26 haad for (i = 0 ; i < max_devsw_convs; i++) {
633 1.26 haad if (devsw_conv[i].d_cmajor == major) {
634 1.26 haad name = devsw_conv[i].d_name;
635 1.26 haad break;
636 1.26 haad }
637 1.26 haad }
638 1.26 haad mutex_exit(&device_lock);
639 1.26 haad return (name);
640 1.26 haad }
641 1.26 haad
642 1.26 haad /*
643 1.26 haad * Convert block major number to device driver name.
644 1.26 haad */
645 1.27 yamt const char *
646 1.26 haad bdevsw_getname(devmajor_t major)
647 1.26 haad {
648 1.26 haad const char *name;
649 1.26 haad int i;
650 1.26 haad
651 1.26 haad name = NULL;
652 1.26 haad
653 1.26 haad if (major < 0)
654 1.26 haad return (NULL);
655 1.26 haad
656 1.26 haad mutex_enter(&device_lock);
657 1.26 haad for (i = 0 ; i < max_devsw_convs; i++) {
658 1.26 haad if (devsw_conv[i].d_bmajor == major) {
659 1.26 haad name = devsw_conv[i].d_name;
660 1.26 haad break;
661 1.26 haad }
662 1.26 haad }
663 1.26 haad mutex_exit(&device_lock);
664 1.26 haad return (name);
665 1.26 haad }
666 1.26 haad
667 1.26 haad /*
668 1.2 gehenna * Convert from device name to block major number.
669 1.11 ad *
670 1.11 ad * => Caller must ensure that the device is not detached, and therefore
671 1.11 ad * that the major number is still valid when dereferenced.
672 1.2 gehenna */
673 1.24 drochner devmajor_t
674 1.2 gehenna devsw_name2blk(const char *name, char *devname, size_t devnamelen)
675 1.2 gehenna {
676 1.2 gehenna struct devsw_conv *conv;
677 1.24 drochner devmajor_t bmajor;
678 1.24 drochner int i;
679 1.2 gehenna
680 1.2 gehenna if (name == NULL)
681 1.24 drochner return (NODEVMAJOR);
682 1.2 gehenna
683 1.23 pooka mutex_enter(&device_lock);
684 1.2 gehenna for (i = 0 ; i < max_devsw_convs ; i++) {
685 1.5 mrg size_t len;
686 1.5 mrg
687 1.2 gehenna conv = &devsw_conv[i];
688 1.2 gehenna if (conv->d_name == NULL)
689 1.2 gehenna continue;
690 1.5 mrg len = strlen(conv->d_name);
691 1.5 mrg if (strncmp(conv->d_name, name, len) != 0)
692 1.5 mrg continue;
693 1.5 mrg if (*(name +len) && !isdigit(*(name + len)))
694 1.2 gehenna continue;
695 1.2 gehenna bmajor = conv->d_bmajor;
696 1.2 gehenna if (bmajor < 0 || bmajor >= max_bdevsws ||
697 1.2 gehenna bdevsw[bmajor] == NULL)
698 1.5 mrg break;
699 1.2 gehenna if (devname != NULL) {
700 1.2 gehenna #ifdef DEVSW_DEBUG
701 1.2 gehenna if (strlen(conv->d_name) >= devnamelen)
702 1.2 gehenna printf("devsw_name2blk: too short buffer");
703 1.2 gehenna #endif /* DEVSW_DEBUG */
704 1.4 tsutsui strncpy(devname, conv->d_name, devnamelen);
705 1.2 gehenna devname[devnamelen - 1] = '\0';
706 1.2 gehenna }
707 1.23 pooka mutex_exit(&device_lock);
708 1.2 gehenna return (bmajor);
709 1.2 gehenna }
710 1.2 gehenna
711 1.23 pooka mutex_exit(&device_lock);
712 1.24 drochner return (NODEVMAJOR);
713 1.2 gehenna }
714 1.2 gehenna
715 1.2 gehenna /*
716 1.16 plunky * Convert from device name to char major number.
717 1.16 plunky *
718 1.16 plunky * => Caller must ensure that the device is not detached, and therefore
719 1.16 plunky * that the major number is still valid when dereferenced.
720 1.16 plunky */
721 1.24 drochner devmajor_t
722 1.16 plunky devsw_name2chr(const char *name, char *devname, size_t devnamelen)
723 1.16 plunky {
724 1.16 plunky struct devsw_conv *conv;
725 1.24 drochner devmajor_t cmajor;
726 1.24 drochner int i;
727 1.16 plunky
728 1.16 plunky if (name == NULL)
729 1.24 drochner return (NODEVMAJOR);
730 1.16 plunky
731 1.23 pooka mutex_enter(&device_lock);
732 1.16 plunky for (i = 0 ; i < max_devsw_convs ; i++) {
733 1.16 plunky size_t len;
734 1.16 plunky
735 1.16 plunky conv = &devsw_conv[i];
736 1.16 plunky if (conv->d_name == NULL)
737 1.16 plunky continue;
738 1.16 plunky len = strlen(conv->d_name);
739 1.16 plunky if (strncmp(conv->d_name, name, len) != 0)
740 1.16 plunky continue;
741 1.16 plunky if (*(name +len) && !isdigit(*(name + len)))
742 1.16 plunky continue;
743 1.16 plunky cmajor = conv->d_cmajor;
744 1.16 plunky if (cmajor < 0 || cmajor >= max_cdevsws ||
745 1.16 plunky cdevsw[cmajor] == NULL)
746 1.16 plunky break;
747 1.16 plunky if (devname != NULL) {
748 1.16 plunky #ifdef DEVSW_DEBUG
749 1.16 plunky if (strlen(conv->d_name) >= devnamelen)
750 1.16 plunky printf("devsw_name2chr: too short buffer");
751 1.16 plunky #endif /* DEVSW_DEBUG */
752 1.16 plunky strncpy(devname, conv->d_name, devnamelen);
753 1.16 plunky devname[devnamelen - 1] = '\0';
754 1.16 plunky }
755 1.23 pooka mutex_exit(&device_lock);
756 1.16 plunky return (cmajor);
757 1.16 plunky }
758 1.16 plunky
759 1.23 pooka mutex_exit(&device_lock);
760 1.24 drochner return (NODEVMAJOR);
761 1.16 plunky }
762 1.16 plunky
763 1.16 plunky /*
764 1.2 gehenna * Convert from character dev_t to block dev_t.
765 1.11 ad *
766 1.11 ad * => Caller must ensure that the device is not detached, and therefore
767 1.11 ad * that the major number is still valid when dereferenced.
768 1.2 gehenna */
769 1.2 gehenna dev_t
770 1.2 gehenna devsw_chr2blk(dev_t cdev)
771 1.2 gehenna {
772 1.24 drochner devmajor_t bmajor, cmajor;
773 1.24 drochner int i;
774 1.11 ad dev_t rv;
775 1.2 gehenna
776 1.2 gehenna cmajor = major(cdev);
777 1.24 drochner bmajor = NODEVMAJOR;
778 1.11 ad rv = NODEV;
779 1.2 gehenna
780 1.23 pooka mutex_enter(&device_lock);
781 1.11 ad if (cmajor < 0 || cmajor >= max_cdevsws || cdevsw[cmajor] == NULL) {
782 1.23 pooka mutex_exit(&device_lock);
783 1.11 ad return (NODEV);
784 1.11 ad }
785 1.2 gehenna for (i = 0 ; i < max_devsw_convs ; i++) {
786 1.11 ad if (devsw_conv[i].d_cmajor == cmajor) {
787 1.11 ad bmajor = devsw_conv[i].d_bmajor;
788 1.11 ad break;
789 1.11 ad }
790 1.2 gehenna }
791 1.11 ad if (bmajor >= 0 && bmajor < max_bdevsws && bdevsw[bmajor] != NULL)
792 1.11 ad rv = makedev(bmajor, minor(cdev));
793 1.23 pooka mutex_exit(&device_lock);
794 1.2 gehenna
795 1.11 ad return (rv);
796 1.2 gehenna }
797 1.2 gehenna
798 1.2 gehenna /*
799 1.2 gehenna * Convert from block dev_t to character dev_t.
800 1.11 ad *
801 1.11 ad * => Caller must ensure that the device is not detached, and therefore
802 1.11 ad * that the major number is still valid when dereferenced.
803 1.2 gehenna */
804 1.2 gehenna dev_t
805 1.2 gehenna devsw_blk2chr(dev_t bdev)
806 1.2 gehenna {
807 1.24 drochner devmajor_t bmajor, cmajor;
808 1.24 drochner int i;
809 1.11 ad dev_t rv;
810 1.2 gehenna
811 1.11 ad bmajor = major(bdev);
812 1.24 drochner cmajor = NODEVMAJOR;
813 1.11 ad rv = NODEV;
814 1.11 ad
815 1.23 pooka mutex_enter(&device_lock);
816 1.11 ad if (bmajor < 0 || bmajor >= max_bdevsws || bdevsw[bmajor] == NULL) {
817 1.23 pooka mutex_exit(&device_lock);
818 1.2 gehenna return (NODEV);
819 1.11 ad }
820 1.11 ad for (i = 0 ; i < max_devsw_convs ; i++) {
821 1.11 ad if (devsw_conv[i].d_bmajor == bmajor) {
822 1.11 ad cmajor = devsw_conv[i].d_cmajor;
823 1.11 ad break;
824 1.11 ad }
825 1.11 ad }
826 1.11 ad if (cmajor >= 0 && cmajor < max_cdevsws && cdevsw[cmajor] != NULL)
827 1.11 ad rv = makedev(cmajor, minor(bdev));
828 1.23 pooka mutex_exit(&device_lock);
829 1.2 gehenna
830 1.11 ad return (rv);
831 1.11 ad }
832 1.11 ad
833 1.11 ad /*
834 1.11 ad * Device access methods.
835 1.11 ad */
836 1.11 ad
837 1.11 ad #define DEV_LOCK(d) \
838 1.17 ad if ((mpflag = (d->d_flag & D_MPSAFE)) == 0) { \
839 1.17 ad KERNEL_LOCK(1, NULL); \
840 1.11 ad }
841 1.2 gehenna
842 1.11 ad #define DEV_UNLOCK(d) \
843 1.17 ad if (mpflag == 0) { \
844 1.17 ad KERNEL_UNLOCK_ONE(NULL); \
845 1.2 gehenna }
846 1.2 gehenna
847 1.11 ad int
848 1.11 ad bdev_open(dev_t dev, int flag, int devtype, lwp_t *l)
849 1.11 ad {
850 1.11 ad const struct bdevsw *d;
851 1.17 ad int rv, mpflag;
852 1.11 ad
853 1.11 ad /*
854 1.11 ad * For open we need to lock, in order to synchronize
855 1.11 ad * with attach/detach.
856 1.11 ad */
857 1.23 pooka mutex_enter(&device_lock);
858 1.11 ad d = bdevsw_lookup(dev);
859 1.23 pooka mutex_exit(&device_lock);
860 1.11 ad if (d == NULL)
861 1.11 ad return ENXIO;
862 1.11 ad
863 1.11 ad DEV_LOCK(d);
864 1.11 ad rv = (*d->d_open)(dev, flag, devtype, l);
865 1.11 ad DEV_UNLOCK(d);
866 1.11 ad
867 1.11 ad return rv;
868 1.11 ad }
869 1.11 ad
870 1.11 ad int
871 1.11 ad bdev_close(dev_t dev, int flag, int devtype, lwp_t *l)
872 1.11 ad {
873 1.11 ad const struct bdevsw *d;
874 1.17 ad int rv, mpflag;
875 1.11 ad
876 1.11 ad if ((d = bdevsw_lookup(dev)) == NULL)
877 1.11 ad return ENXIO;
878 1.11 ad
879 1.11 ad DEV_LOCK(d);
880 1.11 ad rv = (*d->d_close)(dev, flag, devtype, l);
881 1.11 ad DEV_UNLOCK(d);
882 1.11 ad
883 1.11 ad return rv;
884 1.11 ad }
885 1.11 ad
886 1.34 riz SDT_PROVIDER_DECLARE(io);
887 1.34 riz SDT_PROBE_DEFINE1(io, kernel, , start, "struct buf *"/*bp*/);
888 1.34 riz
889 1.11 ad void
890 1.11 ad bdev_strategy(struct buf *bp)
891 1.11 ad {
892 1.11 ad const struct bdevsw *d;
893 1.17 ad int mpflag;
894 1.11 ad
895 1.34 riz SDT_PROBE1(io, kernel, , start, bp);
896 1.34 riz
897 1.28 jmcneill if ((d = bdevsw_lookup(bp->b_dev)) == NULL) {
898 1.28 jmcneill bp->b_error = ENXIO;
899 1.28 jmcneill bp->b_resid = bp->b_bcount;
900 1.31 pooka biodone_vfs(bp); /* biodone() iff vfs present */
901 1.28 jmcneill return;
902 1.28 jmcneill }
903 1.11 ad
904 1.11 ad DEV_LOCK(d);
905 1.11 ad (*d->d_strategy)(bp);
906 1.11 ad DEV_UNLOCK(d);
907 1.11 ad }
908 1.11 ad
909 1.11 ad int
910 1.11 ad bdev_ioctl(dev_t dev, u_long cmd, void *data, int flag, lwp_t *l)
911 1.11 ad {
912 1.11 ad const struct bdevsw *d;
913 1.17 ad int rv, mpflag;
914 1.11 ad
915 1.11 ad if ((d = bdevsw_lookup(dev)) == NULL)
916 1.11 ad return ENXIO;
917 1.11 ad
918 1.11 ad DEV_LOCK(d);
919 1.11 ad rv = (*d->d_ioctl)(dev, cmd, data, flag, l);
920 1.11 ad DEV_UNLOCK(d);
921 1.11 ad
922 1.11 ad return rv;
923 1.11 ad }
924 1.11 ad
925 1.11 ad int
926 1.11 ad bdev_dump(dev_t dev, daddr_t addr, void *data, size_t sz)
927 1.11 ad {
928 1.11 ad const struct bdevsw *d;
929 1.11 ad int rv;
930 1.11 ad
931 1.11 ad /*
932 1.11 ad * Dump can be called without the device open. Since it can
933 1.11 ad * currently only be called with the system paused (and in a
934 1.11 ad * potentially unstable state), we don't perform any locking.
935 1.11 ad */
936 1.11 ad if ((d = bdevsw_lookup(dev)) == NULL)
937 1.11 ad return ENXIO;
938 1.11 ad
939 1.11 ad /* DEV_LOCK(d); */
940 1.11 ad rv = (*d->d_dump)(dev, addr, data, sz);
941 1.11 ad /* DEV_UNLOCK(d); */
942 1.11 ad
943 1.11 ad return rv;
944 1.11 ad }
945 1.11 ad
946 1.11 ad int
947 1.11 ad bdev_type(dev_t dev)
948 1.11 ad {
949 1.11 ad const struct bdevsw *d;
950 1.11 ad
951 1.11 ad if ((d = bdevsw_lookup(dev)) == NULL)
952 1.11 ad return D_OTHER;
953 1.11 ad return d->d_flag & D_TYPEMASK;
954 1.11 ad }
955 1.11 ad
956 1.11 ad int
957 1.29 mrg bdev_size(dev_t dev)
958 1.29 mrg {
959 1.29 mrg const struct bdevsw *d;
960 1.29 mrg int rv, mpflag = 0;
961 1.29 mrg
962 1.29 mrg if ((d = bdevsw_lookup(dev)) == NULL ||
963 1.29 mrg d->d_psize == NULL)
964 1.29 mrg return -1;
965 1.29 mrg
966 1.29 mrg /*
967 1.29 mrg * Don't to try lock the device if we're dumping.
968 1.30 mrg * XXX: is there a better way to test this?
969 1.29 mrg */
970 1.29 mrg if ((boothowto & RB_DUMP) == 0)
971 1.29 mrg DEV_LOCK(d);
972 1.29 mrg rv = (*d->d_psize)(dev);
973 1.29 mrg if ((boothowto & RB_DUMP) == 0)
974 1.29 mrg DEV_UNLOCK(d);
975 1.29 mrg
976 1.29 mrg return rv;
977 1.29 mrg }
978 1.29 mrg
979 1.29 mrg int
980 1.32 dholland bdev_discard(dev_t dev, off_t pos, off_t len)
981 1.32 dholland {
982 1.32 dholland const struct bdevsw *d;
983 1.32 dholland int rv, mpflag;
984 1.32 dholland
985 1.32 dholland if ((d = bdevsw_lookup(dev)) == NULL)
986 1.32 dholland return ENXIO;
987 1.32 dholland
988 1.32 dholland DEV_LOCK(d);
989 1.32 dholland rv = (*d->d_discard)(dev, pos, len);
990 1.32 dholland DEV_UNLOCK(d);
991 1.32 dholland
992 1.32 dholland return rv;
993 1.32 dholland }
994 1.32 dholland
995 1.32 dholland int
996 1.11 ad cdev_open(dev_t dev, int flag, int devtype, lwp_t *l)
997 1.11 ad {
998 1.11 ad const struct cdevsw *d;
999 1.17 ad int rv, mpflag;
1000 1.11 ad
1001 1.11 ad /*
1002 1.11 ad * For open we need to lock, in order to synchronize
1003 1.11 ad * with attach/detach.
1004 1.11 ad */
1005 1.23 pooka mutex_enter(&device_lock);
1006 1.11 ad d = cdevsw_lookup(dev);
1007 1.23 pooka mutex_exit(&device_lock);
1008 1.11 ad if (d == NULL)
1009 1.11 ad return ENXIO;
1010 1.11 ad
1011 1.11 ad DEV_LOCK(d);
1012 1.11 ad rv = (*d->d_open)(dev, flag, devtype, l);
1013 1.11 ad DEV_UNLOCK(d);
1014 1.11 ad
1015 1.11 ad return rv;
1016 1.11 ad }
1017 1.11 ad
1018 1.11 ad int
1019 1.11 ad cdev_close(dev_t dev, int flag, int devtype, lwp_t *l)
1020 1.11 ad {
1021 1.11 ad const struct cdevsw *d;
1022 1.17 ad int rv, mpflag;
1023 1.11 ad
1024 1.11 ad if ((d = cdevsw_lookup(dev)) == NULL)
1025 1.11 ad return ENXIO;
1026 1.11 ad
1027 1.11 ad DEV_LOCK(d);
1028 1.11 ad rv = (*d->d_close)(dev, flag, devtype, l);
1029 1.11 ad DEV_UNLOCK(d);
1030 1.11 ad
1031 1.11 ad return rv;
1032 1.11 ad }
1033 1.11 ad
1034 1.11 ad int
1035 1.11 ad cdev_read(dev_t dev, struct uio *uio, int flag)
1036 1.11 ad {
1037 1.11 ad const struct cdevsw *d;
1038 1.17 ad int rv, mpflag;
1039 1.11 ad
1040 1.11 ad if ((d = cdevsw_lookup(dev)) == NULL)
1041 1.11 ad return ENXIO;
1042 1.11 ad
1043 1.11 ad DEV_LOCK(d);
1044 1.11 ad rv = (*d->d_read)(dev, uio, flag);
1045 1.11 ad DEV_UNLOCK(d);
1046 1.11 ad
1047 1.11 ad return rv;
1048 1.11 ad }
1049 1.11 ad
1050 1.11 ad int
1051 1.11 ad cdev_write(dev_t dev, struct uio *uio, int flag)
1052 1.11 ad {
1053 1.11 ad const struct cdevsw *d;
1054 1.17 ad int rv, mpflag;
1055 1.11 ad
1056 1.11 ad if ((d = cdevsw_lookup(dev)) == NULL)
1057 1.11 ad return ENXIO;
1058 1.11 ad
1059 1.11 ad DEV_LOCK(d);
1060 1.11 ad rv = (*d->d_write)(dev, uio, flag);
1061 1.11 ad DEV_UNLOCK(d);
1062 1.11 ad
1063 1.11 ad return rv;
1064 1.11 ad }
1065 1.11 ad
1066 1.11 ad int
1067 1.11 ad cdev_ioctl(dev_t dev, u_long cmd, void *data, int flag, lwp_t *l)
1068 1.11 ad {
1069 1.11 ad const struct cdevsw *d;
1070 1.17 ad int rv, mpflag;
1071 1.11 ad
1072 1.11 ad if ((d = cdevsw_lookup(dev)) == NULL)
1073 1.11 ad return ENXIO;
1074 1.11 ad
1075 1.11 ad DEV_LOCK(d);
1076 1.11 ad rv = (*d->d_ioctl)(dev, cmd, data, flag, l);
1077 1.11 ad DEV_UNLOCK(d);
1078 1.11 ad
1079 1.11 ad return rv;
1080 1.11 ad }
1081 1.11 ad
1082 1.11 ad void
1083 1.11 ad cdev_stop(struct tty *tp, int flag)
1084 1.11 ad {
1085 1.11 ad const struct cdevsw *d;
1086 1.17 ad int mpflag;
1087 1.11 ad
1088 1.11 ad if ((d = cdevsw_lookup(tp->t_dev)) == NULL)
1089 1.11 ad return;
1090 1.11 ad
1091 1.11 ad DEV_LOCK(d);
1092 1.11 ad (*d->d_stop)(tp, flag);
1093 1.11 ad DEV_UNLOCK(d);
1094 1.11 ad }
1095 1.11 ad
1096 1.11 ad struct tty *
1097 1.11 ad cdev_tty(dev_t dev)
1098 1.11 ad {
1099 1.11 ad const struct cdevsw *d;
1100 1.11 ad
1101 1.11 ad if ((d = cdevsw_lookup(dev)) == NULL)
1102 1.11 ad return NULL;
1103 1.11 ad
1104 1.12 ad /* XXX Check if necessary. */
1105 1.12 ad if (d->d_tty == NULL)
1106 1.12 ad return NULL;
1107 1.12 ad
1108 1.21 ad return (*d->d_tty)(dev);
1109 1.11 ad }
1110 1.11 ad
1111 1.11 ad int
1112 1.11 ad cdev_poll(dev_t dev, int flag, lwp_t *l)
1113 1.11 ad {
1114 1.11 ad const struct cdevsw *d;
1115 1.17 ad int rv, mpflag;
1116 1.11 ad
1117 1.11 ad if ((d = cdevsw_lookup(dev)) == NULL)
1118 1.11 ad return POLLERR;
1119 1.11 ad
1120 1.11 ad DEV_LOCK(d);
1121 1.11 ad rv = (*d->d_poll)(dev, flag, l);
1122 1.11 ad DEV_UNLOCK(d);
1123 1.11 ad
1124 1.11 ad return rv;
1125 1.11 ad }
1126 1.11 ad
1127 1.11 ad paddr_t
1128 1.11 ad cdev_mmap(dev_t dev, off_t off, int flag)
1129 1.11 ad {
1130 1.11 ad const struct cdevsw *d;
1131 1.11 ad paddr_t rv;
1132 1.17 ad int mpflag;
1133 1.11 ad
1134 1.11 ad if ((d = cdevsw_lookup(dev)) == NULL)
1135 1.11 ad return (paddr_t)-1LL;
1136 1.11 ad
1137 1.11 ad DEV_LOCK(d);
1138 1.11 ad rv = (*d->d_mmap)(dev, off, flag);
1139 1.11 ad DEV_UNLOCK(d);
1140 1.11 ad
1141 1.11 ad return rv;
1142 1.11 ad }
1143 1.11 ad
1144 1.11 ad int
1145 1.11 ad cdev_kqfilter(dev_t dev, struct knote *kn)
1146 1.11 ad {
1147 1.11 ad const struct cdevsw *d;
1148 1.17 ad int rv, mpflag;
1149 1.11 ad
1150 1.11 ad if ((d = cdevsw_lookup(dev)) == NULL)
1151 1.11 ad return ENXIO;
1152 1.11 ad
1153 1.11 ad DEV_LOCK(d);
1154 1.11 ad rv = (*d->d_kqfilter)(dev, kn);
1155 1.11 ad DEV_UNLOCK(d);
1156 1.11 ad
1157 1.11 ad return rv;
1158 1.11 ad }
1159 1.11 ad
1160 1.11 ad int
1161 1.32 dholland cdev_discard(dev_t dev, off_t pos, off_t len)
1162 1.32 dholland {
1163 1.32 dholland const struct cdevsw *d;
1164 1.32 dholland int rv, mpflag;
1165 1.32 dholland
1166 1.32 dholland if ((d = cdevsw_lookup(dev)) == NULL)
1167 1.32 dholland return ENXIO;
1168 1.32 dholland
1169 1.32 dholland DEV_LOCK(d);
1170 1.32 dholland rv = (*d->d_discard)(dev, pos, len);
1171 1.32 dholland DEV_UNLOCK(d);
1172 1.32 dholland
1173 1.32 dholland return rv;
1174 1.32 dholland }
1175 1.32 dholland
1176 1.32 dholland int
1177 1.11 ad cdev_type(dev_t dev)
1178 1.11 ad {
1179 1.11 ad const struct cdevsw *d;
1180 1.11 ad
1181 1.11 ad if ((d = cdevsw_lookup(dev)) == NULL)
1182 1.11 ad return D_OTHER;
1183 1.11 ad return d->d_flag & D_TYPEMASK;
1184 1.2 gehenna }
1185