subr_devsw.c revision 1.1.2.5 1 1.1.2.5 gehenna /* $NetBSD: subr_devsw.c,v 1.1.2.5 2002/05/22 10:57:12 gehenna Exp $ */
2 1.1.2.1 gehenna /*-
3 1.1.2.1 gehenna * Copyright (c) 2001,2002 The NetBSD Foundation, Inc.
4 1.1.2.1 gehenna * All rights reserved.
5 1.1.2.1 gehenna *
6 1.1.2.1 gehenna * This code is derived from software contributed to The NetBSD Foundation
7 1.1.2.1 gehenna * by MAEKAWA Masahide <gehenna (at) NetBSD.org>.
8 1.1.2.1 gehenna *
9 1.1.2.1 gehenna * Redistribution and use in source and binary forms, with or without
10 1.1.2.1 gehenna * modification, are permitted provided that the following conditions
11 1.1.2.1 gehenna * are met:
12 1.1.2.1 gehenna * 1. Redistributions of source code must retain the above copyright
13 1.1.2.1 gehenna * notice, this list of conditions and the following disclaimer.
14 1.1.2.1 gehenna * 2. Redistributions in binary form must reproduce the above copyright
15 1.1.2.1 gehenna * notice, this list of conditions and the following disclaimer in the
16 1.1.2.1 gehenna * documentation and/or other materials provided with the distribution.
17 1.1.2.1 gehenna * 3. All advertising materials mentioning features or use of this software
18 1.1.2.1 gehenna * must display the following acknowledgement:
19 1.1.2.1 gehenna * This product includes software developed by the NetBSD
20 1.1.2.1 gehenna * Foundation, Inc. and its contributors.
21 1.1.2.1 gehenna * 4. Neither the name of The NetBSD Foundation nor the names of its
22 1.1.2.1 gehenna * contributors may be used to endorse or promote products derived
23 1.1.2.1 gehenna * from this software without specific prior written permission.
24 1.1.2.1 gehenna *
25 1.1.2.1 gehenna * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
26 1.1.2.1 gehenna * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
27 1.1.2.1 gehenna * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
28 1.1.2.1 gehenna * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
29 1.1.2.1 gehenna * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
30 1.1.2.1 gehenna * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
31 1.1.2.1 gehenna * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
32 1.1.2.1 gehenna * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
33 1.1.2.1 gehenna * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
34 1.1.2.1 gehenna * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
35 1.1.2.1 gehenna * POSSIBILITY OF SUCH DAMAGE.
36 1.1.2.1 gehenna */
37 1.1.2.1 gehenna
38 1.1.2.1 gehenna /*
39 1.1.2.1 gehenna * New device switch framework is developing.
40 1.1.2.1 gehenna * So debug options are always turned on.
41 1.1.2.1 gehenna */
42 1.1.2.1 gehenna #ifndef DEVSW_DEBUG
43 1.1.2.1 gehenna #define DEVSW_DEBUG
44 1.1.2.1 gehenna #endif /* DEVSW_DEBUG */
45 1.1.2.1 gehenna
46 1.1.2.1 gehenna #include <sys/param.h>
47 1.1.2.1 gehenna #include <sys/conf.h>
48 1.1.2.1 gehenna #include <sys/malloc.h>
49 1.1.2.1 gehenna #include <sys/systm.h>
50 1.1.2.1 gehenna
51 1.1.2.1 gehenna #ifdef DEVSW_DEBUG
52 1.1.2.1 gehenna #define DPRINTF(x) printf x
53 1.1.2.1 gehenna #else /* DEVSW_DEBUG */
54 1.1.2.1 gehenna #define DPRINTF(x)
55 1.1.2.1 gehenna #endif /* DEVSW_DEBUG */
56 1.1.2.1 gehenna
57 1.1.2.1 gehenna #define MAXDEVSW 4096 /* the maximum of major device number */
58 1.1.2.1 gehenna #define BDEVSW_SIZE (sizeof(struct bdevsw *))
59 1.1.2.1 gehenna #define CDEVSW_SIZE (sizeof(struct cdevsw *))
60 1.1.2.1 gehenna #define DEVSWCONV_SIZE (sizeof(struct devsw_conv))
61 1.1.2.1 gehenna
62 1.1.2.1 gehenna extern const struct bdevsw **bdevsw, *bdevsw0[];
63 1.1.2.1 gehenna extern const struct cdevsw **cdevsw, *cdevsw0[];
64 1.1.2.1 gehenna extern struct devsw_conv *devsw_conv, devsw_conv0[];
65 1.1.2.3 gehenna extern const int sys_bdevsws, sys_cdevsws;
66 1.1.2.3 gehenna extern int max_bdevsws, max_cdevsws;
67 1.1.2.1 gehenna
68 1.1.2.1 gehenna int
69 1.1.2.1 gehenna devsw_attach(const char *devname, const struct bdevsw *bdev, int *bmajor,
70 1.1.2.1 gehenna const struct cdevsw *cdev, int *cmajor)
71 1.1.2.1 gehenna {
72 1.1.2.1 gehenna int i;
73 1.1.2.1 gehenna
74 1.1.2.3 gehenna if (devname == NULL || cdev == NULL)
75 1.1.2.1 gehenna return (EINVAL);
76 1.1.2.1 gehenna
77 1.1.2.1 gehenna if (bdevsw_lookup_major(bdev) != -1 ||
78 1.1.2.1 gehenna cdevsw_lookup_major(cdev) != -1)
79 1.1.2.1 gehenna return (EEXIST);
80 1.1.2.1 gehenna
81 1.1.2.3 gehenna if (*cmajor < 0) {
82 1.1.2.3 gehenna for (i = 0 ; i < max_cdevsws ; i++) {
83 1.1.2.3 gehenna if (devsw_conv[i].d_name == NULL ||
84 1.1.2.3 gehenna strcmp(devname, devsw_conv[i].d_name) != 0)
85 1.1.2.3 gehenna continue;
86 1.1.2.3 gehenna *cmajor = i;
87 1.1.2.3 gehenna if (devsw_conv[i].d_bmajor != -1) {
88 1.1.2.3 gehenna if (bdev == NULL)
89 1.1.2.3 gehenna return (EINVAL);
90 1.1.2.3 gehenna if (*bmajor != -1 &&
91 1.1.2.3 gehenna *bmajor != devsw_conv[i].d_bmajor)
92 1.1.2.3 gehenna return (EINVAL);
93 1.1.2.3 gehenna *bmajor = devsw_conv[i].d_bmajor;
94 1.1.2.3 gehenna }
95 1.1.2.5 gehenna break;
96 1.1.2.3 gehenna }
97 1.1.2.3 gehenna }
98 1.1.2.3 gehenna
99 1.1.2.1 gehenna if (bdev != NULL) {
100 1.1.2.1 gehenna if (*bmajor < 0) {
101 1.1.2.4 gehenna for (i = sys_bdevsws ; i < max_bdevsws ; i++) {
102 1.1.2.5 gehenna int j;
103 1.1.2.5 gehenna
104 1.1.2.1 gehenna if (bdevsw[i] != NULL)
105 1.1.2.1 gehenna continue;
106 1.1.2.5 gehenna for (j = sys_cdevsws ; j < max_cdevsws ; j++) {
107 1.1.2.5 gehenna if (i == devsw_conv[i].d_bmajor)
108 1.1.2.5 gehenna break;
109 1.1.2.5 gehenna }
110 1.1.2.5 gehenna if (j != max_cdevsws)
111 1.1.2.5 gehenna continue;
112 1.1.2.1 gehenna *bmajor = i;
113 1.1.2.1 gehenna break;
114 1.1.2.1 gehenna }
115 1.1.2.4 gehenna if (*bmajor < 0)
116 1.1.2.4 gehenna *bmajor = max_bdevsws;
117 1.1.2.4 gehenna if (*bmajor >= MAXDEVSW)
118 1.1.2.1 gehenna return (EINVAL);
119 1.1.2.1 gehenna }
120 1.1.2.1 gehenna
121 1.1.2.3 gehenna if (*bmajor >= max_bdevsws) {
122 1.1.2.4 gehenna int old = max_bdevsws, new = *bmajor + 1;
123 1.1.2.3 gehenna const struct bdevsw **newptr;
124 1.1.2.1 gehenna
125 1.1.2.1 gehenna newptr = malloc(new * BDEVSW_SIZE, M_DEVBUF, M_NOWAIT);
126 1.1.2.1 gehenna if (newptr == NULL)
127 1.1.2.1 gehenna return (ENOMEM);
128 1.1.2.1 gehenna memset(newptr + old, 0, (new - old) * BDEVSW_SIZE);
129 1.1.2.1 gehenna if (old != 0) {
130 1.1.2.1 gehenna memcpy(newptr, bdevsw, old * BDEVSW_SIZE);
131 1.1.2.1 gehenna if (bdevsw != bdevsw0)
132 1.1.2.1 gehenna free(bdevsw, M_DEVBUF);
133 1.1.2.1 gehenna }
134 1.1.2.3 gehenna bdevsw = newptr;
135 1.1.2.3 gehenna max_bdevsws = new;
136 1.1.2.1 gehenna }
137 1.1.2.1 gehenna
138 1.1.2.1 gehenna if (bdevsw[*bmajor] != NULL)
139 1.1.2.1 gehenna return (EEXIST);
140 1.1.2.1 gehenna }
141 1.1.2.1 gehenna
142 1.1.2.3 gehenna if (*cmajor < 0) {
143 1.1.2.4 gehenna for (i = sys_cdevsws ; i < max_cdevsws ; i++) {
144 1.1.2.5 gehenna if (cdevsw[i] != NULL || devsw_conv[i].d_name != NULL)
145 1.1.2.3 gehenna continue;
146 1.1.2.3 gehenna *cmajor = i;
147 1.1.2.3 gehenna break;
148 1.1.2.1 gehenna }
149 1.1.2.4 gehenna if (*cmajor < 0)
150 1.1.2.4 gehenna *cmajor = max_cdevsws;
151 1.1.2.4 gehenna if (*cmajor >= MAXDEVSW)
152 1.1.2.3 gehenna return (EINVAL);
153 1.1.2.3 gehenna }
154 1.1.2.1 gehenna
155 1.1.2.3 gehenna if (*cmajor >= max_cdevsws) {
156 1.1.2.4 gehenna int old = max_cdevsws, new = *cmajor + 1;
157 1.1.2.3 gehenna const struct cdevsw **newptr;
158 1.1.2.3 gehenna struct devsw_conv *newconv;
159 1.1.2.3 gehenna
160 1.1.2.3 gehenna newptr = malloc(new * CDEVSW_SIZE, M_DEVBUF, M_NOWAIT);
161 1.1.2.3 gehenna if (newptr == NULL)
162 1.1.2.3 gehenna return (ENOMEM);
163 1.1.2.3 gehenna memset(newptr + old, 0, (new - old) * CDEVSW_SIZE);
164 1.1.2.3 gehenna if (old != 0) {
165 1.1.2.3 gehenna memcpy(newptr, cdevsw, old * CDEVSW_SIZE);
166 1.1.2.3 gehenna if (cdevsw != cdevsw0)
167 1.1.2.3 gehenna free(cdevsw, M_DEVBUF);
168 1.1.2.1 gehenna }
169 1.1.2.3 gehenna cdevsw = newptr;
170 1.1.2.3 gehenna max_cdevsws = new;
171 1.1.2.1 gehenna
172 1.1.2.3 gehenna newconv = malloc(new * DEVSWCONV_SIZE, M_DEVBUF, M_NOWAIT);
173 1.1.2.3 gehenna if (newconv == NULL)
174 1.1.2.3 gehenna return (ENOMEM);
175 1.1.2.3 gehenna for (i = old ; i < new ; i++) {
176 1.1.2.3 gehenna newconv[i].d_name = NULL;
177 1.1.2.3 gehenna newconv[i].d_bmajor = -1;
178 1.1.2.3 gehenna }
179 1.1.2.3 gehenna if (old != 0) {
180 1.1.2.3 gehenna memcpy(newconv, devsw_conv, old * DEVSWCONV_SIZE);
181 1.1.2.3 gehenna if (devsw_conv != devsw_conv0)
182 1.1.2.3 gehenna free(devsw_conv, M_DEVBUF);
183 1.1.2.3 gehenna }
184 1.1.2.3 gehenna devsw_conv = newconv;
185 1.1.2.1 gehenna }
186 1.1.2.1 gehenna
187 1.1.2.3 gehenna if (cdevsw[*cmajor] != NULL)
188 1.1.2.3 gehenna return (EEXIST);
189 1.1.2.1 gehenna
190 1.1.2.3 gehenna if (devsw_conv[*cmajor].d_name == NULL) {
191 1.1.2.3 gehenna char *name;
192 1.1.2.3 gehenna name = malloc(strlen(devname) + 1, M_DEVBUF, M_NOWAIT);
193 1.1.2.3 gehenna if (name == NULL)
194 1.1.2.3 gehenna return (ENOMEM);
195 1.1.2.3 gehenna strcpy(name, devname);
196 1.1.2.3 gehenna devsw_conv[*cmajor].d_name = name;
197 1.1.2.1 gehenna }
198 1.1.2.1 gehenna
199 1.1.2.3 gehenna if (bdev != NULL) {
200 1.1.2.1 gehenna bdevsw[*bmajor] = bdev;
201 1.1.2.3 gehenna devsw_conv[*cmajor].d_bmajor = *bmajor;
202 1.1.2.1 gehenna }
203 1.1.2.3 gehenna cdevsw[*cmajor] = cdev;
204 1.1.2.1 gehenna
205 1.1.2.1 gehenna return (0);
206 1.1.2.1 gehenna }
207 1.1.2.1 gehenna
208 1.1.2.1 gehenna void
209 1.1.2.1 gehenna devsw_detach(const struct bdevsw *bdev, const struct cdevsw *cdev)
210 1.1.2.1 gehenna {
211 1.1.2.3 gehenna int i;
212 1.1.2.1 gehenna
213 1.1.2.1 gehenna if (bdev != NULL) {
214 1.1.2.3 gehenna for (i = 0 ; i < max_bdevsws ; i++) {
215 1.1.2.1 gehenna if (bdevsw[i] != bdev)
216 1.1.2.1 gehenna continue;
217 1.1.2.1 gehenna bdevsw[i] = NULL;
218 1.1.2.1 gehenna break;
219 1.1.2.1 gehenna }
220 1.1.2.1 gehenna }
221 1.1.2.1 gehenna if (cdev != NULL) {
222 1.1.2.3 gehenna for (i = 0 ; i < max_cdevsws ; i++) {
223 1.1.2.1 gehenna if (cdevsw[i] != cdev)
224 1.1.2.1 gehenna continue;
225 1.1.2.1 gehenna cdevsw[i] = NULL;
226 1.1.2.1 gehenna break;
227 1.1.2.1 gehenna }
228 1.1.2.1 gehenna }
229 1.1.2.1 gehenna }
230 1.1.2.1 gehenna
231 1.1.2.1 gehenna const struct bdevsw *
232 1.1.2.1 gehenna bdevsw_lookup(dev_t dev)
233 1.1.2.1 gehenna {
234 1.1.2.1 gehenna int bmajor;
235 1.1.2.1 gehenna
236 1.1.2.1 gehenna if (dev == NODEV)
237 1.1.2.1 gehenna return (NULL);
238 1.1.2.1 gehenna bmajor = major(dev);
239 1.1.2.3 gehenna if (bmajor < 0 || bmajor >= max_bdevsws)
240 1.1.2.1 gehenna return (NULL);
241 1.1.2.1 gehenna
242 1.1.2.1 gehenna return (bdevsw[bmajor]);
243 1.1.2.1 gehenna }
244 1.1.2.1 gehenna
245 1.1.2.1 gehenna const struct cdevsw *
246 1.1.2.1 gehenna cdevsw_lookup(dev_t dev)
247 1.1.2.1 gehenna {
248 1.1.2.1 gehenna int cmajor;
249 1.1.2.1 gehenna
250 1.1.2.1 gehenna if (dev == NODEV)
251 1.1.2.1 gehenna return (NULL);
252 1.1.2.1 gehenna cmajor = major(dev);
253 1.1.2.3 gehenna if (cmajor < 0 || cmajor >= max_cdevsws)
254 1.1.2.1 gehenna return (NULL);
255 1.1.2.1 gehenna
256 1.1.2.1 gehenna return (cdevsw[cmajor]);
257 1.1.2.1 gehenna }
258 1.1.2.1 gehenna
259 1.1.2.1 gehenna int
260 1.1.2.1 gehenna bdevsw_lookup_major(const struct bdevsw *bdev)
261 1.1.2.1 gehenna {
262 1.1.2.1 gehenna int bmajor;
263 1.1.2.1 gehenna
264 1.1.2.3 gehenna for (bmajor = 0 ; bmajor < max_bdevsws ; bmajor++) {
265 1.1.2.1 gehenna if (bdevsw[bmajor] == bdev)
266 1.1.2.1 gehenna return (bmajor);
267 1.1.2.1 gehenna }
268 1.1.2.1 gehenna
269 1.1.2.1 gehenna return (-1);
270 1.1.2.1 gehenna }
271 1.1.2.1 gehenna
272 1.1.2.1 gehenna int
273 1.1.2.1 gehenna cdevsw_lookup_major(const struct cdevsw *cdev)
274 1.1.2.1 gehenna {
275 1.1.2.1 gehenna int cmajor;
276 1.1.2.1 gehenna
277 1.1.2.3 gehenna for (cmajor = 0 ; cmajor < max_cdevsws ; cmajor++) {
278 1.1.2.1 gehenna if (cdevsw[cmajor] == cdev)
279 1.1.2.1 gehenna return (cmajor);
280 1.1.2.1 gehenna }
281 1.1.2.1 gehenna
282 1.1.2.1 gehenna return (-1);
283 1.1.2.1 gehenna }
284 1.1.2.1 gehenna
285 1.1.2.1 gehenna /*
286 1.1.2.1 gehenna * Convert from block major number to name.
287 1.1.2.1 gehenna */
288 1.1.2.1 gehenna const char *
289 1.1.2.1 gehenna devsw_blk2name(int bmajor)
290 1.1.2.1 gehenna {
291 1.1.2.1 gehenna int i;
292 1.1.2.1 gehenna
293 1.1.2.3 gehenna if (bmajor < 0 || bmajor >= max_bdevsws)
294 1.1.2.3 gehenna return (NULL);
295 1.1.2.3 gehenna if (bdevsw[bmajor] == NULL)
296 1.1.2.1 gehenna return (NULL);
297 1.1.2.1 gehenna
298 1.1.2.3 gehenna for (i = 0 ; i < max_cdevsws ; i++) {
299 1.1.2.3 gehenna if (devsw_conv[i].d_bmajor != bmajor)
300 1.1.2.1 gehenna continue;
301 1.1.2.3 gehenna if (cdevsw[i] == NULL)
302 1.1.2.3 gehenna return (NULL);
303 1.1.2.1 gehenna return (devsw_conv[i].d_name);
304 1.1.2.1 gehenna }
305 1.1.2.1 gehenna
306 1.1.2.1 gehenna return (NULL);
307 1.1.2.1 gehenna }
308 1.1.2.1 gehenna
309 1.1.2.1 gehenna /*
310 1.1.2.1 gehenna * Convert from device name to block major number.
311 1.1.2.1 gehenna */
312 1.1.2.1 gehenna int
313 1.1.2.2 gehenna devsw_name2blk(const char *name, char *devname, size_t devnamelen)
314 1.1.2.1 gehenna {
315 1.1.2.3 gehenna struct devsw_conv *conv;
316 1.1.2.3 gehenna int bmajor, i;
317 1.1.2.1 gehenna
318 1.1.2.1 gehenna if (name == NULL)
319 1.1.2.1 gehenna return (-1);
320 1.1.2.1 gehenna
321 1.1.2.3 gehenna for (i = 0 ; i < max_cdevsws ; i++) {
322 1.1.2.3 gehenna conv = &devsw_conv[i];
323 1.1.2.3 gehenna if (conv->d_name == NULL)
324 1.1.2.1 gehenna continue;
325 1.1.2.3 gehenna if (strncmp(conv->d_name, name, strlen(conv->d_name)) != 0)
326 1.1.2.1 gehenna continue;
327 1.1.2.3 gehenna bmajor = conv->d_bmajor;
328 1.1.2.3 gehenna if (bmajor < 0 || bmajor >= max_bdevsws ||
329 1.1.2.3 gehenna bdevsw[bmajor] == NULL)
330 1.1.2.3 gehenna return (-1);
331 1.1.2.1 gehenna if (devname != NULL) {
332 1.1.2.3 gehenna #ifdef DEVSW_DEBUG
333 1.1.2.3 gehenna if (strlen(conv->d_name) >= devnamelen)
334 1.1.2.3 gehenna printf("devsw_debug: too short buffer");
335 1.1.2.3 gehenna #endif /* DEVSW_DEBUG */
336 1.1.2.3 gehenna strncpy(devname, name, devnamelen);
337 1.1.2.3 gehenna devname[devnamelen - 1] = '\0';
338 1.1.2.1 gehenna }
339 1.1.2.3 gehenna return (bmajor);
340 1.1.2.1 gehenna }
341 1.1.2.1 gehenna
342 1.1.2.1 gehenna return (-1);
343 1.1.2.1 gehenna }
344 1.1.2.1 gehenna
345 1.1.2.1 gehenna /*
346 1.1.2.1 gehenna * Convert from character dev_t to block dev_t.
347 1.1.2.1 gehenna */
348 1.1.2.1 gehenna dev_t
349 1.1.2.1 gehenna devsw_chr2blk(dev_t cdev)
350 1.1.2.1 gehenna {
351 1.1.2.3 gehenna int bmajor;
352 1.1.2.1 gehenna
353 1.1.2.3 gehenna if (cdevsw_lookup(cdev) == NULL)
354 1.1.2.1 gehenna return (NODEV);
355 1.1.2.1 gehenna
356 1.1.2.3 gehenna bmajor = devsw_conv[major(cdev)].d_bmajor;
357 1.1.2.3 gehenna if (bmajor < 0 || bmajor >= max_bdevsws || bdevsw[bmajor] == NULL)
358 1.1.2.3 gehenna return (NODEV);
359 1.1.2.1 gehenna
360 1.1.2.3 gehenna return (makedev(bmajor, minor(cdev)));
361 1.1.2.1 gehenna };
362 1.1.2.1 gehenna
363 1.1.2.1 gehenna /*
364 1.1.2.1 gehenna * Convert from block dev_t to character dev_t.
365 1.1.2.1 gehenna */
366 1.1.2.1 gehenna dev_t
367 1.1.2.1 gehenna devsw_blk2chr(dev_t bdev)
368 1.1.2.1 gehenna {
369 1.1.2.1 gehenna int bmajor, i;
370 1.1.2.1 gehenna
371 1.1.2.3 gehenna if (bdevsw_lookup(bdev) == NULL)
372 1.1.2.1 gehenna return (NODEV);
373 1.1.2.1 gehenna
374 1.1.2.1 gehenna bmajor = major(bdev);
375 1.1.2.3 gehenna
376 1.1.2.3 gehenna for (i = 0 ; i < max_cdevsws ; i++) {
377 1.1.2.3 gehenna if (devsw_conv[i].d_bmajor != bmajor)
378 1.1.2.1 gehenna continue;
379 1.1.2.3 gehenna if (cdevsw[i] == NULL)
380 1.1.2.3 gehenna return (NODEV);
381 1.1.2.3 gehenna return (makedev(i, minor(bdev)));
382 1.1.2.1 gehenna }
383 1.1.2.1 gehenna
384 1.1.2.1 gehenna return (NODEV);
385 1.1.2.1 gehenna }
386