349 lines
8.5 KiB
C
349 lines
8.5 KiB
C
/* $NetBSD: md_root.c,v 1.17 2002/05/23 14:59:28 leo Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 1996 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>
|
|
|
|
#include <dev/cons.h>
|
|
#include <dev/md.h>
|
|
|
|
#include <atari/atari/device.h>
|
|
|
|
/*
|
|
* Misc. defines:
|
|
*/
|
|
#define RAMD_CHUNK (9 * 512) /* Chunk-size for auto-load */
|
|
#define RAMD_NDEV 3 /* 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 */
|
|
};
|
|
|
|
/*
|
|
* ramd_flag:
|
|
*/
|
|
#define RAMD_LOAD 0x01 /* Auto load when first opened */
|
|
#define RAMD_LCOMP 0x02 /* Input is compressed */
|
|
|
|
struct ramd_info rd_info[RAMD_NDEV] = {
|
|
{
|
|
1105920, /* 1Mb in 2160 sectors */
|
|
RAMD_LOAD, /* auto-load this device */
|
|
MAKEDISKDEV(2, 0, 2), /* XXX: This is crap! (720Kb flop) */
|
|
},
|
|
{
|
|
1474560, /* 1.44Mb in 2880 sectors */
|
|
RAMD_LOAD, /* auto-load this device */
|
|
MAKEDISKDEV(2, 0, 2), /* XXX: This is crap! (720Kb flop) */
|
|
},
|
|
{
|
|
1474560, /* 1.44Mb in 2880 sectors */
|
|
RAMD_LOAD, /* auto-load this device */
|
|
MAKEDISKDEV(2, 0, 3), /* XXX: This is crap! (1.44Mb flop) */
|
|
}
|
|
};
|
|
|
|
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)(struct buf *); /* strategy function for read */
|
|
};
|
|
|
|
|
|
static int loaddisk __P((struct md_conf *, dev_t ld_dev, struct proc *));
|
|
static int ramd_norm_read __P((struct read_info *));
|
|
|
|
#ifdef support_compression
|
|
static int cpy_uncompressed __P((caddr_t, int, struct read_info *));
|
|
static int md_compressed __P((caddr_t, int, struct read_info *));
|
|
#endif
|
|
|
|
/*
|
|
* This is called during autoconfig.
|
|
*/
|
|
void
|
|
md_attach_hook(unit, md)
|
|
int unit;
|
|
struct md_conf *md;
|
|
{
|
|
if (atari_realconfig && (unit < RAMD_NDEV) && rd_info[unit].ramd_flag) {
|
|
printf ("md%d: %sauto-load on open. Size %ld bytes.\n", unit,
|
|
rd_info[unit].ramd_flag & RAMD_LCOMP ? "decompress/" : "",
|
|
rd_info[unit].ramd_size);
|
|
md->md_type = MD_UNCONFIGURED; /* Paranoia... */
|
|
}
|
|
}
|
|
|
|
void
|
|
md_open_hook(unit, md)
|
|
int unit;
|
|
struct md_conf *md;
|
|
{
|
|
struct ramd_info *ri;
|
|
|
|
if(unit >= RAMD_NDEV)
|
|
return;
|
|
|
|
ri = &rd_info[unit];
|
|
if (md->md_type != MD_UNCONFIGURED)
|
|
return; /* Only configure once */
|
|
md->md_addr = malloc(ri->ramd_size, M_DEVBUF, M_WAITOK);
|
|
md->md_size = ri->ramd_size;
|
|
if(md->md_addr == NULL)
|
|
return;
|
|
if(ri->ramd_flag & RAMD_LOAD) {
|
|
if (loaddisk(md, ri->ramd_dev, curproc)) {
|
|
free(md->md_addr, M_DEVBUF);
|
|
md->md_addr = NULL;
|
|
return;
|
|
}
|
|
}
|
|
md->md_type = MD_KMEM_ALLOCATED;
|
|
}
|
|
|
|
static int
|
|
loaddisk(md, ld_dev, proc)
|
|
struct md_conf *md;
|
|
dev_t ld_dev;
|
|
struct proc *proc;
|
|
{
|
|
struct buf buf;
|
|
int error;
|
|
struct bdevsw *bdp = &bdevsw[major(ld_dev)];
|
|
struct disklabel dl;
|
|
struct read_info rs;
|
|
|
|
/*
|
|
* Initialize our buffer header:
|
|
*/
|
|
memset(&buf, 0, sizeof(buf));
|
|
buf.b_vnbufs.le_next = NOLIST;
|
|
buf.b_flags = B_BUSY;
|
|
buf.b_dev = ld_dev;
|
|
buf.b_error = 0;
|
|
buf.b_proc = proc;
|
|
|
|
/*
|
|
* Setup read_info:
|
|
*/
|
|
rs.bp = &buf;
|
|
rs.nbytes = md->md_size;
|
|
rs.offset = 0;
|
|
rs.bufp = md->md_addr;
|
|
rs.ebufp = md->md_addr + md->md_size;
|
|
rs.chunk = RAMD_CHUNK;
|
|
rs.media_sz = md->md_size;
|
|
rs.strat = bdp->d_strategy;
|
|
|
|
/*
|
|
* Open device and try to get some statistics.
|
|
*/
|
|
if((error = bdp->d_open(ld_dev, FREAD | FNONBLOCK, 0, proc)) != 0)
|
|
return(error);
|
|
if(bdp->d_ioctl(ld_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 support_compression
|
|
if(ri->ramd_flag & RAMD_LCOMP)
|
|
error = decompress(cpy_uncompressed, md_compressed, &rs);
|
|
else
|
|
#endif /* support_compression */
|
|
error = ramd_norm_read(&rs);
|
|
|
|
bdp->d_close(ld_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");
|
|
return(error);
|
|
}
|
|
|
|
#ifdef support_compression
|
|
/*
|
|
* 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
|
|
md_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) && (nbyte != 0)) {
|
|
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);
|
|
}
|
|
#endif /* support_compression */
|