subr_devsw.c revision 1.1.2.4 1 1.1.2.4 gehenna /* $NetBSD: subr_devsw.c,v 1.1.2.4 2002/05/19 14:36:40 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.3 gehenna }
96 1.1.2.3 gehenna }
97 1.1.2.3 gehenna
98 1.1.2.1 gehenna if (bdev != NULL) {
99 1.1.2.1 gehenna if (*bmajor < 0) {
100 1.1.2.4 gehenna for (i = sys_bdevsws ; i < max_bdevsws ; i++) {
101 1.1.2.1 gehenna if (bdevsw[i] != NULL)
102 1.1.2.1 gehenna continue;
103 1.1.2.1 gehenna *bmajor = i;
104 1.1.2.1 gehenna break;
105 1.1.2.1 gehenna }
106 1.1.2.4 gehenna if (*bmajor < 0)
107 1.1.2.4 gehenna *bmajor = max_bdevsws;
108 1.1.2.4 gehenna if (*bmajor >= MAXDEVSW)
109 1.1.2.1 gehenna return (EINVAL);
110 1.1.2.1 gehenna }
111 1.1.2.1 gehenna
112 1.1.2.3 gehenna if (*bmajor >= max_bdevsws) {
113 1.1.2.4 gehenna int old = max_bdevsws, new = *bmajor + 1;
114 1.1.2.3 gehenna const struct bdevsw **newptr;
115 1.1.2.1 gehenna
116 1.1.2.1 gehenna newptr = malloc(new * BDEVSW_SIZE, M_DEVBUF, M_NOWAIT);
117 1.1.2.1 gehenna if (newptr == NULL)
118 1.1.2.1 gehenna return (ENOMEM);
119 1.1.2.1 gehenna memset(newptr + old, 0, (new - old) * BDEVSW_SIZE);
120 1.1.2.1 gehenna if (old != 0) {
121 1.1.2.1 gehenna memcpy(newptr, bdevsw, old * BDEVSW_SIZE);
122 1.1.2.1 gehenna if (bdevsw != bdevsw0)
123 1.1.2.1 gehenna free(bdevsw, M_DEVBUF);
124 1.1.2.1 gehenna }
125 1.1.2.3 gehenna bdevsw = newptr;
126 1.1.2.3 gehenna max_bdevsws = new;
127 1.1.2.1 gehenna }
128 1.1.2.1 gehenna
129 1.1.2.1 gehenna if (bdevsw[*bmajor] != NULL)
130 1.1.2.1 gehenna return (EEXIST);
131 1.1.2.1 gehenna }
132 1.1.2.1 gehenna
133 1.1.2.3 gehenna if (*cmajor < 0) {
134 1.1.2.4 gehenna for (i = sys_cdevsws ; i < max_cdevsws ; i++) {
135 1.1.2.3 gehenna if (cdevsw[i] != NULL)
136 1.1.2.3 gehenna continue;
137 1.1.2.3 gehenna *cmajor = i;
138 1.1.2.3 gehenna break;
139 1.1.2.1 gehenna }
140 1.1.2.4 gehenna if (*cmajor < 0)
141 1.1.2.4 gehenna *cmajor = max_cdevsws;
142 1.1.2.4 gehenna if (*cmajor >= MAXDEVSW)
143 1.1.2.3 gehenna return (EINVAL);
144 1.1.2.3 gehenna }
145 1.1.2.1 gehenna
146 1.1.2.3 gehenna if (*cmajor >= max_cdevsws) {
147 1.1.2.4 gehenna int old = max_cdevsws, new = *cmajor + 1;
148 1.1.2.3 gehenna const struct cdevsw **newptr;
149 1.1.2.3 gehenna struct devsw_conv *newconv;
150 1.1.2.3 gehenna
151 1.1.2.3 gehenna newptr = malloc(new * CDEVSW_SIZE, M_DEVBUF, M_NOWAIT);
152 1.1.2.3 gehenna if (newptr == NULL)
153 1.1.2.3 gehenna return (ENOMEM);
154 1.1.2.3 gehenna memset(newptr + old, 0, (new - old) * CDEVSW_SIZE);
155 1.1.2.3 gehenna if (old != 0) {
156 1.1.2.3 gehenna memcpy(newptr, cdevsw, old * CDEVSW_SIZE);
157 1.1.2.3 gehenna if (cdevsw != cdevsw0)
158 1.1.2.3 gehenna free(cdevsw, M_DEVBUF);
159 1.1.2.1 gehenna }
160 1.1.2.3 gehenna cdevsw = newptr;
161 1.1.2.3 gehenna max_cdevsws = new;
162 1.1.2.1 gehenna
163 1.1.2.3 gehenna newconv = malloc(new * DEVSWCONV_SIZE, M_DEVBUF, M_NOWAIT);
164 1.1.2.3 gehenna if (newconv == NULL)
165 1.1.2.3 gehenna return (ENOMEM);
166 1.1.2.3 gehenna for (i = old ; i < new ; i++) {
167 1.1.2.3 gehenna newconv[i].d_name = NULL;
168 1.1.2.3 gehenna newconv[i].d_bmajor = -1;
169 1.1.2.3 gehenna }
170 1.1.2.3 gehenna if (old != 0) {
171 1.1.2.3 gehenna memcpy(newconv, devsw_conv, old * DEVSWCONV_SIZE);
172 1.1.2.3 gehenna if (devsw_conv != devsw_conv0)
173 1.1.2.3 gehenna free(devsw_conv, M_DEVBUF);
174 1.1.2.3 gehenna }
175 1.1.2.3 gehenna devsw_conv = newconv;
176 1.1.2.1 gehenna }
177 1.1.2.1 gehenna
178 1.1.2.3 gehenna if (cdevsw[*cmajor] != NULL)
179 1.1.2.3 gehenna return (EEXIST);
180 1.1.2.1 gehenna
181 1.1.2.3 gehenna if (devsw_conv[*cmajor].d_name == NULL) {
182 1.1.2.3 gehenna char *name;
183 1.1.2.3 gehenna name = malloc(strlen(devname) + 1, M_DEVBUF, M_NOWAIT);
184 1.1.2.3 gehenna if (name == NULL)
185 1.1.2.3 gehenna return (ENOMEM);
186 1.1.2.3 gehenna strcpy(name, devname);
187 1.1.2.3 gehenna devsw_conv[*cmajor].d_name = name;
188 1.1.2.1 gehenna }
189 1.1.2.1 gehenna
190 1.1.2.3 gehenna if (bdev != NULL) {
191 1.1.2.1 gehenna bdevsw[*bmajor] = bdev;
192 1.1.2.3 gehenna devsw_conv[*cmajor].d_bmajor = *bmajor;
193 1.1.2.1 gehenna }
194 1.1.2.3 gehenna cdevsw[*cmajor] = cdev;
195 1.1.2.1 gehenna
196 1.1.2.1 gehenna return (0);
197 1.1.2.1 gehenna }
198 1.1.2.1 gehenna
199 1.1.2.1 gehenna void
200 1.1.2.1 gehenna devsw_detach(const struct bdevsw *bdev, const struct cdevsw *cdev)
201 1.1.2.1 gehenna {
202 1.1.2.3 gehenna int i;
203 1.1.2.1 gehenna
204 1.1.2.1 gehenna if (bdev != NULL) {
205 1.1.2.3 gehenna for (i = 0 ; i < max_bdevsws ; i++) {
206 1.1.2.1 gehenna if (bdevsw[i] != bdev)
207 1.1.2.1 gehenna continue;
208 1.1.2.1 gehenna bdevsw[i] = NULL;
209 1.1.2.1 gehenna break;
210 1.1.2.1 gehenna }
211 1.1.2.1 gehenna }
212 1.1.2.1 gehenna if (cdev != NULL) {
213 1.1.2.3 gehenna for (i = 0 ; i < max_cdevsws ; i++) {
214 1.1.2.1 gehenna if (cdevsw[i] != cdev)
215 1.1.2.1 gehenna continue;
216 1.1.2.1 gehenna cdevsw[i] = NULL;
217 1.1.2.1 gehenna break;
218 1.1.2.1 gehenna }
219 1.1.2.1 gehenna }
220 1.1.2.1 gehenna }
221 1.1.2.1 gehenna
222 1.1.2.1 gehenna const struct bdevsw *
223 1.1.2.1 gehenna bdevsw_lookup(dev_t dev)
224 1.1.2.1 gehenna {
225 1.1.2.1 gehenna int bmajor;
226 1.1.2.1 gehenna
227 1.1.2.1 gehenna if (dev == NODEV)
228 1.1.2.1 gehenna return (NULL);
229 1.1.2.1 gehenna bmajor = major(dev);
230 1.1.2.3 gehenna if (bmajor < 0 || bmajor >= max_bdevsws)
231 1.1.2.1 gehenna return (NULL);
232 1.1.2.1 gehenna
233 1.1.2.1 gehenna return (bdevsw[bmajor]);
234 1.1.2.1 gehenna }
235 1.1.2.1 gehenna
236 1.1.2.1 gehenna const struct cdevsw *
237 1.1.2.1 gehenna cdevsw_lookup(dev_t dev)
238 1.1.2.1 gehenna {
239 1.1.2.1 gehenna int cmajor;
240 1.1.2.1 gehenna
241 1.1.2.1 gehenna if (dev == NODEV)
242 1.1.2.1 gehenna return (NULL);
243 1.1.2.1 gehenna cmajor = major(dev);
244 1.1.2.3 gehenna if (cmajor < 0 || cmajor >= max_cdevsws)
245 1.1.2.1 gehenna return (NULL);
246 1.1.2.1 gehenna
247 1.1.2.1 gehenna return (cdevsw[cmajor]);
248 1.1.2.1 gehenna }
249 1.1.2.1 gehenna
250 1.1.2.1 gehenna int
251 1.1.2.1 gehenna bdevsw_lookup_major(const struct bdevsw *bdev)
252 1.1.2.1 gehenna {
253 1.1.2.1 gehenna int bmajor;
254 1.1.2.1 gehenna
255 1.1.2.3 gehenna for (bmajor = 0 ; bmajor < max_bdevsws ; bmajor++) {
256 1.1.2.1 gehenna if (bdevsw[bmajor] == bdev)
257 1.1.2.1 gehenna return (bmajor);
258 1.1.2.1 gehenna }
259 1.1.2.1 gehenna
260 1.1.2.1 gehenna return (-1);
261 1.1.2.1 gehenna }
262 1.1.2.1 gehenna
263 1.1.2.1 gehenna int
264 1.1.2.1 gehenna cdevsw_lookup_major(const struct cdevsw *cdev)
265 1.1.2.1 gehenna {
266 1.1.2.1 gehenna int cmajor;
267 1.1.2.1 gehenna
268 1.1.2.3 gehenna for (cmajor = 0 ; cmajor < max_cdevsws ; cmajor++) {
269 1.1.2.1 gehenna if (cdevsw[cmajor] == cdev)
270 1.1.2.1 gehenna return (cmajor);
271 1.1.2.1 gehenna }
272 1.1.2.1 gehenna
273 1.1.2.1 gehenna return (-1);
274 1.1.2.1 gehenna }
275 1.1.2.1 gehenna
276 1.1.2.1 gehenna /*
277 1.1.2.1 gehenna * Convert from block major number to name.
278 1.1.2.1 gehenna */
279 1.1.2.1 gehenna const char *
280 1.1.2.1 gehenna devsw_blk2name(int bmajor)
281 1.1.2.1 gehenna {
282 1.1.2.1 gehenna int i;
283 1.1.2.1 gehenna
284 1.1.2.3 gehenna if (bmajor < 0 || bmajor >= max_bdevsws)
285 1.1.2.3 gehenna return (NULL);
286 1.1.2.3 gehenna if (bdevsw[bmajor] == NULL)
287 1.1.2.1 gehenna return (NULL);
288 1.1.2.1 gehenna
289 1.1.2.3 gehenna for (i = 0 ; i < max_cdevsws ; i++) {
290 1.1.2.3 gehenna if (devsw_conv[i].d_bmajor != bmajor)
291 1.1.2.1 gehenna continue;
292 1.1.2.3 gehenna if (cdevsw[i] == NULL)
293 1.1.2.3 gehenna return (NULL);
294 1.1.2.1 gehenna return (devsw_conv[i].d_name);
295 1.1.2.1 gehenna }
296 1.1.2.1 gehenna
297 1.1.2.1 gehenna return (NULL);
298 1.1.2.1 gehenna }
299 1.1.2.1 gehenna
300 1.1.2.1 gehenna /*
301 1.1.2.1 gehenna * Convert from device name to block major number.
302 1.1.2.1 gehenna */
303 1.1.2.1 gehenna int
304 1.1.2.2 gehenna devsw_name2blk(const char *name, char *devname, size_t devnamelen)
305 1.1.2.1 gehenna {
306 1.1.2.3 gehenna struct devsw_conv *conv;
307 1.1.2.3 gehenna int bmajor, i;
308 1.1.2.1 gehenna
309 1.1.2.1 gehenna if (name == NULL)
310 1.1.2.1 gehenna return (-1);
311 1.1.2.1 gehenna
312 1.1.2.3 gehenna for (i = 0 ; i < max_cdevsws ; i++) {
313 1.1.2.3 gehenna conv = &devsw_conv[i];
314 1.1.2.3 gehenna if (conv->d_name == NULL)
315 1.1.2.1 gehenna continue;
316 1.1.2.3 gehenna if (strncmp(conv->d_name, name, strlen(conv->d_name)) != 0)
317 1.1.2.1 gehenna continue;
318 1.1.2.3 gehenna bmajor = conv->d_bmajor;
319 1.1.2.3 gehenna if (bmajor < 0 || bmajor >= max_bdevsws ||
320 1.1.2.3 gehenna bdevsw[bmajor] == NULL)
321 1.1.2.3 gehenna return (-1);
322 1.1.2.1 gehenna if (devname != NULL) {
323 1.1.2.3 gehenna #ifdef DEVSW_DEBUG
324 1.1.2.3 gehenna if (strlen(conv->d_name) >= devnamelen)
325 1.1.2.3 gehenna printf("devsw_debug: too short buffer");
326 1.1.2.3 gehenna #endif /* DEVSW_DEBUG */
327 1.1.2.3 gehenna strncpy(devname, name, devnamelen);
328 1.1.2.3 gehenna devname[devnamelen - 1] = '\0';
329 1.1.2.1 gehenna }
330 1.1.2.3 gehenna return (bmajor);
331 1.1.2.1 gehenna }
332 1.1.2.1 gehenna
333 1.1.2.1 gehenna return (-1);
334 1.1.2.1 gehenna }
335 1.1.2.1 gehenna
336 1.1.2.1 gehenna /*
337 1.1.2.1 gehenna * Convert from character dev_t to block dev_t.
338 1.1.2.1 gehenna */
339 1.1.2.1 gehenna dev_t
340 1.1.2.1 gehenna devsw_chr2blk(dev_t cdev)
341 1.1.2.1 gehenna {
342 1.1.2.3 gehenna int bmajor;
343 1.1.2.1 gehenna
344 1.1.2.3 gehenna if (cdevsw_lookup(cdev) == NULL)
345 1.1.2.1 gehenna return (NODEV);
346 1.1.2.1 gehenna
347 1.1.2.3 gehenna bmajor = devsw_conv[major(cdev)].d_bmajor;
348 1.1.2.3 gehenna if (bmajor < 0 || bmajor >= max_bdevsws || bdevsw[bmajor] == NULL)
349 1.1.2.3 gehenna return (NODEV);
350 1.1.2.1 gehenna
351 1.1.2.3 gehenna return (makedev(bmajor, minor(cdev)));
352 1.1.2.1 gehenna };
353 1.1.2.1 gehenna
354 1.1.2.1 gehenna /*
355 1.1.2.1 gehenna * Convert from block dev_t to character dev_t.
356 1.1.2.1 gehenna */
357 1.1.2.1 gehenna dev_t
358 1.1.2.1 gehenna devsw_blk2chr(dev_t bdev)
359 1.1.2.1 gehenna {
360 1.1.2.1 gehenna int bmajor, i;
361 1.1.2.1 gehenna
362 1.1.2.3 gehenna if (bdevsw_lookup(bdev) == NULL)
363 1.1.2.1 gehenna return (NODEV);
364 1.1.2.1 gehenna
365 1.1.2.1 gehenna bmajor = major(bdev);
366 1.1.2.3 gehenna
367 1.1.2.3 gehenna for (i = 0 ; i < max_cdevsws ; i++) {
368 1.1.2.3 gehenna if (devsw_conv[i].d_bmajor != bmajor)
369 1.1.2.1 gehenna continue;
370 1.1.2.3 gehenna if (cdevsw[i] == NULL)
371 1.1.2.3 gehenna return (NODEV);
372 1.1.2.3 gehenna return (makedev(i, minor(bdev)));
373 1.1.2.1 gehenna }
374 1.1.2.1 gehenna
375 1.1.2.1 gehenna return (NODEV);
376 1.1.2.1 gehenna }
377