| 1 | /* hp.c 4.14 81/02/25 */ |
| 2 | |
| 3 | #include "hp.h" |
| 4 | #if NHP > 0 |
| 5 | /* |
| 6 | * HP disk driver for RP0x+RM0x |
| 7 | */ |
| 8 | |
| 9 | #include "../h/param.h" |
| 10 | #include "../h/systm.h" |
| 11 | #include "../h/dk.h" |
| 12 | #include "../h/buf.h" |
| 13 | #include "../h/conf.h" |
| 14 | #include "../h/dir.h" |
| 15 | #include "../h/user.h" |
| 16 | #include "../h/map.h" |
| 17 | #include "../h/pte.h" |
| 18 | #include "../h/mba.h" |
| 19 | #include "../h/mtpr.h" |
| 20 | #include "../h/vm.h" |
| 21 | #include "../h/cmap.h" |
| 22 | |
| 23 | #include "../h/hpreg.h" |
| 24 | |
| 25 | /* THIS SHOULD BE READ OFF THE PACK, PER DRIVE */ |
| 26 | struct size { |
| 27 | daddr_t nblocks; |
| 28 | int cyloff; |
| 29 | } hp_sizes[8] = { |
| 30 | 15884, 0, /* A=cyl 0 thru 37 */ |
| 31 | 33440, 38, /* B=cyl 38 thru 117 */ |
| 32 | 340670, 0, /* C=cyl 0 thru 814 */ |
| 33 | 0, 0, |
| 34 | 0, 0, |
| 35 | 0, 0, |
| 36 | 291346, 118, /* G=cyl 118 thru 814 */ |
| 37 | 0, 0, |
| 38 | }, rm_sizes[8] = { |
| 39 | 15884, 0, /* A=cyl 0 thru 99 */ |
| 40 | 33440, 100, /* B=cyl 100 thru 309 */ |
| 41 | 131680, 0, /* C=cyl 0 thru 822 */ |
| 42 | 2720, 291, |
| 43 | 0, 0, |
| 44 | 0, 0, |
| 45 | 82080, 310, /* G=cyl 310 thru 822 */ |
| 46 | 0, 0, |
| 47 | }, rm5_sizes[8] = { |
| 48 | 15884, 0, /* A=cyl 0 thru 26 */ |
| 49 | 33440, 27, /* B=cyl 27 thru 81 */ |
| 50 | 500992, 0, /* C=cyl 0 thru 823 */ |
| 51 | 15884, 562, /* D=cyl 562 thru 588 */ |
| 52 | 55936, 589, /* E=cyl 589 thru 680 */ |
| 53 | 86944, 681, /* F=cyl 681 thru 823 */ |
| 54 | 159296, 562, /* G=cyl 562 thru 823 */ |
| 55 | 291346, 82, /* H=cyl 82 thru 561 */ |
| 56 | }, rm80_sizes[8] = { |
| 57 | 15884, 0, /* A=cyl 0 thru 36 */ |
| 58 | 33440, 37, /* B=cyl 37 thru 114 */ |
| 59 | 242606, 0, /* C=cyl 0 thru 558 */ |
| 60 | 0, 0, |
| 61 | 0, 0, |
| 62 | 0, 0, |
| 63 | 82080, 115, /* G=cyl 115 thru 304 */ |
| 64 | 110236, 305, /* H=cyl 305 thru 558 */ |
| 65 | }; |
| 66 | /* END OF STUFF WHICH SHOULD BE READ IN PER DISK */ |
| 67 | |
| 68 | #define _hpSDIST 2 |
| 69 | #define _hpRDIST 3 |
| 70 | |
| 71 | int hpSDIST = _hpSDIST; |
| 72 | int hpRDIST = _hpRDIST; |
| 73 | |
| 74 | short hptypes[] = |
| 75 | { MBDT_RM03, MBDT_RM05, MBDT_RP06, MBDT_RM80, 0 }; |
| 76 | struct mba_info *hpinfo[NHP]; |
| 77 | int hpdkinit(),hpustart(),hpstart(),hpdtint(); |
| 78 | struct mba_driver hpdriver = |
| 79 | { hpdkinit, hpustart, hpstart, hpdtint, 0, hptypes, hpinfo }; |
| 80 | |
| 81 | struct hpst { |
| 82 | short nsect; |
| 83 | short ntrak; |
| 84 | short nspc; |
| 85 | short ncyl; |
| 86 | struct size *sizes; |
| 87 | } hpst[] = { |
| 88 | 32, 5, 32*5, 823, rm_sizes, /* RM03 */ |
| 89 | 32, 19, 32*19, 823, rm5_sizes, /* RM05 */ |
| 90 | 22, 19, 22*19, 815, hp_sizes, /* RP06 */ |
| 91 | 31, 14, 31*14, 559, rm80_sizes /* RM80 */ |
| 92 | }; |
| 93 | |
| 94 | u_char hp_offset[16] = { |
| 95 | HP_P400, HP_M400, HP_P400, HP_M400, HP_P800, HP_M800, HP_P800, HP_M800, |
| 96 | HP_P1200, HP_M1200, HP_P1200, HP_M1200, 0, 0, 0, 0, |
| 97 | }; |
| 98 | |
| 99 | struct buf rhpbuf[NHP]; |
| 100 | |
| 101 | #define b_cylin b_resid |
| 102 | |
| 103 | #ifdef INTRLVE |
| 104 | daddr_t dkblock(); |
| 105 | #endif |
| 106 | |
| 107 | int hpseek; |
| 108 | |
| 109 | hpdkinit(mi) |
| 110 | struct mba_info *mi; |
| 111 | { |
| 112 | register struct hpst *st = &hpst[mi->mi_type]; |
| 113 | |
| 114 | if (mi->mi_dk >= 0) |
| 115 | dk_mspw[mi->mi_dk] = 1.0 / HZ / (st->nsect * 256); |
| 116 | } |
| 117 | |
| 118 | hpstrategy(bp) |
| 119 | register struct buf *bp; |
| 120 | { |
| 121 | register struct mba_info *mi; |
| 122 | register struct hpst *st; |
| 123 | register int unit; |
| 124 | long sz, bn; |
| 125 | int xunit = minor(bp->b_dev) & 07; |
| 126 | |
| 127 | sz = bp->b_bcount; |
| 128 | sz = (sz+511) >> 9; |
| 129 | unit = dkunit(bp); |
| 130 | if (unit >= NHP) |
| 131 | goto bad; |
| 132 | mi = hpinfo[unit]; |
| 133 | if (mi == 0 || mi->mi_alive == 0) |
| 134 | goto bad; |
| 135 | st = &hpst[mi->mi_type]; |
| 136 | if (bp->b_blkno < 0 || |
| 137 | (bn = dkblock(bp))+sz > st->sizes[xunit].nblocks) |
| 138 | goto bad; |
| 139 | bp->b_cylin = bn/st->nspc + st->sizes[xunit].cyloff; |
| 140 | (void) spl5(); |
| 141 | disksort(&mi->mi_tab, bp); |
| 142 | if (mi->mi_tab.b_active == 0) |
| 143 | mbustart(mi); |
| 144 | (void) spl0(); |
| 145 | return; |
| 146 | |
| 147 | bad: |
| 148 | bp->b_flags |= B_ERROR; |
| 149 | iodone(bp); |
| 150 | return; |
| 151 | } |
| 152 | |
| 153 | hpustart(mi) |
| 154 | register struct mba_info *mi; |
| 155 | { |
| 156 | register struct hpdevice *hpaddr = (struct hpdevice *)mi->mi_drv; |
| 157 | register struct buf *bp = mi->mi_tab.b_actf; |
| 158 | register struct hpst *st; |
| 159 | daddr_t bn; |
| 160 | int sn, dist, flags; |
| 161 | |
| 162 | if ((hpaddr->hpcs1&HP_DVA) == 0) |
| 163 | return (MBU_BUSY); |
| 164 | if ((hpaddr->hpds & HP_VV) == 0) { |
| 165 | hpaddr->hpcs1 = HP_DCLR|HP_GO; |
| 166 | hpaddr->hpcs1 = HP_PRESET|HP_GO; |
| 167 | hpaddr->hpof = HP_FMT22; |
| 168 | } |
| 169 | if (mi->mi_tab.b_active || mi->mi_hd->mh_ndrive == 1) |
| 170 | return (MBU_DODATA); |
| 171 | if ((hpaddr->hpds & (HP_DPR|HP_MOL)) != (HP_DPR|HP_MOL)) |
| 172 | return (MBU_DODATA); |
| 173 | st = &hpst[mi->mi_type]; |
| 174 | bn = dkblock(bp); |
| 175 | sn = bn%st->nspc; |
| 176 | sn = (sn+st->nsect-hpSDIST)%st->nsect; |
| 177 | if (bp->b_cylin == (hpaddr->hpdc & 0xffff)) { |
| 178 | if (hpseek) |
| 179 | return (MBU_DODATA); |
| 180 | dist = ((hpaddr->hpla & 0xffff)>>6) - st->nsect + 1; |
| 181 | if (dist < 0) |
| 182 | dist += st->nsect; |
| 183 | if (dist > st->nsect - hpRDIST) |
| 184 | return (MBU_DODATA); |
| 185 | } else |
| 186 | hpaddr->hpdc = bp->b_cylin; |
| 187 | if (hpseek) |
| 188 | hpaddr->hpcs1 = HP_SEEK|HP_GO; |
| 189 | else { |
| 190 | hpaddr->hpda = sn; |
| 191 | hpaddr->hpcs1 = HP_SEARCH|HP_GO; |
| 192 | } |
| 193 | return (MBU_STARTED); |
| 194 | } |
| 195 | |
| 196 | hpstart(mi) |
| 197 | register struct mba_info *mi; |
| 198 | { |
| 199 | register struct hpdevice *hpaddr = (struct hpdevice *)mi->mi_drv; |
| 200 | register struct buf *bp = mi->mi_tab.b_actf; |
| 201 | register struct hpst *st = &hpst[mi->mi_type]; |
| 202 | daddr_t bn; |
| 203 | int sn, tn; |
| 204 | |
| 205 | bn = dkblock(bp); |
| 206 | sn = bn%st->nspc; |
| 207 | tn = sn/st->nsect; |
| 208 | sn %= st->nsect; |
| 209 | if (mi->mi_tab.b_errcnt >= 16 && (bp->b_flags&B_READ) != 0) { |
| 210 | hpaddr->hpof = hp_offset[mi->mi_tab.b_errcnt & 017] | HP_FMT22; |
| 211 | hpaddr->hpcs1 = HP_OFFSET|HP_GO; |
| 212 | while (hpaddr->hpds & HP_PIP) |
| 213 | ; |
| 214 | mbclrattn(mi); |
| 215 | } |
| 216 | hpaddr->hpdc = bp->b_cylin; |
| 217 | hpaddr->hpda = (tn << 8) + sn; |
| 218 | } |
| 219 | |
| 220 | hpdtint(mi, mbasr) |
| 221 | register struct mba_info *mi; |
| 222 | int mbasr; |
| 223 | { |
| 224 | register struct hpdevice *hpaddr = (struct hpdevice *)mi->mi_drv; |
| 225 | register struct buf *bp = mi->mi_tab.b_actf; |
| 226 | |
| 227 | while ((hpaddr->hpds & HP_DRY) == 0) /* shouldn't happen */ |
| 228 | printf("hp dry not set\n"); |
| 229 | if (hpaddr->hpds & HP_ERR || mbasr & MBAEBITS) |
| 230 | if (++mi->mi_tab.b_errcnt < 28 && (hpaddr->hper1&HP_WLE) == 0) { |
| 231 | if ((hpaddr->hper1&0xffff) != HP_DCK) { |
| 232 | hpaddr->hpcs1 = HP_DCLR|HP_GO; |
| 233 | if ((mi->mi_tab.b_errcnt&07) == 4) { |
| 234 | hpaddr->hpcs1 = HP_RECAL|HP_GO; |
| 235 | while (hpaddr->hpds & HP_PIP) |
| 236 | ; |
| 237 | mbclrattn(mi); |
| 238 | } |
| 239 | return (MBD_RETRY); |
| 240 | } else if (hpecc(mi)) |
| 241 | return (MBD_RESTARTED); |
| 242 | } else { |
| 243 | if (hpaddr->hper1&HP_WLE) |
| 244 | printf("hp%d is write locked\n", dkunit(bp)); |
| 245 | else |
| 246 | harderr(bp); |
| 247 | printf("hp%d mbasr %b er1 %b er2 %b\n", |
| 248 | dkunit(bp), mbasr, mbasr_bits, |
| 249 | hpaddr->hper1, HPER1_BITS, |
| 250 | hpaddr->hper2, HPER2_BITS); |
| 251 | hpaddr->hpcs1 = HP_DCLR|HP_GO; |
| 252 | bp->b_flags |= B_ERROR; |
| 253 | } |
| 254 | bp->b_resid = -(mi->mi_mba->mba_bcr) & 0xffff; |
| 255 | if (mi->mi_tab.b_errcnt) { |
| 256 | hpaddr->hpcs1 = HP_RTC|HP_GO; |
| 257 | while (hpaddr->hpds & HP_PIP) |
| 258 | ; |
| 259 | mbclrattn(mi); |
| 260 | } |
| 261 | hpaddr->hpcs1 = HP_RELEASE|HP_GO; |
| 262 | return (MBD_DONE); |
| 263 | } |
| 264 | |
| 265 | hpread(dev) |
| 266 | dev_t dev; |
| 267 | { |
| 268 | register int unit = minor(dev) >> 3; |
| 269 | |
| 270 | if (unit >= NHP) |
| 271 | u.u_error = ENXIO; |
| 272 | else |
| 273 | physio(hpstrategy, &rhpbuf[unit], dev, B_READ, minphys); |
| 274 | } |
| 275 | |
| 276 | hpwrite(dev) |
| 277 | dev_t dev; |
| 278 | { |
| 279 | register int unit = minor(dev) >> 3; |
| 280 | |
| 281 | if (unit >= NHP) |
| 282 | u.u_error = ENXIO; |
| 283 | else |
| 284 | physio(hpstrategy, &rhpbuf[unit], dev, B_WRITE, minphys); |
| 285 | } |
| 286 | |
| 287 | hpecc(mi) |
| 288 | register struct mba_info *mi; |
| 289 | { |
| 290 | register struct mba_regs *mbp = mi->mi_mba; |
| 291 | register struct hpdevice *rp = (struct hpdevice *)mi->mi_drv; |
| 292 | register struct buf *bp = mi->mi_tab.b_actf; |
| 293 | register struct hpst *st; |
| 294 | register int i; |
| 295 | caddr_t addr; |
| 296 | int reg, bit, byte, npf, mask, o; |
| 297 | int bn, cn, tn, sn; |
| 298 | struct pte mpte; |
| 299 | int bcr; |
| 300 | |
| 301 | bcr = mbp->mba_bcr & 0xffff; |
| 302 | if (bcr) |
| 303 | bcr |= 0xffff0000; /* sxt */ |
| 304 | npf = btop(bcr + bp->b_bcount) - 1; |
| 305 | reg = npf; |
| 306 | o = (int)bp->b_un.b_addr & PGOFSET; |
| 307 | printf("%D ", bp->b_blkno + npf); |
| 308 | prdev("ECC", bp->b_dev); |
| 309 | mask = rp->hpec2&0xffff; |
| 310 | if (mask == 0) { |
| 311 | rp->hpof = HP_FMT22; |
| 312 | return (0); |
| 313 | } |
| 314 | |
| 315 | i = (rp->hpec1&0xffff) - 1; /* -1 makes 0 origin */ |
| 316 | bit = i&07; |
| 317 | i = (i&~07)>>3; |
| 318 | byte = i + o; |
| 319 | while (i < 512 && (int)ptob(npf)+i < bp->b_bcount && bit > -11) { |
| 320 | mpte = mbp->mba_map[reg+btop(byte)]; |
| 321 | addr = ptob(mpte.pg_pfnum) + (byte & PGOFSET); |
| 322 | putmemc(addr, getmemc(addr)^(mask<<bit)); |
| 323 | byte++; |
| 324 | i++; |
| 325 | bit -= 8; |
| 326 | } |
| 327 | mi->mi_hd->mh_active++; /* Either complete or continuing */ |
| 328 | if (bcr == 0) |
| 329 | return (0); |
| 330 | #ifdef notdef |
| 331 | rp->hper1 = 0; |
| 332 | rp->hpcs1 = HP_RCOM|HP_GO; |
| 333 | #else |
| 334 | rp->hpcs1 = HP_DCLR|HP_GO; |
| 335 | bn = dkblock(bp); |
| 336 | st = &hpst[mi->mi_type]; |
| 337 | cn = bp->b_cylin; |
| 338 | sn = bn%(st->nspc) + npf + 1; |
| 339 | tn = sn/st->nsect; |
| 340 | sn %= st->nsect; |
| 341 | cn += tn/st->ntrak; |
| 342 | tn %= st->ntrak; |
| 343 | rp->hpdc = cn; |
| 344 | rp->hpda = (tn<<8) + sn; |
| 345 | mbp->mba_sr = -1; |
| 346 | mbp->mba_var = (int)ptob(reg+1) + o; |
| 347 | rp->hpcs1 = HP_RCOM|HP_GO; |
| 348 | #endif |
| 349 | return (1); |
| 350 | } |
| 351 | |
| 352 | #define DBSIZE 20 |
| 353 | |
| 354 | hpdump(dev) |
| 355 | dev_t dev; |
| 356 | { |
| 357 | register struct mba_info *mi; |
| 358 | register struct mba_regs *mba; |
| 359 | struct hpdevice *hpaddr; |
| 360 | char *start; |
| 361 | int num, unit; |
| 362 | register struct hpst *st; |
| 363 | |
| 364 | num = maxfree; |
| 365 | start = 0; |
| 366 | unit = minor(dev) >> 3; |
| 367 | if (unit >= NHP) { |
| 368 | printf("bad unit\n"); |
| 369 | return (-1); |
| 370 | } |
| 371 | #define phys(a,b) ((b)((int)(a)&0x7fffffff)) |
| 372 | mi = phys(hpinfo[unit],struct mba_info *); |
| 373 | if (mi == 0 || mi->mi_alive == 0) { |
| 374 | printf("dna\n"); |
| 375 | return (-1); |
| 376 | } |
| 377 | mba = phys(mi->mi_hd, struct mba_hd *)->mh_physmba; |
| 378 | mba->mba_cr = MBAINIT; |
| 379 | hpaddr = (struct hpdevice *)&mba->mba_drv[mi->mi_drive]; |
| 380 | if ((hpaddr->hpds & HP_VV) == 0) { |
| 381 | hpaddr->hpcs1 = HP_DCLR|HP_GO; |
| 382 | hpaddr->hpcs1 = HP_PRESET|HP_GO; |
| 383 | hpaddr->hpof = HP_FMT22; |
| 384 | } |
| 385 | st = &hpst[mi->mi_type]; |
| 386 | if (dumplo < 0 || dumplo + num >= st->sizes[minor(dev)&07].nblocks) { |
| 387 | printf("oor\n"); |
| 388 | return (-1); |
| 389 | } |
| 390 | while (num > 0) { |
| 391 | register struct pte *hpte = mba->mba_map; |
| 392 | register int i; |
| 393 | int blk, cn, sn, tn; |
| 394 | daddr_t bn; |
| 395 | |
| 396 | blk = num > DBSIZE ? DBSIZE : num; |
| 397 | bn = dumplo + btop(start); |
| 398 | cn = bn/st->nspc + st->sizes[minor(dev)&07].cyloff; |
| 399 | sn = bn%st->nspc; |
| 400 | tn = sn/st->nsect; |
| 401 | sn = sn%st->nsect; |
| 402 | hpaddr->hpdc = cn; |
| 403 | hpaddr->hpda = (tn << 8) + sn; |
| 404 | for (i = 0; i < blk; i++) |
| 405 | *(int *)hpte++ = (btop(start)+i) | PG_V; |
| 406 | mba->mba_sr = -1; |
| 407 | mba->mba_bcr = -(blk*NBPG); |
| 408 | mba->mba_var = 0; |
| 409 | hpaddr->hpcs1 = HP_WCOM | HP_GO; |
| 410 | while ((hpaddr->hpds & HP_DRY) == 0) |
| 411 | ; |
| 412 | if (hpaddr->hpds&HP_ERR) { |
| 413 | printf("dskerr: (%d,%d,%d) ds=%x er=%x\n", |
| 414 | cn, tn, sn, hpaddr->hpds, hpaddr->hper1); |
| 415 | return (-1); |
| 416 | } |
| 417 | start += blk*NBPG; |
| 418 | num -= blk; |
| 419 | } |
| 420 | return (0); |
| 421 | } |
| 422 | #endif |