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