md_root.c revision 1.2
1 /* $NetBSD: md_root.c,v 1.2 1996/03/27 10:13:09 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/param.h> 34 #include <sys/systm.h> 35 #include <sys/kernel.h> 36 #include <sys/malloc.h> 37 #include <sys/buf.h> 38 #include <sys/proc.h> 39 #include <sys/device.h> 40 #include <sys/ioctl.h> 41 #include <sys/fcntl.h> 42 #include <sys/conf.h> 43 #include <sys/disklabel.h> 44 #include <sys/disk.h> 45 #include <sys/dkbad.h> 46 47 #include <dev/ramdisk.h> 48 49 /* 50 * Misc. defines: 51 */ 52 #define RAMD_CHUNK (9 * 512) /* Chunk-size for auto-load */ 53 #define RAMD_NDEV 2 /* Number of devices configured */ 54 55 struct ramd_info { 56 u_long ramd_size; /* Size of disk in bytes */ 57 u_long ramd_flag; /* see defs below */ 58 dev_t ramd_dev; /* device to load from */ 59 }; 60 61 /* 62 * ramd_flag: 63 */ 64 #define RAMD_LOAD 0x01 /* Auto load when first opened */ 65 #define RAMD_LCOMP 0x02 /* Input is compressed */ 66 67 struct ramd_info rd_info[RAMD_NDEV] = { 68 { 69 1105920, /* 1Mb in 2160 sectors */ 70 RAMD_LOAD, /* auto-load this device */ 71 MAKEDISKDEV(2, 0, 1), /* XXX: This is crap! (720Kb flop) */ 72 }, 73 { 74 1474560, /* 1.44Mb in 2880 sectors */ 75 RAMD_LOAD, /* auto-load this device */ 76 MAKEDISKDEV(2, 0, 1), /* XXX: This is crap! (720Kb flop) */ 77 } 78 }; 79 80 struct read_info { 81 struct buf *bp; /* buffer for strategy function */ 82 long nbytes; /* total number of bytes to read */ 83 long offset; /* offset in input medium */ 84 caddr_t bufp; /* current output buffer */ 85 caddr_t ebufp; /* absolute maximum for bufp */ 86 int chunk; /* chunk size on input medium */ 87 int media_sz; /* size of input medium */ 88 void (*strat)(struct buf *); /* strategy function for read */ 89 }; 90 91 92 static int loaddisk __P((struct rd_conf *, dev_t ld_dev, struct proc *)); 93 static int ramd_norm_read __P((struct read_info *)); 94 static int cpy_uncompressed __P((caddr_t, int, struct read_info *)); 95 static int rd_compressed __P((caddr_t, int, struct read_info *)); 96 97 /* 98 * This is called during autoconfig. 99 */ 100 void 101 rd_attach_hook(unit, rd) 102 int unit; 103 struct rd_conf *rd; 104 { 105 extern int atari_realconfig; 106 107 if (atari_realconfig && (unit < RAMD_NDEV) && rd_info[unit].ramd_flag) { 108 printf ("rd%d:%sauto-load on open. Size %ld bytes.\n", unit, 109 rd_info[unit].ramd_flag & RAMD_LCOMP ? " decompress/" : "", 110 rd_info[unit].ramd_size); 111 rd->rd_type = RD_UNCONFIGURED; /* Paranoia... */ 112 } 113 } 114 115 void 116 rd_open_hook(unit, rd) 117 int unit; 118 struct rd_conf *rd; 119 { 120 struct ramd_info *ri; 121 122 if(unit >= RAMD_NDEV) 123 return; 124 125 ri = &rd_info[unit]; 126 if (rd->rd_type != RD_UNCONFIGURED) 127 return; /* Only configure once */ 128 rd->rd_addr = malloc(ri->ramd_size, M_DEVBUF, M_WAITOK); 129 rd->rd_size = ri->ramd_size; 130 if(rd->rd_addr == NULL) 131 return; 132 if(ri->ramd_flag & RAMD_LOAD) { 133 if (loaddisk(rd, ri->ramd_dev, curproc)) { 134 free(rd->rd_addr, M_DEVBUF); 135 rd->rd_addr = NULL; 136 return; 137 } 138 } 139 rd->rd_type = RD_KMEM_ALLOCATED; 140 } 141 142 static int 143 loaddisk(rd, ld_dev, proc) 144 struct rd_conf *rd; 145 dev_t ld_dev; 146 struct proc *proc; 147 { 148 struct buf buf; 149 int error; 150 struct bdevsw *bdp = &bdevsw[major(ld_dev)]; 151 struct disklabel dl; 152 struct read_info rs; 153 154 /* 155 * Initialize our buffer header: 156 */ 157 buf.b_actf = NULL; 158 buf.b_rcred = buf.b_wcred = proc->p_ucred; 159 buf.b_vnbufs.le_next = NOLIST; 160 buf.b_flags = B_BUSY; 161 buf.b_dev = ld_dev; 162 buf.b_error = 0; 163 buf.b_proc = proc; 164 165 /* 166 * Setup read_info: 167 */ 168 rs.bp = &buf; 169 rs.nbytes = rd->rd_size; 170 rs.offset = 0; 171 rs.bufp = rd->rd_addr; 172 rs.ebufp = rd->rd_addr + rd->rd_size; 173 rs.chunk = RAMD_CHUNK; 174 rs.media_sz = rd->rd_size; 175 rs.strat = bdp->d_strategy; 176 177 /* 178 * Open device and try to get some statistics. 179 */ 180 if(error = bdp->d_open(ld_dev, FREAD | FNONBLOCK, 0, proc)) 181 return(error); 182 if(bdp->d_ioctl(ld_dev, DIOCGDINFO, (caddr_t)&dl, FREAD, proc) == 0) { 183 /* Read on a cylinder basis */ 184 rs.chunk = dl.d_secsize * dl.d_secpercyl; 185 rs.media_sz = dl.d_secperunit * dl.d_secsize; 186 } 187 188 #ifdef support_compression 189 if(ri->ramd_flag & RAMD_LCOMP) 190 error = decompress(cpy_uncompressed, rd_compressed, &rs); 191 else 192 #endif /* support_compression */ 193 error = ramd_norm_read(&rs); 194 195 bdp->d_close(ld_dev,FREAD | FNONBLOCK, 0, proc); 196 return(error); 197 } 198 199 static int 200 ramd_norm_read(rsp) 201 struct read_info *rsp; 202 { 203 long bytes_left; 204 int done, error; 205 struct buf *bp; 206 int s; 207 int dotc = 0; 208 209 bytes_left = rsp->nbytes; 210 bp = rsp->bp; 211 error = 0; 212 213 while(bytes_left > 0) { 214 s = splbio(); 215 bp->b_flags = B_BUSY | B_PHYS | B_READ; 216 splx(s); 217 bp->b_blkno = btodb(rsp->offset); 218 bp->b_bcount = rsp->chunk; 219 bp->b_data = rsp->bufp; 220 221 /* Initiate read */ 222 (*rsp->strat)(bp); 223 224 /* Wait for results */ 225 s = splbio(); 226 while ((bp->b_flags & B_DONE) == 0) 227 tsleep((caddr_t) bp, PRIBIO + 1, "ramd_norm_read", 0); 228 if (bp->b_flags & B_ERROR) 229 error = (bp->b_error ? bp->b_error : EIO); 230 splx(s); 231 232 /* Dot counter */ 233 printf("."); 234 if(!(++dotc % 40)) 235 printf("\n"); 236 237 done = bp->b_bcount - bp->b_resid; 238 bytes_left -= done; 239 rsp->offset += done; 240 rsp->bufp += done; 241 242 if(error || !done) 243 break; 244 245 if((rsp->offset == rsp->media_sz) && (bytes_left != 0)) { 246 printf("\nInsert next media and hit any key..."); 247 cngetc(); 248 printf("\n"); 249 rsp->offset = 0; 250 } 251 } 252 printf("\n"); 253 return(error); 254 } 255 256 #ifdef support_compression 257 /* 258 * Functions supporting uncompression: 259 */ 260 /* 261 * Copy from the uncompression buffer to the ramdisk 262 */ 263 static int 264 cpy_uncompressed(buf, nbyte, rsp) 265 caddr_t buf; 266 struct read_info *rsp; 267 int nbyte; 268 { 269 if((rsp->bufp + nbyte) >= rsp->ebufp) 270 return(0); 271 bcopy(buf, rsp->bufp, nbyte); 272 rsp->bufp += nbyte; 273 return(0); 274 } 275 276 /* 277 * Read a maximum of 'nbyte' bytes into 'buf'. 278 */ 279 static int 280 rd_compressed(buf, nbyte, rsp) 281 caddr_t buf; 282 struct read_info *rsp; 283 int nbyte; 284 { 285 static int dotc = 0; 286 struct buf *bp; 287 int nread = 0; 288 int s; 289 int done, error; 290 291 292 error = 0; 293 bp = rsp->bp; 294 nbyte &= ~(DEV_BSIZE - 1); 295 296 while(nbyte > 0) { 297 s = splbio(); 298 bp->b_flags = B_BUSY | B_PHYS | B_READ; 299 splx(s); 300 bp->b_blkno = btodb(rsp->offset); 301 bp->b_bcount = min(rsp->chunk, nbyte); 302 bp->b_data = buf; 303 304 /* Initiate read */ 305 (*rsp->strat)(bp); 306 307 /* Wait for results */ 308 s = splbio(); 309 while ((bp->b_flags & B_DONE) == 0) 310 tsleep((caddr_t) bp, PRIBIO + 1, "ramd_norm_read", 0); 311 if (bp->b_flags & B_ERROR) 312 error = (bp->b_error ? bp->b_error : EIO); 313 splx(s); 314 315 /* Dot counter */ 316 printf("."); 317 if(!(++dotc % 40)) 318 printf("\n"); 319 320 done = bp->b_bcount - bp->b_resid; 321 nbyte -= done; 322 nread += done; 323 rsp->offset += done; 324 325 if(error || !done) 326 break; 327 328 if((rsp->offset == rsp->media_sz) && (nbyte != 0)) { 329 if(rsp->offset == rsp->media_sz) { 330 printf("\nInsert next media and hit any key..."); 331 if(cngetc() != '\n') 332 printf("\n"); 333 rsp->offset = 0; 334 } 335 } 336 s = splbio(); 337 splx(s); 338 return(nread); 339 } 340 #endif /* support_compression */ 341
Indexes created Wed Sep 24 05:09:52 GMT 2025