Home | History | Annotate | Line # | Download | only in dev
md_root.c revision 1.24.2.1
      1 /*	NetBSD: md_root.c,v 1.17 2002/05/23 14:59:28 leo Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 1996 Leo Weppelman.
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  * 3. All advertising materials mentioning features or use of this software
     16  *    must display the following acknowledgement:
     17  *      This product includes software developed by Leo Weppelman.
     18  * 4. The name of the author may not be used to endorse or promote products
     19  *    derived from this software without specific prior written permission
     20  *
     21  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     22  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     23  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     24  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     25  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     26  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     27  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     28  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     29  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     30  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     31  */
     32 
     33 #include <sys/cdefs.h>
     34 __KERNEL_RCSID(0, "$NetBSD: md_root.c,v 1.24.2.1 2008/02/18 21:04:24 mjf Exp $");
     35 
     36 #include <sys/param.h>
     37 #include <sys/systm.h>
     38 #include <sys/kernel.h>
     39 #include <sys/malloc.h>
     40 #include <sys/buf.h>
     41 #include <sys/proc.h>
     42 #include <sys/device.h>
     43 #include <sys/ioctl.h>
     44 #include <sys/fcntl.h>
     45 #include <sys/conf.h>
     46 #include <sys/disklabel.h>
     47 #include <sys/disk.h>
     48 #include <sys/dkbad.h>
     49 
     50 #include <dev/cons.h>
     51 #include <dev/md.h>
     52 
     53 #include <atari/atari/device.h>
     54 
     55 /*
     56  * Misc. defines:
     57  */
     58 #define	RAMD_CHUNK	(9 * 512)	/* Chunk-size for auto-load	*/
     59 #define	RAMD_NDEV	3		/* Number of devices configured	*/
     60 
     61 struct   ramd_info {
     62 	u_long	ramd_size;  /* Size of disk in bytes			*/
     63 	u_long	ramd_flag;  /* see defs below				*/
     64 	dev_t	ramd_dev;   /* device to load from			*/
     65 };
     66 
     67 /*
     68  * ramd_flag:
     69  */
     70 #define	RAMD_LOAD	0x01	/* Auto load when first opened	*/
     71 #define	RAMD_LCOMP	0x02	/* Input is compressed		*/
     72 
     73 struct ramd_info rd_info[RAMD_NDEV] = {
     74     {
     75 	1105920,		/*	1Mb in 2160 sectors		*/
     76 	RAMD_LOAD,		/* auto-load this device		*/
     77 	MAKEDISKDEV(2, 0, 2),	/* XXX: This is crap! (720Kb flop)	*/
     78     },
     79     {
     80 	1474560,		/* 1.44Mb in 2880 sectors		*/
     81 	RAMD_LOAD,		/* auto-load this device		*/
     82 	MAKEDISKDEV(2, 0, 2),	/* XXX: This is crap! (720Kb flop)	*/
     83     },
     84     {
     85 	1474560,		/* 1.44Mb in 2880 sectors		*/
     86 	RAMD_LOAD,		/* auto-load this device		*/
     87 	MAKEDISKDEV(2, 0, 3),	/* XXX: This is crap! (1.44Mb flop)	*/
     88     }
     89 };
     90 
     91 struct read_info {
     92     struct buf	*bp;		/* buffer for strategy function		*/
     93     long	nbytes;		/* total number of bytes to read	*/
     94     long	offset;		/* offset in input medium		*/
     95     char	*bufp;		/* current output buffer		*/
     96     char	*ebufp;		/* absolute maximum for bufp		*/
     97     int		chunk;		/* chunk size on input medium		*/
     98     int		media_sz;	/* size of input medium			*/
     99     void	(*strat)(struct buf *);	/* strategy function for read	*/
    100 };
    101 
    102 
    103 static int  loaddisk __P((struct  md_conf *, dev_t ld_dev, struct lwp *));
    104 static int  ramd_norm_read __P((struct read_info *));
    105 
    106 #ifdef support_compression
    107 static int  cpy_uncompressed __P((void *, int, struct read_info *));
    108 static int  md_compressed __P((void *, int, struct read_info *));
    109 #endif
    110 
    111 /*
    112  * This is called during autoconfig.
    113  */
    114 void
    115 md_attach_hook(unit, md)
    116 int		unit;
    117 struct md_conf	*md;
    118 {
    119 	if (atari_realconfig && (unit < RAMD_NDEV) && rd_info[unit].ramd_flag) {
    120 		printf ("md%d: %sauto-load on open. Size %ld bytes.\n", unit,
    121 		    rd_info[unit].ramd_flag & RAMD_LCOMP ? "decompress/" : "",
    122 		    rd_info[unit].ramd_size);
    123 		md->md_type = MD_UNCONFIGURED; /* Paranoia... */
    124 	}
    125 }
    126 
    127 void
    128 md_open_hook(unit, md)
    129 int		unit;
    130 struct md_conf	*md;
    131 {
    132 	struct ramd_info *ri;
    133 
    134 	if(unit >= RAMD_NDEV)
    135 		return;
    136 
    137 	ri = &rd_info[unit];
    138 	if (md->md_type != MD_UNCONFIGURED)
    139 		return;	/* Only configure once */
    140 	md->md_addr = malloc(ri->ramd_size, M_DEVBUF, M_WAITOK);
    141 	md->md_size = ri->ramd_size;
    142 	if(md->md_addr == NULL)
    143 		return;
    144 	if(ri->ramd_flag & RAMD_LOAD) {
    145 		if (loaddisk(md, ri->ramd_dev, curlwp)) {
    146 			free(md->md_addr, M_DEVBUF);
    147 			md->md_addr = NULL;
    148 			return;
    149 		}
    150 	}
    151 	md->md_type = MD_KMEM_ALLOCATED;
    152 }
    153 
    154 static int
    155 loaddisk(md, ld_dev, lwp)
    156 struct md_conf		*md;
    157 dev_t			ld_dev;
    158 struct lwp		*lwp;
    159 {
    160 	struct buf		*buf;
    161 	int			error;
    162 	const struct bdevsw	*bdp;
    163 	struct disklabel	dl;
    164 	struct read_info	rs;
    165 
    166 	bdp = bdevsw_lookup(ld_dev);
    167 	if (bdp == NULL)
    168 		return (ENXIO);
    169 
    170 	/*
    171 	 * Initialize our buffer header:
    172 	 */
    173 	buf = getiobuf(NULL, false);
    174 	buf->b_cflags = BC_BUSY;
    175 	buf->b_dev   = ld_dev;
    176 	buf->b_error = 0;
    177 	buf->b_proc  = lwp->l_proc;
    178 
    179 	/*
    180 	 * Setup read_info:
    181 	 */
    182 	rs.bp       = buf;
    183 	rs.nbytes   = md->md_size;
    184 	rs.offset   = 0;
    185 	rs.bufp     = md->md_addr;
    186 	rs.ebufp    = (char *)md->md_addr + md->md_size;
    187 	rs.chunk    = RAMD_CHUNK;
    188 	rs.media_sz = md->md_size;
    189 	rs.strat    = bdp->d_strategy;
    190 
    191 	/*
    192 	 * Open device and try to get some statistics.
    193 	 */
    194 	if((error = bdp->d_open(ld_dev, FREAD | FNONBLOCK, 0, lwp)) != 0) {
    195 		putiobuf(buf);
    196 		return(error);
    197 	}
    198 	if(bdp->d_ioctl(ld_dev, DIOCGDINFO, (void *)&dl, FREAD, lwp) == 0) {
    199 		/* Read on a cylinder basis */
    200 		rs.chunk    = dl.d_secsize * dl.d_secpercyl;
    201 		rs.media_sz = dl.d_secperunit * dl.d_secsize;
    202 	}
    203 
    204 #ifdef support_compression
    205 	if(ri->ramd_flag & RAMD_LCOMP)
    206 		error = decompress(cpy_uncompressed, md_compressed, &rs);
    207 	else
    208 #endif /* support_compression */
    209 		error = ramd_norm_read(&rs);
    210 
    211 	bdp->d_close(ld_dev,FREAD | FNONBLOCK, 0, lwp);
    212 	putiobuf(buf);
    213 	return(error);
    214 }
    215 
    216 static int
    217 ramd_norm_read(rsp)
    218 struct read_info	*rsp;
    219 {
    220 	long		bytes_left;
    221 	int		done, error;
    222 	struct buf	*bp;
    223 	int		dotc = 0;
    224 
    225 	bytes_left = rsp->nbytes;
    226 	bp         = rsp->bp;
    227 	error      = 0;
    228 
    229 	while(bytes_left > 0) {
    230 		bp->b_cflags = BC_BUSY;
    231 		bp->b_flags  = B_PHYS | B_READ;
    232 		bp->b_blkno  = btodb(rsp->offset);
    233 		bp->b_bcount = rsp->chunk;
    234 		bp->b_data   = rsp->bufp;
    235 		bp->b_error  = 0;
    236 
    237 		/* Initiate read */
    238 		(*rsp->strat)(bp);
    239 
    240 		/* Wait for results	*/
    241 		biowait(bp);
    242 		error = bp->b_error;
    243 
    244 		/* Dot counter */
    245 		printf(".");
    246 		if(!(++dotc % 40))
    247 			printf("\n");
    248 
    249 		done = bp->b_bcount - bp->b_resid;
    250 		bytes_left   -= done;
    251 		rsp->offset  += done;
    252 		rsp->bufp    += done;
    253 
    254 		if(error || !done)
    255 			break;
    256 
    257 		if((rsp->offset == rsp->media_sz) && (bytes_left != 0)) {
    258 			printf("\nInsert next media and hit any key...");
    259 			cngetc();
    260 			printf("\n");
    261 			rsp->offset = 0;
    262 		}
    263 	}
    264 	printf("\n");
    265 	return(error);
    266 }
    267 
    268 #ifdef support_compression
    269 /*
    270  * Functions supporting uncompression:
    271  */
    272 /*
    273  * Copy from the uncompression buffer to the ramdisk
    274  */
    275 static int
    276 cpy_uncompressed(buf, nbyte, rsp)
    277 void *			buf;
    278 struct read_info	*rsp;
    279 int			nbyte;
    280 {
    281 	if((rsp->bufp + nbyte) >= rsp->ebufp)
    282 		return(0);
    283 	bcopy(buf, rsp->bufp, nbyte);
    284 	rsp->bufp += nbyte;
    285 	return(0);
    286 }
    287 
    288 /*
    289  * Read a maximum of 'nbyte' bytes into 'buf'.
    290  */
    291 static int
    292 md_compressed(buf, nbyte, rsp)
    293 void *			buf;
    294 struct read_info	*rsp;
    295 int			nbyte;
    296 {
    297 	static int	dotc = 0;
    298 	struct buf	*bp;
    299 	       int	nread = 0;
    300 	       int	done, error;
    301 
    302 
    303 	error  = 0;
    304 	bp     = rsp->bp;
    305 	nbyte &= ~(DEV_BSIZE - 1);
    306 
    307 	while(nbyte > 0) {
    308 		bp->b_cflags = BC_BUSY;
    309 		bp->b_flags  = B_PHYS | B_READ;
    310 		bp->b_blkno  = btodb(rsp->offset);
    311 		bp->b_bcount = min(rsp->chunk, nbyte);
    312 		bp->b_data   = buf;
    313 		bp->b_error  = 0;
    314 
    315 		/* Initiate read */
    316 		(*rsp->strat)(bp);
    317 
    318 		/* Wait for results	*/
    319 		biowait(bp);
    320 
    321 		/* Dot counter */
    322 		printf(".");
    323 		if(!(++dotc % 40))
    324 			printf("\n");
    325 
    326 		done = bp->b_bcount - bp->b_resid;
    327 		nbyte        -= done;
    328 		nread        += done;
    329 		rsp->offset  += done;
    330 
    331 		if(error || !done)
    332 			break;
    333 
    334 		if((rsp->offset == rsp->media_sz) && (nbyte != 0)) {
    335 		if(rsp->offset == rsp->media_sz) {
    336 			printf("\nInsert next media and hit any key...");
    337 			if(cngetc() != '\n')
    338 				printf("\n");
    339 			rsp->offset = 0;
    340 		}
    341 	}
    342 	return(nread);
    343 }
    344 #endif /* support_compression */
    345