md.c revision 1.4 1 1.4 thorpej /* $NetBSD: md.c,v 1.4 1996/01/07 22:03:31 thorpej 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.4 thorpej #include <sys/disk.h>
53 1.1 gwr
54 1.1 gwr #include <vm/vm.h>
55 1.1 gwr #include <vm/vm_kern.h>
56 1.1 gwr /* Don't want all those other VM headers... */
57 1.1 gwr extern vm_offset_t kmem_alloc __P((vm_map_t, vm_size_t));
58 1.1 gwr
59 1.1 gwr #include <dev/ramdisk.h>
60 1.1 gwr
61 1.1 gwr /*
62 1.1 gwr * By default, include the user-space functionality.
63 1.1 gwr * Use: option RAMDISK_SERVER=0 to turn it off.
64 1.1 gwr */
65 1.1 gwr #ifndef RAMDISK_SERVER
66 1.1 gwr #define RAMDISK_SERVER 1
67 1.1 gwr #endif
68 1.1 gwr
69 1.1 gwr /*
70 1.1 gwr * XXX: the "control" unit is (base unit + 16).
71 1.1 gwr * We should just use the cdev as the "control", but
72 1.1 gwr * that interferes with the security stuff preventing
73 1.1 gwr * simulatneous use of raw and block devices.
74 1.1 gwr *
75 1.1 gwr * XXX Assumption: 16 RAM-disks are enough!
76 1.1 gwr */
77 1.1 gwr #define RD_IS_CTRL(unit) (unit & 0x10)
78 1.1 gwr #define RD_UNIT(unit) (unit & 0xF)
79 1.1 gwr
80 1.1 gwr /*
81 1.1 gwr * XXX - This is just for a sanity check. Only
82 1.1 gwr * applies to kernel-space RAM disk allocations.
83 1.1 gwr */
84 1.1 gwr #define RD_KMEM_MAX_SIZE 0x100000 /* 1MB */
85 1.1 gwr
86 1.1 gwr /* autoconfig stuff... */
87 1.1 gwr
88 1.1 gwr struct rd_softc {
89 1.1 gwr struct device sc_dev; /* REQUIRED first entry */
90 1.4 thorpej struct disk sc_dkdev; /* hook for generic disk handling */
91 1.1 gwr struct rd_conf sc_rd;
92 1.1 gwr struct buf *sc_buflist;
93 1.1 gwr int sc_flags;
94 1.1 gwr };
95 1.1 gwr /* shorthand for fields in sc_rd: */
96 1.1 gwr #define sc_addr sc_rd.rd_addr
97 1.1 gwr #define sc_size sc_rd.rd_size
98 1.1 gwr #define sc_type sc_rd.rd_type
99 1.1 gwr /* flags */
100 1.1 gwr #define RD_ISOPEN 0x01
101 1.1 gwr #define RD_SERVED 0x02
102 1.1 gwr
103 1.1 gwr static int rd_match (struct device *, void *self, void *);
104 1.1 gwr static void rd_attach(struct device *, struct device *self, void *);
105 1.1 gwr
106 1.1 gwr struct cfdriver rdcd = {
107 1.1 gwr NULL, "rd", rd_match, rd_attach,
108 1.3 gwr DV_DULL, sizeof(struct rd_softc), NULL, 0 };
109 1.1 gwr
110 1.4 thorpej void rdstrategy __P((struct buf *bp));
111 1.4 thorpej
112 1.4 thorpej struct dkdriver rddkdriver = { rdstrategy };
113 1.4 thorpej
114 1.1 gwr static int
115 1.1 gwr rd_match(parent, self, aux)
116 1.1 gwr struct device *parent;
117 1.1 gwr void *self;
118 1.1 gwr void *aux;
119 1.1 gwr {
120 1.1 gwr return(1);
121 1.1 gwr }
122 1.1 gwr
123 1.1 gwr static void
124 1.1 gwr rd_attach(parent, self, aux)
125 1.1 gwr struct device *parent, *self;
126 1.1 gwr void *aux;
127 1.1 gwr {
128 1.1 gwr struct rd_softc *sc = (struct rd_softc *)self;
129 1.1 gwr
130 1.1 gwr /* XXX - Could accept aux info here to set the config. */
131 1.1 gwr #ifdef RAMDISK_HOOKS
132 1.1 gwr /*
133 1.1 gwr * This external function might setup a pre-loaded disk.
134 1.1 gwr * All it would need to do is setup the rd_conf struct.
135 1.1 gwr * See sys/arch/sun3/dev/rd_root.c for an example.
136 1.1 gwr */
137 1.1 gwr rd_attach_hook(sc->sc_dev.dv_unit, &sc->sc_rd);
138 1.1 gwr #endif
139 1.1 gwr printf("\n");
140 1.4 thorpej
141 1.4 thorpej /*
142 1.4 thorpej * Initialize and attach the disk structure.
143 1.4 thorpej */
144 1.4 thorpej bzero(&sc->sc_dkdev, sizeof(sc->sc_dkdev));
145 1.4 thorpej sc->sc_dkdev.dk_driver = &rddkdriver;
146 1.4 thorpej sc->sc_dkdev.dk_name = sc->sc_dev.dv_xname;
147 1.4 thorpej disk_attach(&sc->sc_dkdev);
148 1.1 gwr }
149 1.1 gwr
150 1.1 gwr /*
151 1.1 gwr * operational routines:
152 1.1 gwr * open, close, read, write, strategy,
153 1.1 gwr * ioctl, dump, size
154 1.1 gwr */
155 1.1 gwr
156 1.1 gwr #if RAMDISK_SERVER
157 1.1 gwr static int rd_server_loop __P((struct rd_softc *sc));
158 1.1 gwr static int rd_ioctl_server __P((struct rd_softc *sc,
159 1.1 gwr struct rd_conf *urd, struct proc *proc));
160 1.1 gwr #endif
161 1.1 gwr
162 1.1 gwr int rddump(dev, blkno, va, size)
163 1.1 gwr dev_t dev;
164 1.1 gwr daddr_t blkno;
165 1.1 gwr caddr_t va;
166 1.1 gwr size_t size;
167 1.1 gwr {
168 1.1 gwr return ENODEV;
169 1.1 gwr }
170 1.1 gwr
171 1.1 gwr int rdsize(dev_t dev)
172 1.1 gwr {
173 1.1 gwr int unit;
174 1.1 gwr struct rd_softc *sc;
175 1.1 gwr
176 1.1 gwr /* Disallow control units. */
177 1.1 gwr unit = minor(dev);
178 1.1 gwr if (unit >= rdcd.cd_ndevs)
179 1.1 gwr return 0;
180 1.1 gwr sc = rdcd.cd_devs[unit];
181 1.1 gwr if (sc == NULL)
182 1.1 gwr return 0;
183 1.1 gwr
184 1.1 gwr if (sc->sc_type == RD_UNCONFIGURED)
185 1.1 gwr return 0;
186 1.1 gwr
187 1.1 gwr return (sc->sc_size >> DEV_BSHIFT);
188 1.1 gwr }
189 1.1 gwr
190 1.1 gwr int rdopen(dev, flag, fmt, proc)
191 1.1 gwr dev_t dev;
192 1.1 gwr int flag, fmt;
193 1.1 gwr struct proc *proc;
194 1.1 gwr {
195 1.1 gwr int md, unit;
196 1.1 gwr struct rd_softc *sc;
197 1.1 gwr
198 1.1 gwr md = minor(dev);
199 1.1 gwr unit = RD_UNIT(md);
200 1.1 gwr if (unit >= rdcd.cd_ndevs)
201 1.1 gwr return ENXIO;
202 1.1 gwr sc = rdcd.cd_devs[unit];
203 1.1 gwr if (sc == NULL)
204 1.1 gwr return ENXIO;
205 1.1 gwr
206 1.1 gwr /*
207 1.1 gwr * The control device is not exclusive, and can
208 1.1 gwr * open uninitialized units (so you can setconf).
209 1.1 gwr */
210 1.1 gwr if (RD_IS_CTRL(md))
211 1.1 gwr return 0;
212 1.1 gwr
213 1.1 gwr #ifdef RAMDISK_HOOKS
214 1.1 gwr /* Call the open hook to allow loading the device. */
215 1.1 gwr rd_open_hook(unit, &sc->sc_rd);
216 1.1 gwr #endif
217 1.1 gwr
218 1.1 gwr /*
219 1.1 gwr * This is a normal, "slave" device, so
220 1.1 gwr * enforce initialized, exclusive open.
221 1.1 gwr */
222 1.1 gwr if (sc->sc_type == RD_UNCONFIGURED)
223 1.1 gwr return ENXIO;
224 1.1 gwr if (sc->sc_flags & RD_ISOPEN)
225 1.1 gwr return EBUSY;
226 1.1 gwr
227 1.1 gwr return 0;
228 1.1 gwr }
229 1.1 gwr
230 1.1 gwr int rdclose(dev, flag, fmt, proc)
231 1.1 gwr dev_t dev;
232 1.1 gwr int flag, fmt;
233 1.1 gwr struct proc *proc;
234 1.1 gwr {
235 1.1 gwr int md, unit;
236 1.1 gwr struct rd_softc *sc;
237 1.1 gwr
238 1.1 gwr md = minor(dev);
239 1.1 gwr unit = RD_UNIT(md);
240 1.1 gwr sc = rdcd.cd_devs[unit];
241 1.1 gwr
242 1.1 gwr if (RD_IS_CTRL(md))
243 1.1 gwr return 0;
244 1.1 gwr
245 1.1 gwr /* Normal device. */
246 1.1 gwr sc->sc_flags = 0;
247 1.1 gwr
248 1.1 gwr return 0;
249 1.1 gwr }
250 1.1 gwr
251 1.1 gwr int
252 1.1 gwr rdread(dev, uio)
253 1.1 gwr dev_t dev;
254 1.1 gwr struct uio *uio;
255 1.1 gwr {
256 1.1 gwr return (physio(rdstrategy, NULL, dev, B_READ, minphys, uio));
257 1.1 gwr }
258 1.1 gwr
259 1.1 gwr int
260 1.1 gwr rdwrite(dev, uio)
261 1.1 gwr dev_t dev;
262 1.1 gwr struct uio *uio;
263 1.1 gwr {
264 1.1 gwr return (physio(rdstrategy, NULL, dev, B_WRITE, minphys, uio));
265 1.1 gwr }
266 1.1 gwr
267 1.1 gwr /*
268 1.1 gwr * Handle I/O requests, either directly, or
269 1.1 gwr * by passing them to the server process.
270 1.1 gwr */
271 1.1 gwr void
272 1.1 gwr rdstrategy(bp)
273 1.1 gwr struct buf *bp;
274 1.1 gwr {
275 1.1 gwr int md, unit;
276 1.1 gwr struct rd_softc *sc;
277 1.1 gwr caddr_t addr;
278 1.1 gwr size_t off, xfer;
279 1.1 gwr
280 1.1 gwr md = minor(bp->b_dev);
281 1.1 gwr unit = RD_UNIT(md);
282 1.1 gwr sc = rdcd.cd_devs[unit];
283 1.1 gwr
284 1.1 gwr switch (sc->sc_type) {
285 1.1 gwr #if RAMDISK_SERVER
286 1.1 gwr case RD_UMEM_SERVER:
287 1.1 gwr /* Just add this job to the server's queue. */
288 1.1 gwr bp->b_actf = sc->sc_buflist;
289 1.1 gwr sc->sc_buflist = bp;
290 1.1 gwr if (bp->b_actf == NULL) {
291 1.1 gwr /* server queue was empty. */
292 1.1 gwr wakeup((caddr_t)sc);
293 1.1 gwr /* see rd_server_loop() */
294 1.1 gwr }
295 1.1 gwr /* no biodone in this case */
296 1.1 gwr return;
297 1.1 gwr #endif /* RAMDISK_SERVER */
298 1.1 gwr
299 1.1 gwr case RD_KMEM_FIXED:
300 1.1 gwr case RD_KMEM_ALLOCATED:
301 1.1 gwr /* These are in kernel space. Access directly. */
302 1.1 gwr bp->b_resid = bp->b_bcount;
303 1.1 gwr off = (bp->b_blkno << DEV_BSHIFT);
304 1.1 gwr if (off >= sc->sc_size) {
305 1.1 gwr if (bp->b_flags & B_READ)
306 1.1 gwr break; /* EOF */
307 1.1 gwr goto set_eio;
308 1.1 gwr }
309 1.1 gwr xfer = bp->b_resid;
310 1.1 gwr if (xfer > (sc->sc_size - off))
311 1.1 gwr xfer = (sc->sc_size - off);
312 1.1 gwr addr = sc->sc_addr + off;
313 1.1 gwr if (bp->b_flags & B_READ)
314 1.1 gwr bcopy(addr, bp->b_data, xfer);
315 1.1 gwr else
316 1.1 gwr bcopy(bp->b_data, addr, xfer);
317 1.1 gwr bp->b_resid -= xfer;
318 1.1 gwr break;
319 1.1 gwr
320 1.1 gwr default:
321 1.1 gwr bp->b_resid = bp->b_bcount;
322 1.1 gwr set_eio:
323 1.1 gwr bp->b_error = EIO;
324 1.1 gwr bp->b_flags |= B_ERROR;
325 1.1 gwr break;
326 1.1 gwr }
327 1.1 gwr biodone(bp);
328 1.1 gwr }
329 1.1 gwr
330 1.1 gwr int
331 1.1 gwr rdioctl(dev, cmd, data, flag, proc)
332 1.1 gwr dev_t dev;
333 1.1 gwr u_long cmd;
334 1.1 gwr int flag;
335 1.1 gwr caddr_t data;
336 1.1 gwr struct proc *proc;
337 1.1 gwr {
338 1.1 gwr int md, unit;
339 1.1 gwr struct rd_softc *sc;
340 1.1 gwr struct rd_conf *urd;
341 1.1 gwr
342 1.1 gwr md = minor(dev);
343 1.1 gwr unit = RD_UNIT(md);
344 1.1 gwr sc = rdcd.cd_devs[unit];
345 1.1 gwr
346 1.1 gwr /* If this is not the control device, punt! */
347 1.1 gwr if (RD_IS_CTRL(md) == 0)
348 1.1 gwr return ENOTTY;
349 1.1 gwr
350 1.1 gwr urd = (struct rd_conf *)data;
351 1.1 gwr switch (cmd) {
352 1.1 gwr case RD_GETCONF:
353 1.1 gwr *urd = sc->sc_rd;
354 1.1 gwr return 0;
355 1.1 gwr
356 1.1 gwr case RD_SETCONF:
357 1.1 gwr /* Can only set it once. */
358 1.1 gwr if (sc->sc_type != RD_UNCONFIGURED)
359 1.1 gwr break;
360 1.1 gwr switch (urd->rd_type) {
361 1.1 gwr case RD_KMEM_ALLOCATED:
362 1.1 gwr return rd_ioctl_kalloc(sc, urd, proc);
363 1.1 gwr #if RAMDISK_SERVER
364 1.1 gwr case RD_UMEM_SERVER:
365 1.1 gwr return rd_ioctl_server(sc, urd, proc);
366 1.1 gwr #endif
367 1.1 gwr default:
368 1.1 gwr break;
369 1.1 gwr }
370 1.1 gwr break;
371 1.1 gwr }
372 1.1 gwr return EINVAL;
373 1.1 gwr }
374 1.1 gwr
375 1.1 gwr /*
376 1.1 gwr * Handle ioctl RD_SETCONF for (sc_type == RD_KMEM_ALLOCATED)
377 1.1 gwr * Just allocate some kernel memory and return.
378 1.1 gwr */
379 1.1 gwr int
380 1.1 gwr rd_ioctl_kalloc(sc, urd, proc)
381 1.1 gwr struct rd_softc *sc;
382 1.1 gwr struct rd_conf *urd;
383 1.1 gwr struct proc *proc;
384 1.1 gwr {
385 1.1 gwr vm_offset_t addr;
386 1.1 gwr vm_size_t size;
387 1.1 gwr
388 1.1 gwr /* Sanity check the size. */
389 1.1 gwr size = urd->rd_size;
390 1.1 gwr if (size > RD_KMEM_MAX_SIZE)
391 1.1 gwr return EINVAL;
392 1.1 gwr addr = kmem_alloc(kernel_map, size);
393 1.1 gwr if (!addr)
394 1.1 gwr return ENOMEM;
395 1.1 gwr
396 1.1 gwr /* This unit is now configured. */
397 1.1 gwr sc->sc_addr = (caddr_t)addr; /* kernel space */
398 1.1 gwr sc->sc_size = (size_t)size;
399 1.1 gwr sc->sc_type = RD_KMEM_ALLOCATED;
400 1.1 gwr return 0;
401 1.1 gwr }
402 1.1 gwr
403 1.1 gwr #if RAMDISK_SERVER
404 1.1 gwr
405 1.1 gwr /*
406 1.2 gwr * Handle ioctl RD_SETCONF for (sc_type == RD_UMEM_SERVER)
407 1.1 gwr * Set config, then become the I/O server for this unit.
408 1.1 gwr */
409 1.1 gwr int
410 1.1 gwr rd_ioctl_server(sc, urd, proc)
411 1.1 gwr struct rd_softc *sc;
412 1.1 gwr struct rd_conf *urd;
413 1.1 gwr struct proc *proc;
414 1.1 gwr {
415 1.1 gwr vm_offset_t end;
416 1.1 gwr int error;
417 1.1 gwr
418 1.1 gwr /* Sanity check addr, size. */
419 1.1 gwr end = (vm_offset_t) (urd->rd_addr + urd->rd_size);
420 1.1 gwr
421 1.1 gwr if ((end >= VM_MAXUSER_ADDRESS) ||
422 1.1 gwr (end < ((vm_offset_t) urd->rd_addr)) )
423 1.1 gwr return EINVAL;
424 1.1 gwr
425 1.1 gwr /* This unit is now configured. */
426 1.1 gwr sc->sc_addr = urd->rd_addr; /* user space */
427 1.1 gwr sc->sc_size = urd->rd_size;
428 1.1 gwr sc->sc_type = RD_UMEM_SERVER;
429 1.1 gwr
430 1.1 gwr /* Become the server daemon */
431 1.1 gwr error = rd_server_loop(sc);
432 1.1 gwr
433 1.1 gwr /* This server is now going away! */
434 1.1 gwr sc->sc_type = RD_UNCONFIGURED;
435 1.1 gwr sc->sc_addr = 0;
436 1.1 gwr sc->sc_size = 0;
437 1.1 gwr
438 1.1 gwr return (error);
439 1.1 gwr }
440 1.1 gwr
441 1.1 gwr int rd_sleep_pri = PWAIT | PCATCH;
442 1.1 gwr
443 1.1 gwr static int
444 1.1 gwr rd_server_loop(sc)
445 1.1 gwr struct rd_softc *sc;
446 1.1 gwr {
447 1.1 gwr struct buf *bp;
448 1.1 gwr caddr_t addr; /* user space address */
449 1.1 gwr size_t off; /* offset into "device" */
450 1.1 gwr size_t xfer; /* amount to transfer */
451 1.1 gwr int error;
452 1.1 gwr
453 1.1 gwr for (;;) {
454 1.1 gwr /* Wait for some work to arrive. */
455 1.1 gwr while (sc->sc_buflist == NULL) {
456 1.1 gwr error = tsleep((caddr_t)sc, rd_sleep_pri, "rd_idle", 0);
457 1.1 gwr if (error)
458 1.1 gwr return error;
459 1.1 gwr }
460 1.1 gwr
461 1.1 gwr /* Unlink buf from head of list. */
462 1.1 gwr bp = sc->sc_buflist;
463 1.1 gwr sc->sc_buflist = bp->b_actf;
464 1.1 gwr bp->b_actf = NULL;
465 1.1 gwr
466 1.1 gwr /* Do the transfer to/from user space. */
467 1.1 gwr error = 0;
468 1.1 gwr bp->b_resid = bp->b_bcount;
469 1.1 gwr off = (bp->b_blkno << DEV_BSHIFT);
470 1.1 gwr if (off >= sc->sc_size) {
471 1.1 gwr if (bp->b_flags & B_READ)
472 1.1 gwr goto done; /* EOF (not an error) */
473 1.1 gwr error = EIO;
474 1.1 gwr goto done;
475 1.1 gwr }
476 1.1 gwr xfer = bp->b_resid;
477 1.1 gwr if (xfer > (sc->sc_size - off))
478 1.1 gwr xfer = (sc->sc_size - off);
479 1.1 gwr addr = sc->sc_addr + off;
480 1.1 gwr if (bp->b_flags & B_READ)
481 1.1 gwr error = copyin(addr, bp->b_data, xfer);
482 1.1 gwr else
483 1.1 gwr error = copyout(bp->b_data, addr, xfer);
484 1.1 gwr if (!error)
485 1.1 gwr bp->b_resid -= xfer;
486 1.1 gwr
487 1.1 gwr done:
488 1.1 gwr if (error) {
489 1.1 gwr bp->b_error = error;
490 1.1 gwr bp->b_flags |= B_ERROR;
491 1.1 gwr }
492 1.1 gwr biodone(bp);
493 1.1 gwr }
494 1.1 gwr }
495 1.1 gwr
496 1.1 gwr #endif /* RAMDISK_SERVER */
497