493 lines
11 KiB
C
493 lines
11 KiB
C
/* $NetBSD: ramd.c,v 1.1.1.1 1995/03/26 07:12:13 leo Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 1995 Leo Weppelman.
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by Leo Weppelman.
|
|
* 4. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/buf.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/device.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/fcntl.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/disklabel.h>
|
|
#include <sys/disk.h>
|
|
#include <sys/dkbad.h>
|
|
|
|
/*
|
|
* Misc. defines:
|
|
*/
|
|
#define RAMD_CHUNK (9 * 512) /* Chunk-size for auto-load */
|
|
#define RAMD_NDEV 1 /* Number of devices configured */
|
|
|
|
struct ramd_info {
|
|
u_long ramd_size; /* Size of disk in bytes */
|
|
u_long ramd_flag; /* see defs below */
|
|
dev_t ramd_dev; /* device to load from */
|
|
u_long ramd_state; /* runtime state see defs below */
|
|
caddr_t ramd_addr; /* Kernel virtual addr */
|
|
};
|
|
|
|
/*
|
|
* ramd_flag:
|
|
*/
|
|
#define RAMD_LOAD 0x01 /* Auto load when first opened */
|
|
#define RAMD_LCOMP 0x02 /* Input is compressed */
|
|
|
|
/*
|
|
* ramd_state:
|
|
*/
|
|
#define RAMD_ALLOC 0x01 /* Memory is allocated */
|
|
#define RAMD_OPEN 0x02 /* Ramdisk is open */
|
|
#define RAMD_INOPEN 0x04 /* Ramdisk is being opened */
|
|
#define RAMD_WANTED 0x08 /* Someone is waiting on struct */
|
|
#define RAMD_LOADED 0x10 /* Ramdisk is properly loaded */
|
|
|
|
struct ramd_info rd_info[RAMD_NDEV] = {
|
|
{
|
|
1105920, /* 1Mb in 2160 sectors */
|
|
RAMD_LOAD, /* auto-load this device */
|
|
MAKEDISKDEV(2, 0, 1), /* XXX: This is crap! (720Kb flop) */
|
|
0, /* Will be set at runtime */
|
|
NULL /* Will be set at runtime */
|
|
},
|
|
{
|
|
1474560, /* 1.44Mb in 2880 sectors */
|
|
RAMD_LOAD, /* auto-load this device */
|
|
MAKEDISKDEV(2, 0, 1), /* XXX: This is crap! (720Kb flop) */
|
|
0, /* Will be set at runtime */
|
|
NULL /* Will be set at runtime */
|
|
}
|
|
};
|
|
|
|
struct read_info {
|
|
struct buf *bp; /* buffer for strategy function */
|
|
long nbytes; /* total number of bytes to read */
|
|
long offset; /* offset in input medium */
|
|
caddr_t bufp; /* current output buffer */
|
|
caddr_t ebufp; /* absolute maximum for bufp */
|
|
int chunk; /* chunk size on input medium */
|
|
int media_sz; /* size of input medium */
|
|
void (*strat)(); /* strategy function for read */
|
|
};
|
|
|
|
/*
|
|
* Autoconfig stuff....
|
|
*/
|
|
static int ramdmatch __P((struct device *, struct cfdata *, void *));
|
|
static int ramdprint __P((void *, char *));
|
|
static void ramdattach __P((struct device *, struct device *, void *));
|
|
|
|
struct cfdriver ramdcd = {
|
|
NULL, "rd", (cfmatch_t)ramdmatch, ramdattach, DV_DULL,
|
|
sizeof(struct device), NULL, 0 };
|
|
|
|
static int
|
|
ramdmatch(pdp, cfp, auxp)
|
|
struct device *pdp;
|
|
struct cfdata *cfp;
|
|
void *auxp;
|
|
{
|
|
if(strcmp("rd", auxp) || (cfp->cf_unit >= RAMD_NDEV))
|
|
return(0);
|
|
return(1);
|
|
}
|
|
|
|
static void
|
|
ramdattach(pdp, dp, auxp)
|
|
struct device *pdp, *dp;
|
|
void *auxp;
|
|
{
|
|
int i;
|
|
|
|
for(i = 0; i < RAMD_NDEV; i++)
|
|
config_found(dp, (void*)i, ramdprint);
|
|
}
|
|
|
|
static int
|
|
ramdprint(auxp, pnp)
|
|
void *auxp;
|
|
char *pnp;
|
|
{
|
|
return(UNCONF);
|
|
}
|
|
|
|
static int loaddisk __P((struct ramd_info *, struct proc *));
|
|
static void rdminphys __P((struct buf *));
|
|
static int ramd_norm_read __P((struct read_info *));
|
|
static int cpy_uncompressed __P((caddr_t, int, struct read_info *));
|
|
static int rd_compressed __P((caddr_t, int, struct read_info *));
|
|
|
|
int
|
|
rdopen(dev, flags, devtype, p)
|
|
dev_t dev;
|
|
int flags, devtype;
|
|
struct proc *p;
|
|
{
|
|
struct ramd_info *ri;
|
|
int s;
|
|
int error = 0;
|
|
|
|
if(DISKUNIT(dev) >= RAMD_NDEV)
|
|
return(ENXIO);
|
|
|
|
ri = &rd_info[DISKUNIT(dev)];
|
|
if(ri->ramd_state & RAMD_OPEN)
|
|
return(0);
|
|
|
|
/*
|
|
* If someone is busy opening, wait for it to complete.
|
|
*/
|
|
s = splbio();
|
|
while(ri->ramd_state & RAMD_INOPEN) {
|
|
ri->ramd_state |= RAMD_WANTED;
|
|
tsleep((caddr_t)ri, PRIBIO, "rdopen", 0);
|
|
}
|
|
ri->ramd_state |= RAMD_INOPEN;
|
|
splx(s);
|
|
|
|
if(!(ri->ramd_state & RAMD_ALLOC)) {
|
|
ri->ramd_addr = malloc(ri->ramd_size, M_DEVBUF, M_WAITOK);
|
|
if(ri->ramd_addr == NULL) {
|
|
error = ENXIO;
|
|
goto done;
|
|
}
|
|
ri->ramd_state |= RAMD_ALLOC;
|
|
}
|
|
if((ri->ramd_flag & RAMD_LOAD) && !(ri->ramd_state & RAMD_LOADED)) {
|
|
error = loaddisk(ri, p);
|
|
if(!error)
|
|
ri->ramd_state |= RAMD_LOADED;
|
|
}
|
|
done:
|
|
ri->ramd_state &= ~RAMD_INOPEN;
|
|
if(ri->ramd_state & RAMD_WANTED) {
|
|
ri->ramd_state &= ~RAMD_WANTED;
|
|
wakeup((caddr_t)ri);
|
|
}
|
|
return(error);
|
|
}
|
|
|
|
int
|
|
rdclose(dev, flags, devtype, p)
|
|
dev_t dev;
|
|
int flags, devtype;
|
|
struct proc *p;
|
|
{
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
rdioctl(dev, cmd, addr, flag, p)
|
|
dev_t dev;
|
|
u_long cmd;
|
|
int flag;
|
|
caddr_t addr;
|
|
struct proc *p;
|
|
{
|
|
return(ENOTTY);
|
|
}
|
|
|
|
/*
|
|
* no dumps to ram disks thank you.
|
|
*/
|
|
int
|
|
rdsize(dev)
|
|
dev_t dev;
|
|
{
|
|
return(-1);
|
|
}
|
|
|
|
int
|
|
rdread(dev, uio)
|
|
dev_t dev;
|
|
struct uio *uio;
|
|
{
|
|
return (physio(cdevsw[major(dev)].d_strategy, (struct buf *)NULL,
|
|
dev, B_READ, rdminphys, uio));
|
|
}
|
|
|
|
int
|
|
rdwrite(dev, uio)
|
|
dev_t dev;
|
|
struct uio *uio;
|
|
{
|
|
return(physio(cdevsw[major(dev)].d_strategy, (struct buf *)NULL,
|
|
dev, B_WRITE, rdminphys, uio));
|
|
}
|
|
|
|
/* XXX: Limit to 64k. */
|
|
static void
|
|
rdminphys(bp)
|
|
struct buf *bp;
|
|
{
|
|
bp->b_bcount = min(bp->b_bcount, (64 * 1024));
|
|
}
|
|
|
|
void
|
|
rdstrategy(bp)
|
|
struct buf *bp;
|
|
{
|
|
struct ramd_info *ri;
|
|
long maxsz, sz;
|
|
char *datap;
|
|
|
|
ri = &rd_info[DISKUNIT(bp->b_dev)];
|
|
|
|
maxsz = ri->ramd_size / DEV_BSIZE;
|
|
sz = (bp->b_bcount + DEV_BSIZE - 1) / DEV_BSIZE;
|
|
if (bp->b_blkno < 0 || bp->b_blkno + sz > maxsz) {
|
|
if((bp->b_blkno == maxsz) && (bp->b_flags & B_READ)) {
|
|
/* Hitting EOF */
|
|
bp->b_resid = bp->b_bcount;
|
|
goto done;
|
|
}
|
|
sz = maxsz - bp->b_blkno;
|
|
if((sz <= 0) || (bp->b_blkno < 0)) {
|
|
bp->b_error = EINVAL;
|
|
bp->b_flags |= B_ERROR;
|
|
goto done;
|
|
}
|
|
bp->b_bcount = sz * DEV_BSIZE;
|
|
}
|
|
datap = (char*)((u_long)ri->ramd_addr + bp->b_blkno * DEV_BSIZE);
|
|
if(bp->b_flags & B_READ)
|
|
bcopy(datap, bp->b_data, bp->b_bcount);
|
|
else bcopy(bp->b_data, datap, bp->b_bcount);
|
|
bp->b_resid = 0;
|
|
biodone(bp);
|
|
return;
|
|
|
|
done:
|
|
bp->b_resid = bp->b_bcount;
|
|
biodone(bp);
|
|
}
|
|
|
|
static int
|
|
loaddisk(ri, proc)
|
|
struct ramd_info *ri;
|
|
struct proc *proc;
|
|
{
|
|
struct buf buf;
|
|
int error;
|
|
struct bdevsw *bdp = &bdevsw[major(ri->ramd_dev)];
|
|
struct disklabel dl;
|
|
struct read_info rs;
|
|
|
|
/*
|
|
* Initialize out buffer header:
|
|
*/
|
|
buf.b_actf = NULL;
|
|
buf.b_rcred = buf.b_wcred = proc->p_ucred;
|
|
buf.b_vnbufs.le_next = NOLIST;
|
|
buf.b_flags = B_BUSY;
|
|
buf.b_dev = ri->ramd_dev;
|
|
buf.b_error = 0;
|
|
buf.b_proc = proc;
|
|
|
|
/*
|
|
* Setup read_info:
|
|
*/
|
|
rs.bp = &buf;
|
|
rs.nbytes = ri->ramd_size;
|
|
rs.offset = 0;
|
|
rs.bufp = ri->ramd_addr;
|
|
rs.ebufp = ri->ramd_addr + ri->ramd_size;
|
|
rs.chunk = RAMD_CHUNK;
|
|
rs.media_sz = ri->ramd_size;
|
|
rs.strat = bdp->d_strategy;
|
|
|
|
/*
|
|
* Open device and try to get some statistics.
|
|
*/
|
|
if(error = bdp->d_open(ri->ramd_dev,FREAD | FNONBLOCK, 0, proc))
|
|
return(error);
|
|
if(bdp->d_ioctl(ri->ramd_dev,DIOCGDINFO,(caddr_t)&dl,FREAD,proc) == 0) {
|
|
/* Read on a cylinder basis */
|
|
rs.chunk = dl.d_secsize * dl.d_secpercyl;
|
|
rs.media_sz = dl.d_secperunit * dl.d_secsize;
|
|
}
|
|
|
|
#ifdef notyet
|
|
if(ri->ramd_flag & RAMD_LCOMP)
|
|
error = decompress(cpy_uncompressed, rd_compressed, &rs);
|
|
else
|
|
#endif /* notyet */
|
|
error = ramd_norm_read(&rs);
|
|
|
|
bdp->d_close(ri->ramd_dev,FREAD | FNONBLOCK, 0, proc);
|
|
return(error);
|
|
}
|
|
|
|
static int
|
|
ramd_norm_read(rsp)
|
|
struct read_info *rsp;
|
|
{
|
|
long bytes_left;
|
|
int done, error;
|
|
struct buf *bp;
|
|
int s;
|
|
int dotc = 0;
|
|
|
|
bytes_left = rsp->nbytes;
|
|
bp = rsp->bp;
|
|
error = 0;
|
|
|
|
while(bytes_left > 0) {
|
|
s = splbio();
|
|
bp->b_flags = B_BUSY | B_PHYS | B_READ;
|
|
splx(s);
|
|
bp->b_blkno = btodb(rsp->offset);
|
|
bp->b_bcount = rsp->chunk;
|
|
bp->b_data = rsp->bufp;
|
|
|
|
/* Initiate read */
|
|
(*rsp->strat)(bp);
|
|
|
|
/* Wait for results */
|
|
s = splbio();
|
|
while ((bp->b_flags & B_DONE) == 0)
|
|
tsleep((caddr_t) bp, PRIBIO + 1, "ramd_norm_read", 0);
|
|
if (bp->b_flags & B_ERROR)
|
|
error = (bp->b_error ? bp->b_error : EIO);
|
|
splx(s);
|
|
|
|
/* Dot counter */
|
|
printf(".");
|
|
if(!(++dotc % 40))
|
|
printf("\n");
|
|
|
|
done = bp->b_bcount - bp->b_resid;
|
|
bytes_left -= done;
|
|
rsp->offset += done;
|
|
rsp->bufp += done;
|
|
|
|
if(error || !done)
|
|
break;
|
|
|
|
if((rsp->offset == rsp->media_sz) && (bytes_left != 0)) {
|
|
printf("\nInsert next media and hit any key...");
|
|
cngetc();
|
|
printf("\n");
|
|
rsp->offset = 0;
|
|
}
|
|
}
|
|
printf("\n");
|
|
s = splbio();
|
|
splx(s);
|
|
return(error);
|
|
}
|
|
|
|
/*
|
|
* Functions supporting uncompression:
|
|
*/
|
|
/*
|
|
* Copy from the uncompression buffer to the ramdisk
|
|
*/
|
|
static int
|
|
cpy_uncompressed(buf, nbyte, rsp)
|
|
caddr_t buf;
|
|
struct read_info *rsp;
|
|
int nbyte;
|
|
{
|
|
if((rsp->bufp + nbyte) >= rsp->ebufp)
|
|
return(0);
|
|
bcopy(buf, rsp->bufp, nbyte);
|
|
rsp->bufp += nbyte;
|
|
return(0);
|
|
}
|
|
|
|
/*
|
|
* Read a maximum of 'nbyte' bytes into 'buf'.
|
|
*/
|
|
static int
|
|
rd_compressed(buf, nbyte, rsp)
|
|
caddr_t buf;
|
|
struct read_info *rsp;
|
|
int nbyte;
|
|
{
|
|
static int dotc = 0;
|
|
struct buf *bp;
|
|
int nread = 0;
|
|
int s;
|
|
int done, error;
|
|
|
|
|
|
error = 0;
|
|
bp = rsp->bp;
|
|
nbyte &= ~(DEV_BSIZE - 1);
|
|
|
|
while(nbyte > 0) {
|
|
s = splbio();
|
|
bp->b_flags = B_BUSY | B_PHYS | B_READ;
|
|
splx(s);
|
|
bp->b_blkno = btodb(rsp->offset);
|
|
bp->b_bcount = min(rsp->chunk, nbyte);
|
|
bp->b_data = buf;
|
|
|
|
/* Initiate read */
|
|
(*rsp->strat)(bp);
|
|
|
|
/* Wait for results */
|
|
s = splbio();
|
|
while ((bp->b_flags & B_DONE) == 0)
|
|
tsleep((caddr_t) bp, PRIBIO + 1, "ramd_norm_read", 0);
|
|
if (bp->b_flags & B_ERROR)
|
|
error = (bp->b_error ? bp->b_error : EIO);
|
|
splx(s);
|
|
|
|
/* Dot counter */
|
|
printf(".");
|
|
if(!(++dotc % 40))
|
|
printf("\n");
|
|
|
|
done = bp->b_bcount - bp->b_resid;
|
|
nbyte -= done;
|
|
nread += done;
|
|
rsp->offset += done;
|
|
|
|
if(error || !done)
|
|
break;
|
|
|
|
if(rsp->offset == rsp->media_sz) {
|
|
printf("\nInsert next media and hit any key...");
|
|
if(cngetc() != '\n')
|
|
printf("\n");
|
|
rsp->offset = 0;
|
|
}
|
|
}
|
|
s = splbio();
|
|
splx(s);
|
|
return(nread);
|
|
}
|