biosdisk_ll.c revision 1.16
1 /* $NetBSD: biosdisk_ll.c,v 1.16 2003/04/02 10:39:33 fvdl Exp $ */ 2 3 /* 4 * Copyright (c) 1996 5 * Matthias Drochner. All rights reserved. 6 * Copyright (c) 1996 7 * Perry E. Metzger. All rights reserved. 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer. 14 * 2. Redistributions in binary form must reproduce the above copyright 15 * notice, this list of conditions and the following disclaimer in the 16 * documentation and/or other materials provided with the distribution. 17 * 3. All advertising materials mentioning features or use of this software 18 * must display the following acknowledgements: 19 * This product includes software developed for the NetBSD Project 20 * by Matthias Drochner. 21 * This product includes software developed for the NetBSD Project 22 * by Perry E. Metzger. 23 * 4. The names of the authors may not be used to endorse or promote products 24 * derived from this software without specific prior written permission. 25 * 26 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 27 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 28 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 29 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 30 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 31 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 32 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 33 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 34 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 35 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 36 */ 37 38 /* 39 * shared by bootsector startup (bootsectmain) and biosdisk.c 40 * needs lowlevel parts from bios_disk.S 41 */ 42 43 #include <lib/libsa/stand.h> 44 45 #include "biosdisk_ll.h" 46 #include "diskbuf.h" 47 48 extern int get_diskinfo(int); 49 extern void int13_getextinfo(int, struct biosdisk_ext13info *); 50 extern int int13_extension(int); 51 extern int biosread(int, int, int, int, int, void *); 52 extern int biosdiskreset(int); 53 extern int biosextread(int, void *); 54 static int do_read(struct biosdisk_ll *, int64_t, int, char *); 55 extern u_int vtophys(void *); 56 57 /* 58 * we get from get_diskinfo(): 59 * xxxx %ch %cl %dh (registers after int13/8), ie 60 * xxxx cccc Csss hhhh 61 */ 62 #define SPT(di) (((di)>>8)&0x3f) 63 #define HEADS(di) (((di)&0xff)+1) 64 #define CYL(di) (((((di)>>16)&0xff)|(((di)>>6)&0x300))+1) 65 66 #ifndef BIOSDISK_RETRIES 67 #define BIOSDISK_RETRIES 5 68 #endif 69 70 int 71 set_geometry(struct biosdisk_ll *d, struct biosdisk_ext13info *ed) 72 { 73 int diskinfo; 74 char buf[512]; 75 76 diskinfo = get_diskinfo(d->dev); 77 d->sec = SPT(diskinfo); 78 d->head = HEADS(diskinfo); 79 d->cyl = CYL(diskinfo); 80 d->chs_sectors = d->sec * d->head * d->cyl; 81 82 d->flags = 0; 83 if ((d->dev & 0x80) && int13_extension(d->dev)) { 84 d->flags |= BIOSDISK_EXT13; 85 if (ed != NULL) 86 int13_getextinfo(d->dev, ed); 87 } 88 89 /* 90 * If the drive is 2.88 floppy drive, check that we can actually 91 * read sector >= 18. If not, assume 1.44 floppy disk. 92 */ 93 if (d->dev == 0 && SPT(diskinfo) == 36) { 94 if (biosread(d->dev, 0, 0, 18, 1, buf)) { 95 d->sec = 18; 96 d->chs_sectors /= 2; 97 } 98 } 99 100 /* 101 * get_diskinfo assumes floppy if BIOS call fails. Check at least 102 * "valid" geometry. 103 */ 104 return (!d->sec || !d->head); 105 } 106 107 /* 108 * Global shared "diskbuf" is used as read ahead buffer. For reading from 109 * floppies, the bootstrap has to be loaded on a 64K boundary to ensure that 110 * this buffer doesn't cross a 64K DMA boundary. 111 */ 112 #define RA_SECTORS (DISKBUFSIZE / BIOSDISK_SECSIZE) 113 static int ra_dev; 114 static int ra_end; 115 static int ra_first; 116 117 static int 118 do_read(struct biosdisk_ll *d, int64_t dblk, int num, char *buf) 119 { 120 int cyl, head, sec, nsec, spc, dblk32; 121 struct { 122 int8_t size; 123 int8_t resvd; 124 int16_t cnt; 125 int16_t off; 126 int16_t seg; 127 int64_t sec; 128 } ext; 129 130 if ((d->dev & 0x80) && (dblk + num) >= d->chs_sectors) { 131 if (!(d->flags & BIOSDISK_EXT13)) 132 return -1; 133 ext.size = sizeof(ext); 134 ext.resvd = 0; 135 ext.cnt = num; 136 /* seg:off of physical address */ 137 ext.off = (int)buf & 0xf; 138 ext.seg = vtophys(buf) >> 4; 139 ext.sec = dblk; 140 141 if (biosextread(d->dev, &ext)) { 142 (void)biosdiskreset(d->dev); 143 return -1; 144 } 145 146 return ext.cnt; 147 } else { 148 dblk32 = (int)dblk; 149 spc = d->head * d->sec; 150 cyl = dblk32 / spc; 151 head = (dblk32 % spc) / d->sec; 152 sec = dblk32 % d->sec; 153 nsec = d->sec - sec; 154 155 if (nsec > num) 156 nsec = num; 157 158 if (biosread(d->dev, cyl, head, sec, nsec, buf)) { 159 (void)biosdiskreset(d->dev); 160 return -1; 161 } 162 163 return nsec; 164 } 165 } 166 167 /* NB if 'cold' is set below not all of the program is loaded, so 168 * musn't use data segment, bss, call library functions or do 169 * read-ahead. 170 */ 171 172 int 173 readsects(struct biosdisk_ll *d, int64_t dblk, int num, char *buf, int cold) 174 { 175 while (num) { 176 int nsec; 177 178 /* check for usable data in read-ahead buffer */ 179 if (cold || diskbuf_user != &ra_dev || d->dev != ra_dev 180 || dblk < ra_first || dblk >= ra_end) { 181 182 /* no, read from disk */ 183 char *trbuf; 184 int maxsecs; 185 int retries = BIOSDISK_RETRIES; 186 187 if (cold) { 188 /* transfer directly to buffer */ 189 trbuf = buf; 190 maxsecs = num; 191 } else { 192 /* fill read-ahead buffer */ 193 trbuf = alloc_diskbuf(0); /* no data yet */ 194 maxsecs = RA_SECTORS; 195 } 196 197 while ((nsec = do_read(d, dblk, maxsecs, trbuf)) < 0) { 198 #ifdef DISK_DEBUG 199 if (!cold) 200 printf("read error dblk %d-%d\n", dblk, 201 dblk + maxsecs - 1); 202 #endif 203 if (--retries >= 0) 204 continue; 205 return (-1); /* XXX cannot output here if 206 * (cold) */ 207 } 208 if (!cold) { 209 ra_dev = d->dev; 210 ra_first = dblk; 211 ra_end = dblk + nsec; 212 diskbuf_user = &ra_dev; 213 } 214 } else /* can take blocks from end of read-ahead 215 * buffer */ 216 nsec = ra_end - dblk; 217 218 if (!cold) { 219 /* copy data from read-ahead to user buffer */ 220 if (nsec > num) 221 nsec = num; 222 memcpy(buf, 223 diskbufp + (dblk - ra_first) * BIOSDISK_SECSIZE, 224 nsec * BIOSDISK_SECSIZE); 225 } 226 buf += nsec * BIOSDISK_SECSIZE; 227 num -= nsec; 228 dblk += nsec; 229 } 230 231 return (0); 232 } 233
Indexes created Tue Sep 30 17:09:57 GMT 2025