1 /* hp.c 4.35 81/04/02 */ 2 int hpdebug; 3 4 #include "hp.h" 5 #if NHP > 0 6 /* 7 * HP disk driver for RP0x+RM0x 8 * 9 * TODO: 10 * check RM80 skip sector handling, esp when ECC's occur later 11 * check offset recovery handling 12 */ 13 14 #include "../h/param.h" 15 #include "../h/systm.h" 16 #include "../h/dk.h" 17 #include "../h/buf.h" 18 #include "../h/conf.h" 19 #include "../h/dir.h" 20 #include "../h/user.h" 21 #include "../h/map.h" 22 #include "../h/pte.h" 23 #include "../h/mbareg.h" 24 #include "../h/mbavar.h" 25 #include "../h/mtpr.h" 26 #include "../h/vm.h" 27 #include "../h/cmap.h" 28 29 #include "../h/hpreg.h" 30 31 /* THIS SHOULD BE READ OFF THE PACK, PER DRIVE */ 32 struct size { 33 daddr_t nblocks; 34 int cyloff; 35 } hp_sizes[8] = { 36 15884, 0, /* A=cyl 0 thru 37 */ 37 33440, 38, /* B=cyl 38 thru 117 */ 38 340670, 0, /* C=cyl 0 thru 814 */ 39 0, 0, 40 0, 0, 41 0, 0, 42 291346, 118, /* G=cyl 118 thru 814 */ 43 0, 0, 44 }, rm_sizes[8] = { 45 15884, 0, /* A=cyl 0 thru 99 */ 46 33440, 100, /* B=cyl 100 thru 309 */ 47 131680, 0, /* C=cyl 0 thru 822 */ 48 0, 0, 49 0, 0, 50 0, 0, 51 82080, 310, /* G=cyl 310 thru 822 */ 52 0, 0, 53 }, rm5_sizes[8] = { 54 15884, 0, /* A=cyl 0 thru 26 */ 55 33440, 27, /* B=cyl 27 thru 81 */ 56 500384, 0, /* C=cyl 0 thru 822 */ 57 15884, 562, /* D=cyl 562 thru 588 */ 58 55936, 589, /* E=cyl 589 thru 680 */ 59 86636, 681, /* F=cyl 681 thru 822 */ 60 158688, 562, /* G=cyl 562 thru 822 */ 61 291346, 82, /* H=cyl 82 thru 561 */ 62 }, rm80_sizes[8] = { 63 15884, 0, /* A=cyl 0 thru 36 */ 64 33440, 37, /* B=cyl 37 thru 114 */ 65 242606, 0, /* C=cyl 0 thru 558 */ 66 0, 0, 67 0, 0, 68 0, 0, 69 82080, 115, /* G=cyl 115 thru 304 */ 70 110236, 305, /* H=cyl 305 thru 558 */ 71 }; 72 /* END OF STUFF WHICH SHOULD BE READ IN PER DISK */ 73 74 #define _hpSDIST 2 75 #define _hpRDIST 3 76 77 int hpSDIST = _hpSDIST; 78 int hpRDIST = _hpRDIST; 79 80 short hptypes[] = 81 { MBDT_RM03, MBDT_RM05, MBDT_RP06, MBDT_RM80, 0 }; 82 struct mba_device *hpinfo[NHP]; 83 int hpattach(),hpustart(),hpstart(),hpdtint(); 84 struct mba_driver hpdriver = 85 { hpattach, 0, hpustart, hpstart, hpdtint, 0, 86 hptypes, "hp", 0, hpinfo }; 87 88 struct hpst { 89 short nsect; 90 short ntrak; 91 short nspc; 92 short ncyl; 93 struct size *sizes; 94 } hpst[] = { 95 32, 5, 32*5, 823, rm_sizes, /* RM03 */ 96 32, 19, 32*19, 823, rm5_sizes, /* RM05 */ 97 22, 19, 22*19, 815, hp_sizes, /* RP06 */ 98 31, 14, 31*14, 559, rm80_sizes /* RM80 */ 99 }; 100 101 u_char hp_offset[16] = { 102 HPOF_P400, HPOF_M400, HPOF_P400, HPOF_M400, 103 HPOF_P800, HPOF_M800, HPOF_P800, HPOF_M800, 104 HPOF_P1200, HPOF_M1200, HPOF_P1200, HPOF_M1200, 105 0, 0, 0, 0, 106 }; 107 108 struct buf rhpbuf[NHP]; 109 char hprecal[NHP]; 110 111 #define b_cylin b_resid 112 113 #ifdef INTRLVE 114 daddr_t dkblock(); 115 #endif 116 117 int hpseek; 118 119 /*ARGSUSED*/ 120 hpattach(mi, slave) 121 struct mba_device *mi; 122 { 123 register struct hpst *st = &hpst[mi->mi_type]; 124 125 if (mi->mi_dk >= 0) 126 dk_mspw[mi->mi_dk] = 1.0 / 60 / (st->nsect * 256); 127 } 128 129 hpstrategy(bp) 130 register struct buf *bp; 131 { 132 register struct mba_device *mi; 133 register struct hpst *st; 134 register int unit; 135 long sz, bn; 136 int xunit = minor(bp->b_dev) & 07; 137 138 sz = bp->b_bcount; 139 sz = (sz+511) >> 9; 140 unit = dkunit(bp); 141 if (unit >= NHP) 142 goto bad; 143 mi = hpinfo[unit]; 144 if (mi == 0 || mi->mi_alive == 0) 145 goto bad; 146 st = &hpst[mi->mi_type]; 147 if (bp->b_blkno < 0 || 148 (bn = dkblock(bp))+sz > st->sizes[xunit].nblocks) 149 goto bad; 150 bp->b_cylin = bn/st->nspc + st->sizes[xunit].cyloff; 151 (void) spl5(); 152 disksort(&mi->mi_tab, bp); 153 if (mi->mi_tab.b_active == 0) 154 mbustart(mi); 155 (void) spl0(); 156 return; 157 158 bad: 159 bp->b_flags |= B_ERROR; 160 iodone(bp); 161 return; 162 } 163 164 hpustart(mi) 165 register struct mba_device *mi; 166 { 167 register struct hpdevice *hpaddr = (struct hpdevice *)mi->mi_drv; 168 register struct buf *bp = mi->mi_tab.b_actf; 169 register struct hpst *st; 170 daddr_t bn; 171 int sn, dist; 172 173 if ((hpaddr->hpcs1&HP_DVA) == 0) 174 return (MBU_BUSY); 175 if ((hpaddr->hpds & HPDS_VV) == 0) { 176 hpaddr->hpcs1 = HP_DCLR|HP_GO; 177 if (mi->mi_mba->mba_drv[0].mbd_as & (1<<mi->mi_drive)) 178 printf("DCLR attn\n"); 179 hpaddr->hpcs1 = HP_PRESET|HP_GO; 180 hpaddr->hpof = HPOF_FMT22; 181 mbclrattn(mi); 182 } 183 if (mi->mi_tab.b_active || mi->mi_hd->mh_ndrive == 1) 184 return (MBU_DODATA); 185 if ((hpaddr->hpds & HPDS_DREADY) != HPDS_DREADY) 186 return (MBU_DODATA); 187 st = &hpst[mi->mi_type]; 188 bn = dkblock(bp); 189 sn = bn%st->nspc; 190 sn = (sn+st->nsect-hpSDIST)%st->nsect; 191 if (bp->b_cylin == (hpaddr->hpdc & 0xffff)) { 192 if (hpseek) 193 return (MBU_DODATA); 194 dist = ((hpaddr->hpla & 0xffff)>>6) - st->nsect + 1; 195 if (dist < 0) 196 dist += st->nsect; 197 if (dist > st->nsect - hpRDIST) 198 return (MBU_DODATA); 199 } else 200 hpaddr->hpdc = bp->b_cylin; 201 if (hpseek) 202 hpaddr->hpcs1 = HP_SEEK|HP_GO; 203 else { 204 hpaddr->hpda = sn; 205 hpaddr->hpcs1 = HP_SEARCH|HP_GO; 206 } 207 return (MBU_STARTED); 208 } 209 210 hpstart(mi) 211 register struct mba_device *mi; 212 { 213 register struct hpdevice *hpaddr = (struct hpdevice *)mi->mi_drv; 214 register struct buf *bp = mi->mi_tab.b_actf; 215 register struct hpst *st = &hpst[mi->mi_type]; 216 daddr_t bn; 217 int sn, tn; 218 219 bn = dkblock(bp); 220 sn = bn%st->nspc; 221 tn = sn/st->nsect; 222 sn %= st->nsect; 223 hpaddr->hpdc = bp->b_cylin; 224 hpaddr->hpda = (tn << 8) + sn; 225 } 226 227 hpdtint(mi, mbsr) 228 register struct mba_device *mi; 229 int mbsr; 230 { 231 register struct hpdevice *hpaddr = (struct hpdevice *)mi->mi_drv; 232 register struct buf *bp = mi->mi_tab.b_actf; 233 int retry = 0; 234 235 if (hpaddr->hpds&HPDS_ERR || mbsr&MBSR_EBITS) { 236 if (hpdebug) { 237 printf("errcnt %d ", mi->mi_tab.b_errcnt); 238 printf("mbsr=%b ", mbsr, mbsr_bits); 239 printf("er1=%b er2=%b\n", 240 hpaddr->hper1, HPER1_BITS, 241 hpaddr->hper2, HPER2_BITS); 242 DELAY(1000000); 243 } 244 if (hpaddr->hper1&HPER1_WLE) { 245 printf("hp%d: write locked\n", dkunit(bp)); 246 bp->b_flags |= B_ERROR; 247 } else if (++mi->mi_tab.b_errcnt > 27 || 248 mbsr & MBSR_HARD || 249 hpaddr->hper1 & HPER1_HARD || 250 hpaddr->hper2 & HPER2_HARD) { 251 harderr(bp, "hp"); 252 if (mbsr & (MBSR_EBITS &~ (MBSR_DTABT|MBSR_MBEXC))) 253 printf("mbsr=%b ", mbsr, mbsr_bits); 254 printf("er1=%b er2=%b\n", 255 hpaddr->hper1, HPER1_BITS, 256 hpaddr->hper2, HPER2_BITS); 257 bp->b_flags |= B_ERROR; 258 hprecal[mi->mi_unit] = 0; 259 } else if (hptypes[mi->mi_type] == MBDT_RM80 && hpaddr->hper2&HPER2_SSE) { 260 hpecc(mi, 1); 261 return (MBD_RESTARTED); 262 } else if ((hpaddr->hper1&(HPER1_DCK|HPER1_ECH))==HPER1_DCK) { 263 if (hpecc(mi, 0)) 264 return (MBD_RESTARTED); 265 /* else done */ 266 } else 267 retry = 1; 268 hpaddr->hpcs1 = HP_DCLR|HP_GO; 269 if ((mi->mi_tab.b_errcnt&07) == 4) { 270 hpaddr->hpcs1 = HP_RECAL|HP_GO; 271 hprecal[mi->mi_unit] = 0; 272 goto nextrecal; 273 } 274 if (retry) 275 return (MBD_RETRY); 276 } 277 else 278 if (hpdebug && hprecal[mi->mi_unit]) { 279 printf("recal %d ", hprecal[mi->mi_unit]); 280 printf("errcnt %d\n", mi->mi_tab.b_errcnt); 281 printf("mbsr=%b ", mbsr, mbsr_bits); 282 printf("er1=%b er2=%b\n", 283 hpaddr->hper1, HPER1_BITS, 284 hpaddr->hper2, HPER2_BITS); 285 } 286 switch (hprecal[mi->mi_unit]) { 287 288 case 1: 289 hpaddr->hpdc = bp->b_cylin; 290 hpaddr->hpcs1 = HP_SEEK|HP_GO; 291 goto nextrecal; 292 case 2: 293 if (mi->mi_tab.b_errcnt < 16 || 294 (bp->b_flags & B_READ) == 0) 295 goto donerecal; 296 hpaddr->hpof = hp_offset[mi->mi_tab.b_errcnt & 017]|HPOF_FMT22; 297 hpaddr->hpcs1 = HP_OFFSET|HP_GO; 298 goto nextrecal; 299 nextrecal: 300 hprecal[mi->mi_unit]++; 301 return (MBD_RESTARTED); 302 donerecal: 303 case 3: 304 hprecal[mi->mi_unit] = 0; 305 return (MBD_RETRY); 306 } 307 bp->b_resid = -(mi->mi_mba->mba_bcr) & 0xffff; 308 if (mi->mi_tab.b_errcnt > 16) { 309 /* 310 * This is fast and occurs rarely; we don't 311 * bother with interrupts. 312 */ 313 hpaddr->hpcs1 = HP_RTC|HP_GO; 314 while (hpaddr->hpds & HPDS_PIP) 315 ; 316 mbclrattn(mi); 317 } 318 hpaddr->hpcs1 = HP_RELEASE|HP_GO; 319 hpaddr->hpof = HPOF_FMT22; 320 if (mi->mi_mba->mba_drv[0].mbd_as & (1<<mi->mi_drive)) 321 printf("REL attn\n"); 322 mbclrattn(mi); 323 return (MBD_DONE); 324 } 325 326 hpread(dev) 327 dev_t dev; 328 { 329 register int unit = minor(dev) >> 3; 330 331 if (unit >= NHP) 332 u.u_error = ENXIO; 333 else 334 physio(hpstrategy, &rhpbuf[unit], dev, B_READ, minphys); 335 } 336 337 hpwrite(dev) 338 dev_t dev; 339 { 340 register int unit = minor(dev) >> 3; 341 342 if (unit >= NHP) 343 u.u_error = ENXIO; 344 else 345 physio(hpstrategy, &rhpbuf[unit], dev, B_WRITE, minphys); 346 } 347 348 /*ARGSUSED*/ 349 hpecc(mi, rm80sse) 350 register struct mba_device *mi; 351 int rm80sse; 352 { 353 register struct mba_regs *mbp = mi->mi_mba; 354 register struct hpdevice *rp = (struct hpdevice *)mi->mi_drv; 355 register struct buf *bp = mi->mi_tab.b_actf; 356 register struct hpst *st; 357 register int i; 358 caddr_t addr; 359 int reg, bit, byte, npf, mask, o; 360 int bn, cn, tn, sn; 361 struct pte mpte; 362 int bcr; 363 364 bcr = mbp->mba_bcr & 0xffff; 365 if (bcr) 366 bcr |= 0xffff0000; /* sxt */ 367 npf = btop(bcr + bp->b_bcount) - 1; 368 reg = npf; 369 if (rm80sse) { 370 rp->hpof |= HPOF_SSEI; 371 reg--; /* compensate in advance for reg+1 below */ 372 goto sse; 373 } 374 o = (int)bp->b_un.b_addr & PGOFSET; 375 printf("hp%d%c: soft ecc sn%d\n", dkunit(bp), 376 'a'+(minor(bp->b_dev)&07), bp->b_blkno + npf); 377 mask = rp->hpec2&0xffff; 378 i = (rp->hpec1&0xffff) - 1; /* -1 makes 0 origin */ 379 bit = i&07; 380 i = (i&~07)>>3; 381 byte = i + o; 382 while (i < 512 && (int)ptob(npf)+i < bp->b_bcount && bit > -11) { 383 mpte = mbp->mba_map[reg+btop(byte)]; 384 addr = ptob(mpte.pg_pfnum) + (byte & PGOFSET); 385 putmemc(addr, getmemc(addr)^(mask<<bit)); 386 byte++; 387 i++; 388 bit -= 8; 389 } 390 if (bcr == 0) 391 return (0); 392 #ifdef notdef 393 sse: 394 if (rpof&HPOF_SSEI) 395 rp->hpda = rp->hpda + 1; 396 rp->hper1 = 0; 397 rp->hpcs1 = HP_RCOM|HP_GO; 398 #else 399 sse: 400 rp->hpcs1 = HP_DCLR|HP_GO; 401 bn = dkblock(bp); 402 st = &hpst[mi->mi_type]; 403 cn = bp->b_cylin; 404 sn = bn%(st->nspc) + npf + 1; 405 tn = sn/st->nsect; 406 sn %= st->nsect; 407 cn += tn/st->ntrak; 408 tn %= st->ntrak; 409 if (rp->hpof&HPOF_SSEI) 410 sn++; 411 rp->hpdc = cn; 412 rp->hpda = (tn<<8) + sn; 413 mbp->mba_sr = -1; 414 mbp->mba_var = (int)ptob(reg+1) + o; 415 rp->hpcs1 = HP_RCOM|HP_GO; 416 #endif 417 return (1); 418 } 419 420 #define DBSIZE 20 421 422 hpdump(dev) 423 dev_t dev; 424 { 425 register struct mba_device *mi; 426 register struct mba_regs *mba; 427 struct hpdevice *hpaddr; 428 char *start; 429 int num, unit; 430 register struct hpst *st; 431 432 num = maxfree; 433 start = 0; 434 unit = minor(dev) >> 3; 435 if (unit >= NHP) 436 return (ENXIO); 437 #define phys(a,b) ((b)((int)(a)&0x7fffffff)) 438 mi = phys(hpinfo[unit],struct mba_device *); 439 if (mi == 0 || mi->mi_alive == 0) 440 return (ENXIO); 441 mba = phys(mi->mi_hd, struct mba_hd *)->mh_physmba; 442 mba->mba_cr = MBCR_INIT; 443 hpaddr = (struct hpdevice *)&mba->mba_drv[mi->mi_drive]; 444 if ((hpaddr->hpds & HPDS_VV) == 0) { 445 hpaddr->hpcs1 = HP_DCLR|HP_GO; 446 hpaddr->hpcs1 = HP_PRESET|HP_GO; 447 hpaddr->hpof = HPOF_FMT22; 448 } 449 st = &hpst[mi->mi_type]; 450 if (dumplo < 0 || dumplo + num >= st->sizes[minor(dev)&07].nblocks) 451 return (EINVAL); 452 while (num > 0) { 453 register struct pte *hpte = mba->mba_map; 454 register int i; 455 int blk, cn, sn, tn; 456 daddr_t bn; 457 458 blk = num > DBSIZE ? DBSIZE : num; 459 bn = dumplo + btop(start); 460 cn = bn/st->nspc + st->sizes[minor(dev)&07].cyloff; 461 sn = bn%st->nspc; 462 tn = sn/st->nsect; 463 sn = sn%st->nsect; 464 hpaddr->hpdc = cn; 465 hpaddr->hpda = (tn << 8) + sn; 466 for (i = 0; i < blk; i++) 467 *(int *)hpte++ = (btop(start)+i) | PG_V; 468 mba->mba_sr = -1; 469 mba->mba_bcr = -(blk*NBPG); 470 mba->mba_var = 0; 471 hpaddr->hpcs1 = HP_WCOM | HP_GO; 472 while ((hpaddr->hpds & HPDS_DRY) == 0) 473 ; 474 if (hpaddr->hpds&HPDS_ERR) 475 return (EIO); 476 start += blk*NBPG; 477 num -= blk; 478 } 479 return (0); 480 } 481 #endif 482