Home | History | Annotate | Line # | Download | only in dev
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