md.c revision 1.1 1 1.1 gwr /* $NetBSD: md.c,v 1.1 1995/10/08 23:30:57 gwr Exp $ */
2 1.1 gwr
3 1.1 gwr /*
4 1.1 gwr * Copyright (c) 1995 Gordon W. Ross, Leo Weppelman.
5 1.1 gwr * All rights reserved.
6 1.1 gwr *
7 1.1 gwr * Redistribution and use in source and binary forms, with or without
8 1.1 gwr * modification, are permitted provided that the following conditions
9 1.1 gwr * are met:
10 1.1 gwr * 1. Redistributions of source code must retain the above copyright
11 1.1 gwr * notice, this list of conditions and the following disclaimer.
12 1.1 gwr * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 gwr * notice, this list of conditions and the following disclaimer in the
14 1.1 gwr * documentation and/or other materials provided with the distribution.
15 1.1 gwr * 3. The name of the author may not be used to endorse or promote products
16 1.1 gwr * derived from this software without specific prior written permission.
17 1.1 gwr * 4. All advertising materials mentioning features or use of this software
18 1.1 gwr * must display the following acknowledgement:
19 1.1 gwr * This product includes software developed by
20 1.1 gwr * Gordon W. Ross and Leo Weppelman.
21 1.1 gwr *
22 1.1 gwr * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
23 1.1 gwr * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
24 1.1 gwr * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
25 1.1 gwr * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
26 1.1 gwr * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
27 1.1 gwr * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28 1.1 gwr * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29 1.1 gwr * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30 1.1 gwr * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
31 1.1 gwr * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32 1.1 gwr */
33 1.1 gwr
34 1.1 gwr /*
35 1.1 gwr * This implements a general-puspose RAM-disk.
36 1.1 gwr * See ramdisk.h for notes on the config types.
37 1.1 gwr *
38 1.1 gwr * Note that this driver provides the same functionality
39 1.1 gwr * as the MFS filesystem hack, but this is better because
40 1.1 gwr * you can use this for any filesystem type you'd like!
41 1.1 gwr *
42 1.1 gwr * Credit for most of the kmem ramdisk code goes to:
43 1.1 gwr * Leo Weppelman (atari) and Phil Nelson (pc532)
44 1.1 gwr * Credit for the ideas behind the "user space RAM" code goes
45 1.1 gwr * to the authors of the MFS implementation.
46 1.1 gwr */
47 1.1 gwr
48 1.1 gwr #include <sys/param.h>
49 1.1 gwr #include <sys/systm.h>
50 1.1 gwr #include <sys/buf.h>
51 1.1 gwr #include <sys/device.h>
52 1.1 gwr
53 1.1 gwr #include <vm/vm.h>
54 1.1 gwr #include <vm/vm_kern.h>
55 1.1 gwr /* Don't want all those other VM headers... */
56 1.1 gwr extern vm_offset_t kmem_alloc __P((vm_map_t, vm_size_t));
57 1.1 gwr
58 1.1 gwr #include <dev/ramdisk.h>
59 1.1 gwr
60 1.1 gwr /*
61 1.1 gwr * By default, include the user-space functionality.
62 1.1 gwr * Use: option RAMDISK_SERVER=0 to turn it off.
63 1.1 gwr */
64 1.1 gwr #ifndef RAMDISK_SERVER
65 1.1 gwr #define RAMDISK_SERVER 1
66 1.1 gwr #endif
67 1.1 gwr
68 1.1 gwr /*
69 1.1 gwr * XXX: the "control" unit is (base unit + 16).
70 1.1 gwr * We should just use the cdev as the "control", but
71 1.1 gwr * that interferes with the security stuff preventing
72 1.1 gwr * simulatneous use of raw and block devices.
73 1.1 gwr *
74 1.1 gwr * XXX Assumption: 16 RAM-disks are enough!
75 1.1 gwr */
76 1.1 gwr #define RD_IS_CTRL(unit) (unit & 0x10)
77 1.1 gwr #define RD_UNIT(unit) (unit & 0xF)
78 1.1 gwr
79 1.1 gwr /*
80 1.1 gwr * XXX - This is just for a sanity check. Only
81 1.1 gwr * applies to kernel-space RAM disk allocations.
82 1.1 gwr */
83 1.1 gwr #define RD_KMEM_MAX_SIZE 0x100000 /* 1MB */
84 1.1 gwr
85 1.1 gwr /* autoconfig stuff... */
86 1.1 gwr
87 1.1 gwr struct rd_softc {
88 1.1 gwr struct device sc_dev; /* REQUIRED first entry */
89 1.1 gwr struct rd_conf sc_rd;
90 1.1 gwr struct buf *sc_buflist;
91 1.1 gwr int sc_flags;
92 1.1 gwr };
93 1.1 gwr /* shorthand for fields in sc_rd: */
94 1.1 gwr #define sc_addr sc_rd.rd_addr
95 1.1 gwr #define sc_size sc_rd.rd_size
96 1.1 gwr #define sc_type sc_rd.rd_type
97 1.1 gwr /* flags */
98 1.1 gwr #define RD_ISOPEN 0x01
99 1.1 gwr #define RD_SERVED 0x02
100 1.1 gwr
101 1.1 gwr static int rd_match (struct device *, void *self, void *);
102 1.1 gwr static void rd_attach(struct device *, struct device *self, void *);
103 1.1 gwr
104 1.1 gwr struct cfdriver rdcd = {
105 1.1 gwr NULL, "rd", rd_match, rd_attach,
106 1.1 gwr DV_DISK, sizeof(struct device), NULL, 0 };
107 1.1 gwr
108 1.1 gwr static int
109 1.1 gwr rd_match(parent, self, aux)
110 1.1 gwr struct device *parent;
111 1.1 gwr void *self;
112 1.1 gwr void *aux;
113 1.1 gwr {
114 1.1 gwr return(1);
115 1.1 gwr }
116 1.1 gwr
117 1.1 gwr static void
118 1.1 gwr rd_attach(parent, self, aux)
119 1.1 gwr struct device *parent, *self;
120 1.1 gwr void *aux;
121 1.1 gwr {
122 1.1 gwr struct rd_softc *sc = (struct rd_softc *)self;
123 1.1 gwr
124 1.1 gwr /* XXX - Could accept aux info here to set the config. */
125 1.1 gwr #ifdef RAMDISK_HOOKS
126 1.1 gwr /*
127 1.1 gwr * This external function might setup a pre-loaded disk.
128 1.1 gwr * All it would need to do is setup the rd_conf struct.
129 1.1 gwr * See sys/arch/sun3/dev/rd_root.c for an example.
130 1.1 gwr */
131 1.1 gwr rd_attach_hook(sc->sc_dev.dv_unit, &sc->sc_rd);
132 1.1 gwr #endif
133 1.1 gwr printf("\n");
134 1.1 gwr }
135 1.1 gwr
136 1.1 gwr /*
137 1.1 gwr * operational routines:
138 1.1 gwr * open, close, read, write, strategy,
139 1.1 gwr * ioctl, dump, size
140 1.1 gwr */
141 1.1 gwr
142 1.1 gwr void rdstrategy __P((struct buf *bp));
143 1.1 gwr
144 1.1 gwr #if RAMDISK_SERVER
145 1.1 gwr static int rd_server_loop __P((struct rd_softc *sc));
146 1.1 gwr static int rd_ioctl_server __P((struct rd_softc *sc,
147 1.1 gwr struct rd_conf *urd, struct proc *proc));
148 1.1 gwr #endif
149 1.1 gwr
150 1.1 gwr int rddump(dev, blkno, va, size)
151 1.1 gwr dev_t dev;
152 1.1 gwr daddr_t blkno;
153 1.1 gwr caddr_t va;
154 1.1 gwr size_t size;
155 1.1 gwr {
156 1.1 gwr return ENODEV;
157 1.1 gwr }
158 1.1 gwr
159 1.1 gwr int rdsize(dev_t dev)
160 1.1 gwr {
161 1.1 gwr int unit;
162 1.1 gwr struct rd_softc *sc;
163 1.1 gwr
164 1.1 gwr /* Disallow control units. */
165 1.1 gwr unit = minor(dev);
166 1.1 gwr if (unit >= rdcd.cd_ndevs)
167 1.1 gwr return 0;
168 1.1 gwr sc = rdcd.cd_devs[unit];
169 1.1 gwr if (sc == NULL)
170 1.1 gwr return 0;
171 1.1 gwr
172 1.1 gwr if (sc->sc_type == RD_UNCONFIGURED)
173 1.1 gwr return 0;
174 1.1 gwr
175 1.1 gwr return (sc->sc_size >> DEV_BSHIFT);
176 1.1 gwr }
177 1.1 gwr
178 1.1 gwr int rdopen(dev, flag, fmt, proc)
179 1.1 gwr dev_t dev;
180 1.1 gwr int flag, fmt;
181 1.1 gwr struct proc *proc;
182 1.1 gwr {
183 1.1 gwr int md, unit;
184 1.1 gwr struct rd_softc *sc;
185 1.1 gwr
186 1.1 gwr md = minor(dev);
187 1.1 gwr unit = RD_UNIT(md);
188 1.1 gwr if (unit >= rdcd.cd_ndevs)
189 1.1 gwr return ENXIO;
190 1.1 gwr sc = rdcd.cd_devs[unit];
191 1.1 gwr if (sc == NULL)
192 1.1 gwr return ENXIO;
193 1.1 gwr
194 1.1 gwr /*
195 1.1 gwr * The control device is not exclusive, and can
196 1.1 gwr * open uninitialized units (so you can setconf).
197 1.1 gwr */
198 1.1 gwr if (RD_IS_CTRL(md))
199 1.1 gwr return 0;
200 1.1 gwr
201 1.1 gwr #ifdef RAMDISK_HOOKS
202 1.1 gwr /* Call the open hook to allow loading the device. */
203 1.1 gwr rd_open_hook(unit, &sc->sc_rd);
204 1.1 gwr #endif
205 1.1 gwr
206 1.1 gwr /*
207 1.1 gwr * This is a normal, "slave" device, so
208 1.1 gwr * enforce initialized, exclusive open.
209 1.1 gwr */
210 1.1 gwr if (sc->sc_type == RD_UNCONFIGURED)
211 1.1 gwr return ENXIO;
212 1.1 gwr if (sc->sc_flags & RD_ISOPEN)
213 1.1 gwr return EBUSY;
214 1.1 gwr
215 1.1 gwr return 0;
216 1.1 gwr }
217 1.1 gwr
218 1.1 gwr int rdclose(dev, flag, fmt, proc)
219 1.1 gwr dev_t dev;
220 1.1 gwr int flag, fmt;
221 1.1 gwr struct proc *proc;
222 1.1 gwr {
223 1.1 gwr int md, unit;
224 1.1 gwr struct rd_softc *sc;
225 1.1 gwr
226 1.1 gwr md = minor(dev);
227 1.1 gwr unit = RD_UNIT(md);
228 1.1 gwr sc = rdcd.cd_devs[unit];
229 1.1 gwr
230 1.1 gwr if (RD_IS_CTRL(md))
231 1.1 gwr return 0;
232 1.1 gwr
233 1.1 gwr /* Normal device. */
234 1.1 gwr sc->sc_flags = 0;
235 1.1 gwr
236 1.1 gwr return 0;
237 1.1 gwr }
238 1.1 gwr
239 1.1 gwr int
240 1.1 gwr rdread(dev, uio)
241 1.1 gwr dev_t dev;
242 1.1 gwr struct uio *uio;
243 1.1 gwr {
244 1.1 gwr return (physio(rdstrategy, NULL, dev, B_READ, minphys, uio));
245 1.1 gwr }
246 1.1 gwr
247 1.1 gwr int
248 1.1 gwr rdwrite(dev, uio)
249 1.1 gwr dev_t dev;
250 1.1 gwr struct uio *uio;
251 1.1 gwr {
252 1.1 gwr return (physio(rdstrategy, NULL, dev, B_WRITE, minphys, uio));
253 1.1 gwr }
254 1.1 gwr
255 1.1 gwr /*
256 1.1 gwr * Handle I/O requests, either directly, or
257 1.1 gwr * by passing them to the server process.
258 1.1 gwr */
259 1.1 gwr void
260 1.1 gwr rdstrategy(bp)
261 1.1 gwr struct buf *bp;
262 1.1 gwr {
263 1.1 gwr int md, unit;
264 1.1 gwr struct rd_softc *sc;
265 1.1 gwr caddr_t addr;
266 1.1 gwr size_t off, xfer;
267 1.1 gwr
268 1.1 gwr md = minor(bp->b_dev);
269 1.1 gwr unit = RD_UNIT(md);
270 1.1 gwr sc = rdcd.cd_devs[unit];
271 1.1 gwr
272 1.1 gwr switch (sc->sc_type) {
273 1.1 gwr #if RAMDISK_SERVER
274 1.1 gwr case RD_UMEM_SERVER:
275 1.1 gwr /* Just add this job to the server's queue. */
276 1.1 gwr bp->b_actf = sc->sc_buflist;
277 1.1 gwr sc->sc_buflist = bp;
278 1.1 gwr if (bp->b_actf == NULL) {
279 1.1 gwr /* server queue was empty. */
280 1.1 gwr wakeup((caddr_t)sc);
281 1.1 gwr /* see rd_server_loop() */
282 1.1 gwr }
283 1.1 gwr /* no biodone in this case */
284 1.1 gwr return;
285 1.1 gwr #endif /* RAMDISK_SERVER */
286 1.1 gwr
287 1.1 gwr case RD_KMEM_FIXED:
288 1.1 gwr case RD_KMEM_ALLOCATED:
289 1.1 gwr /* These are in kernel space. Access directly. */
290 1.1 gwr bp->b_resid = bp->b_bcount;
291 1.1 gwr off = (bp->b_blkno << DEV_BSHIFT);
292 1.1 gwr if (off >= sc->sc_size) {
293 1.1 gwr if (bp->b_flags & B_READ)
294 1.1 gwr break; /* EOF */
295 1.1 gwr goto set_eio;
296 1.1 gwr }
297 1.1 gwr xfer = bp->b_resid;
298 1.1 gwr if (xfer > (sc->sc_size - off))
299 1.1 gwr xfer = (sc->sc_size - off);
300 1.1 gwr addr = sc->sc_addr + off;
301 1.1 gwr if (bp->b_flags & B_READ)
302 1.1 gwr bcopy(addr, bp->b_data, xfer);
303 1.1 gwr else
304 1.1 gwr bcopy(bp->b_data, addr, xfer);
305 1.1 gwr bp->b_resid -= xfer;
306 1.1 gwr break;
307 1.1 gwr
308 1.1 gwr default:
309 1.1 gwr bp->b_resid = bp->b_bcount;
310 1.1 gwr set_eio:
311 1.1 gwr bp->b_error = EIO;
312 1.1 gwr bp->b_flags |= B_ERROR;
313 1.1 gwr break;
314 1.1 gwr }
315 1.1 gwr biodone(bp);
316 1.1 gwr }
317 1.1 gwr
318 1.1 gwr int
319 1.1 gwr rdioctl(dev, cmd, data, flag, proc)
320 1.1 gwr dev_t dev;
321 1.1 gwr u_long cmd;
322 1.1 gwr int flag;
323 1.1 gwr caddr_t data;
324 1.1 gwr struct proc *proc;
325 1.1 gwr {
326 1.1 gwr int md, unit;
327 1.1 gwr struct rd_softc *sc;
328 1.1 gwr struct rd_conf *urd;
329 1.1 gwr
330 1.1 gwr md = minor(dev);
331 1.1 gwr unit = RD_UNIT(md);
332 1.1 gwr sc = rdcd.cd_devs[unit];
333 1.1 gwr
334 1.1 gwr /* If this is not the control device, punt! */
335 1.1 gwr if (RD_IS_CTRL(md) == 0)
336 1.1 gwr return ENOTTY;
337 1.1 gwr
338 1.1 gwr urd = (struct rd_conf *)data;
339 1.1 gwr switch (cmd) {
340 1.1 gwr case RD_GETCONF:
341 1.1 gwr *urd = sc->sc_rd;
342 1.1 gwr return 0;
343 1.1 gwr
344 1.1 gwr case RD_SETCONF:
345 1.1 gwr /* Can only set it once. */
346 1.1 gwr if (sc->sc_type != RD_UNCONFIGURED)
347 1.1 gwr break;
348 1.1 gwr switch (urd->rd_type) {
349 1.1 gwr case RD_KMEM_ALLOCATED:
350 1.1 gwr return rd_ioctl_kalloc(sc, urd, proc);
351 1.1 gwr #if RAMDISK_SERVER
352 1.1 gwr case RD_UMEM_SERVER:
353 1.1 gwr return rd_ioctl_server(sc, urd, proc);
354 1.1 gwr #endif
355 1.1 gwr default:
356 1.1 gwr break;
357 1.1 gwr }
358 1.1 gwr break;
359 1.1 gwr }
360 1.1 gwr return EINVAL;
361 1.1 gwr }
362 1.1 gwr
363 1.1 gwr /*
364 1.1 gwr * Handle ioctl RD_SETCONF for (sc_type == RD_KMEM_ALLOCATED)
365 1.1 gwr * Just allocate some kernel memory and return.
366 1.1 gwr */
367 1.1 gwr int
368 1.1 gwr rd_ioctl_kalloc(sc, urd, proc)
369 1.1 gwr struct rd_softc *sc;
370 1.1 gwr struct rd_conf *urd;
371 1.1 gwr struct proc *proc;
372 1.1 gwr {
373 1.1 gwr vm_offset_t addr;
374 1.1 gwr vm_size_t size;
375 1.1 gwr
376 1.1 gwr /* Sanity check the size. */
377 1.1 gwr size = urd->rd_size;
378 1.1 gwr if (size > RD_KMEM_MAX_SIZE)
379 1.1 gwr return EINVAL;
380 1.1 gwr addr = kmem_alloc(kernel_map, size);
381 1.1 gwr if (!addr)
382 1.1 gwr return ENOMEM;
383 1.1 gwr
384 1.1 gwr /* This unit is now configured. */
385 1.1 gwr sc->sc_addr = (caddr_t)addr; /* kernel space */
386 1.1 gwr sc->sc_size = (size_t)size;
387 1.1 gwr sc->sc_type = RD_KMEM_ALLOCATED;
388 1.1 gwr return 0;
389 1.1 gwr }
390 1.1 gwr
391 1.1 gwr #if RAMDISK_SERVER
392 1.1 gwr
393 1.1 gwr /*
394 1.1 gwr * Handle ioctl RD_SETCONF for (sc_type == RD_KMEM_ALLOCATED)
395 1.1 gwr * Set config, then become the I/O server for this unit.
396 1.1 gwr */
397 1.1 gwr int
398 1.1 gwr rd_ioctl_server(sc, urd, proc)
399 1.1 gwr struct rd_softc *sc;
400 1.1 gwr struct rd_conf *urd;
401 1.1 gwr struct proc *proc;
402 1.1 gwr {
403 1.1 gwr vm_offset_t end;
404 1.1 gwr int error;
405 1.1 gwr
406 1.1 gwr /* Sanity check addr, size. */
407 1.1 gwr end = (vm_offset_t) (urd->rd_addr + urd->rd_size);
408 1.1 gwr
409 1.1 gwr if ((end >= VM_MAXUSER_ADDRESS) ||
410 1.1 gwr (end < ((vm_offset_t) urd->rd_addr)) )
411 1.1 gwr return EINVAL;
412 1.1 gwr
413 1.1 gwr /* This unit is now configured. */
414 1.1 gwr sc->sc_addr = urd->rd_addr; /* user space */
415 1.1 gwr sc->sc_size = urd->rd_size;
416 1.1 gwr sc->sc_type = RD_UMEM_SERVER;
417 1.1 gwr
418 1.1 gwr /* Become the server daemon */
419 1.1 gwr error = rd_server_loop(sc);
420 1.1 gwr
421 1.1 gwr /* This server is now going away! */
422 1.1 gwr sc->sc_type = RD_UNCONFIGURED;
423 1.1 gwr sc->sc_addr = 0;
424 1.1 gwr sc->sc_size = 0;
425 1.1 gwr
426 1.1 gwr return (error);
427 1.1 gwr }
428 1.1 gwr
429 1.1 gwr int rd_sleep_pri = PWAIT | PCATCH;
430 1.1 gwr
431 1.1 gwr static int
432 1.1 gwr rd_server_loop(sc)
433 1.1 gwr struct rd_softc *sc;
434 1.1 gwr {
435 1.1 gwr struct buf *bp;
436 1.1 gwr caddr_t addr; /* user space address */
437 1.1 gwr size_t off; /* offset into "device" */
438 1.1 gwr size_t xfer; /* amount to transfer */
439 1.1 gwr int error;
440 1.1 gwr
441 1.1 gwr for (;;) {
442 1.1 gwr /* Wait for some work to arrive. */
443 1.1 gwr while (sc->sc_buflist == NULL) {
444 1.1 gwr error = tsleep((caddr_t)sc, rd_sleep_pri, "rd_idle", 0);
445 1.1 gwr if (error)
446 1.1 gwr return error;
447 1.1 gwr }
448 1.1 gwr
449 1.1 gwr /* Unlink buf from head of list. */
450 1.1 gwr bp = sc->sc_buflist;
451 1.1 gwr sc->sc_buflist = bp->b_actf;
452 1.1 gwr bp->b_actf = NULL;
453 1.1 gwr
454 1.1 gwr /* Do the transfer to/from user space. */
455 1.1 gwr error = 0;
456 1.1 gwr bp->b_resid = bp->b_bcount;
457 1.1 gwr off = (bp->b_blkno << DEV_BSHIFT);
458 1.1 gwr if (off >= sc->sc_size) {
459 1.1 gwr if (bp->b_flags & B_READ)
460 1.1 gwr goto done; /* EOF (not an error) */
461 1.1 gwr error = EIO;
462 1.1 gwr goto done;
463 1.1 gwr }
464 1.1 gwr xfer = bp->b_resid;
465 1.1 gwr if (xfer > (sc->sc_size - off))
466 1.1 gwr xfer = (sc->sc_size - off);
467 1.1 gwr addr = sc->sc_addr + off;
468 1.1 gwr if (bp->b_flags & B_READ)
469 1.1 gwr error = copyin(addr, bp->b_data, xfer);
470 1.1 gwr else
471 1.1 gwr error = copyout(bp->b_data, addr, xfer);
472 1.1 gwr if (!error)
473 1.1 gwr bp->b_resid -= xfer;
474 1.1 gwr
475 1.1 gwr done:
476 1.1 gwr if (error) {
477 1.1 gwr bp->b_error = error;
478 1.1 gwr bp->b_flags |= B_ERROR;
479 1.1 gwr }
480 1.1 gwr biodone(bp);
481 1.1 gwr }
482 1.1 gwr }
483 1.1 gwr
484 1.1 gwr #endif /* RAMDISK_SERVER */
485