wd.c revision 1.163
1 /* $NetBSD: wd.c,v 1.163 1997/08/27 11:25:14 bouyer Exp $ */ 2 3 /* 4 * Copyright (c) 1994, 1995 Charles M. Hannum. All rights reserved. 5 * 6 * DMA and multi-sector PIO handling are derived from code contributed by 7 * Onno van der Linden. 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 acknowledgement: 19 * This product includes software developed by Charles M. Hannum. 20 * 4. The name of the author may not be used to endorse or promote products 21 * derived from this software without specific prior written permission. 22 * 23 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 24 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 25 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 26 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 27 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 28 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 29 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 30 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 31 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 32 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 33 */ 34 35 #include <sys/param.h> 36 #include <sys/systm.h> 37 #include <sys/kernel.h> 38 #include <sys/conf.h> 39 #include <sys/file.h> 40 #include <sys/stat.h> 41 #include <sys/ioctl.h> 42 #include <sys/buf.h> 43 #include <sys/uio.h> 44 #include <sys/malloc.h> 45 #include <sys/device.h> 46 #include <sys/disklabel.h> 47 #include <sys/disk.h> 48 #include <sys/syslog.h> 49 #include <sys/proc.h> 50 51 #include <vm/vm.h> 52 53 #include <machine/cpu.h> 54 #include <machine/intr.h> 55 #include <machine/pio.h> 56 57 #include <dev/isa/isavar.h> 58 #include <dev/isa/wdreg.h> 59 #include <dev/isa/wdlink.h> 60 #include "locators.h" 61 62 #define WAITTIME (4 * hz) /* time to wait for a completion */ 63 64 #define WDIORETRIES 5 /* number of retries before giving up */ 65 66 #define WDUNIT(dev) DISKUNIT(dev) 67 #define WDPART(dev) DISKPART(dev) 68 #define MAKEWDDEV(maj, unit, part) MAKEDISKDEV(maj, unit, part) 69 70 #define WDLABELDEV(dev) (MAKEWDDEV(major(dev), WDUNIT(dev), RAW_PART)) 71 72 #ifdef WDDEBUG 73 #define WDDEBUG_PRINT(args) printf args 74 #else 75 #define WDDEBUG_PRINT(args) 76 #endif 77 78 struct wd_softc { 79 struct device sc_dev; 80 struct disk sc_dk; 81 struct wd_link *d_link; 82 struct buf sc_q; 83 }; 84 85 int wdprobe __P((struct device *, void *, void *)); 86 void wdattach __P((struct device *, struct device *, void *)); 87 int wdprint __P((void *, char *)); 88 89 struct cfattach wd_ca = { 90 sizeof(struct wd_softc), wdprobe, wdattach 91 }; 92 93 struct cfdriver wd_cd = { 94 NULL, "wd", DV_DISK 95 }; 96 97 void wdgetdisklabel __P((struct wd_softc *)); 98 int wd_get_parms __P((struct wd_softc *)); 99 void wdstrategy __P((struct buf *)); 100 void wdstart __P((void *)); 101 102 struct dkdriver wddkdriver = { wdstrategy }; 103 104 /* XXX: these should go elsewhere */ 105 cdev_decl(wd); 106 bdev_decl(wd); 107 108 void wdfinish __P((struct wd_softc *, struct buf *)); 109 int wdsetctlr __P((struct wd_link *)); 110 static void bad144intern __P((struct wd_softc *)); 111 int wdlock __P((struct wd_link *)); 112 void wdunlock __P((struct wd_link *)); 113 114 int 115 wdprobe(parent, match, aux) 116 struct device *parent; 117 void *match, *aux; 118 { 119 struct cfdata *cf = match; 120 struct wd_link *d_link = aux; 121 int drive; 122 123 if (d_link == NULL) 124 return 0; 125 if (d_link->type != ATA) 126 return 0; 127 128 drive = d_link->drive; 129 if (cf->cf_loc[ATACF_DRIVE] != ATACF_DRIVE_DEFAULT && 130 cf->cf_loc[ATACF_DRIVE] != drive) 131 return 0; 132 133 return 1; 134 } 135 136 void 137 wdattach(parent, self, aux) 138 struct device *parent, *self; 139 void *aux; 140 { 141 struct wd_softc *wd = (void *)self; 142 struct wd_link *d_link= aux; 143 int i, blank; 144 char buf[41], c, *p, *q; 145 146 wd->d_link = d_link; 147 d_link->openings = 1; 148 d_link->wd_softc = (caddr_t)wd; 149 150 /* 151 * Initialize and attach the disk structure. 152 */ 153 wd->sc_dk.dk_driver = &wddkdriver; 154 wd->sc_dk.dk_name = wd->sc_dev.dv_xname; 155 disk_attach(&wd->sc_dk); 156 157 d_link->sc_lp = wd->sc_dk.dk_label; 158 159 wdc_get_parms((struct wdc_softc *)d_link->wdc_softc, d_link); 160 for (blank = 0, p = d_link->sc_params.wdp_model, q = buf, i = 0; 161 i < sizeof(d_link->sc_params.wdp_model); i++) { 162 c = *p++; 163 if (c == '\0') 164 break; 165 if (c != ' ') { 166 if (blank) { 167 *q++ = ' '; 168 blank = 0; 169 } 170 *q++ = c; 171 } else 172 blank = 1; 173 } 174 *q++ = '\0'; 175 176 printf(": <%s>\n%s: %dMB, %d cyl, %d head, %d sec, %d bytes/sec\n", 177 buf, self->dv_xname, 178 d_link->sc_params.wdp_cylinders * 179 (d_link->sc_params.wdp_heads * d_link->sc_params.wdp_sectors) / 180 (1048576 / DEV_BSIZE), 181 d_link->sc_params.wdp_cylinders, 182 d_link->sc_params.wdp_heads, 183 d_link->sc_params.wdp_sectors, 184 DEV_BSIZE); 185 186 if ((d_link->sc_params.wdp_capabilities & WD_CAP_DMA) != 0 && 187 d_link->sc_mode == WDM_DMA) { 188 d_link->sc_mode = WDM_DMA; 189 } else if (d_link->sc_params.wdp_maxmulti > 1) { 190 d_link->sc_mode = WDM_PIOMULTI; 191 d_link->sc_multiple = min(d_link->sc_params.wdp_maxmulti, 16); 192 } else { 193 d_link->sc_mode = WDM_PIOSINGLE; 194 d_link->sc_multiple = 1; 195 } 196 197 printf("%s: using", wd->sc_dev.dv_xname); 198 if (d_link->sc_mode == WDM_DMA) 199 printf(" dma transfers,"); 200 else 201 printf(" %d-sector %d-bit pio transfers,", 202 d_link->sc_multiple, 203 (d_link->sc_flags & WDF_32BIT) == 0 ? 16 : 32); 204 if ((d_link->sc_params.wdp_capabilities & WD_CAP_LBA) != 0) 205 printf(" lba addressing\n"); 206 else 207 printf(" chs addressing\n"); 208 } 209 210 /* 211 * Read/write routine for a buffer. Validates the arguments and schedules the 212 * transfer. Does not wait for the transfer to complete. 213 */ 214 void 215 wdstrategy(bp) 216 struct buf *bp; 217 { 218 struct wd_softc *wd = wd_cd.cd_devs[WDUNIT(bp->b_dev)]; 219 struct wd_link *d_link= wd->d_link; 220 int s; 221 222 /* Valid request? */ 223 if (bp->b_blkno < 0 || 224 (bp->b_bcount % wd->sc_dk.dk_label->d_secsize) != 0 || 225 (bp->b_bcount / wd->sc_dk.dk_label->d_secsize) >= (1 << NBBY)) { 226 bp->b_error = EINVAL; 227 goto bad; 228 } 229 230 /* If device invalidated (e.g. media change, door open), error. */ 231 if ((d_link->sc_flags & WDF_LOADED) == 0) { 232 bp->b_error = EIO; 233 goto bad; 234 } 235 236 /* If it's a null transfer, return immediately. */ 237 if (bp->b_bcount == 0) 238 goto done; 239 240 /* 241 * Do bounds checking, adjust transfer. if error, process. 242 * If end of partition, just return. 243 */ 244 if (WDPART(bp->b_dev) != RAW_PART && 245 bounds_check_with_label(bp, wd->sc_dk.dk_label, 246 (d_link->sc_flags & (WDF_WLABEL|WDF_LABELLING)) != 0) <= 0) 247 goto done; 248 249 /* Queue transfer on drive, activate drive and controller if idle. */ 250 s = splbio(); 251 disksort(&wd->sc_q, bp); 252 wdstart(wd); 253 splx(s); 254 return; 255 256 bad: 257 bp->b_flags |= B_ERROR; 258 done: 259 /* Toss transfer; we're done early. */ 260 bp->b_resid = bp->b_bcount; 261 biodone(bp); 262 } 263 264 /* 265 * Queue a drive for I/O. 266 */ 267 void 268 wdstart(arg) 269 void *arg; 270 { 271 struct wd_softc *wd = arg; 272 struct buf *dp, *bp=0; 273 struct wd_link *d_link = wd->d_link; 274 struct wdc_xfer *xfer; 275 u_long p_offset; 276 277 while (d_link->openings > 0) { 278 279 /* Is there a buf for us ? */ 280 dp = &wd->sc_q; 281 if ((bp = dp->b_actf) == NULL) /* yes, an assign */ 282 return; 283 dp->b_actf = bp->b_actf; 284 285 /* 286 * Make the command. First lock the device 287 */ 288 d_link->openings--; 289 if (WDPART(bp->b_dev) != RAW_PART) 290 p_offset = 291 wd->sc_dk.dk_label->d_partitions[WDPART(bp->b_dev)].p_offset; 292 else 293 p_offset = 0; 294 295 xfer = wdc_get_xfer(0); 296 if (xfer == NULL) 297 panic("wdc_xfer"); 298 299 xfer->d_link = d_link; 300 xfer->c_bp = bp; 301 xfer->c_p_offset = p_offset; 302 xfer->databuf = bp->b_data; 303 xfer->c_bcount = bp->b_bcount; 304 xfer->c_flags |= bp->b_flags & (B_READ|B_WRITE); 305 xfer->c_blkno = bp->b_blkno; 306 307 /* Instrumentation. */ 308 disk_busy(&wd->sc_dk); 309 wdc_exec_xfer((struct wdc_softc *)wd->d_link->wdc_softc, 310 wd->d_link, xfer); 311 } 312 } 313 314 int 315 wdread(dev, uio, flags) 316 dev_t dev; 317 struct uio *uio; 318 int flags; 319 { 320 321 WDDEBUG_PRINT(("wdread\n")); 322 return (physio(wdstrategy, NULL, dev, B_READ, minphys, uio)); 323 } 324 325 int 326 wdwrite(dev, uio, flags) 327 dev_t dev; 328 struct uio *uio; 329 int flags; 330 { 331 332 WDDEBUG_PRINT(("wdwrite\n")); 333 return (physio(wdstrategy, NULL, dev, B_WRITE, minphys, uio)); 334 } 335 336 /* 337 * Wait interruptibly for an exclusive lock. 338 * 339 * XXX 340 * Several drivers do this; it should be abstracted and made MP-safe. 341 */ 342 int 343 wdlock(d_link) 344 struct wd_link *d_link; 345 { 346 int error; 347 int s; 348 349 WDDEBUG_PRINT(("wdlock\n")); 350 351 s = splbio(); 352 353 while ((d_link->sc_flags & WDF_LOCKED) != 0) { 354 d_link->sc_flags |= WDF_WANTED; 355 if ((error = tsleep(d_link, PRIBIO | PCATCH, 356 "wdlck", 0)) != 0) { 357 splx(s); 358 return error; 359 } 360 } 361 d_link->sc_flags |= WDF_LOCKED; 362 splx(s); 363 return 0; 364 } 365 366 /* 367 * Unlock and wake up any waiters. 368 */ 369 void 370 wdunlock(d_link) 371 struct wd_link *d_link; 372 { 373 374 WDDEBUG_PRINT(("wdunlock")); 375 376 d_link->sc_flags &= ~WDF_LOCKED; 377 if ((d_link->sc_flags & WDF_WANTED) != 0) { 378 d_link->sc_flags &= ~WDF_WANTED; 379 wakeup(d_link); 380 } 381 } 382 383 int 384 wdopen(dev, flag, fmt, p) 385 dev_t dev; 386 int flag, fmt; 387 struct proc *p; 388 { 389 struct wd_softc *wd; 390 struct wd_link *d_link; 391 int unit, part; 392 int error; 393 394 WDDEBUG_PRINT(("wdopen\n")); 395 396 unit = WDUNIT(dev); 397 if (unit >= wd_cd.cd_ndevs) 398 return ENXIO; 399 wd = wd_cd.cd_devs[unit]; 400 if (wd == NULL) 401 return ENXIO; 402 403 d_link = wd->d_link; 404 if ((error = wdlock(d_link)) != 0) 405 return error; 406 407 if (wd->sc_dk.dk_openmask != 0) { 408 /* 409 * If any partition is open, but the disk has been invalidated, 410 * disallow further opens. 411 */ 412 if ((d_link->sc_flags & WDF_LOADED) == 0) { 413 error = EIO; 414 goto bad3; 415 } 416 } else { 417 if ((d_link->sc_flags & WDF_LOADED) == 0) { 418 d_link->sc_flags |= WDF_LOADED; 419 420 /* Load the physical device parameters. */ 421 if (wdc_get_parms((struct wdc_softc *)d_link->wdc_softc, 422 d_link) != 0) { 423 error = ENXIO; 424 goto bad2; 425 } 426 427 /* Load the partition info if not already loaded. */ 428 wdgetdisklabel(wd); 429 } 430 } 431 432 part = WDPART(dev); 433 434 /* Check that the partition exists. */ 435 if (part != RAW_PART && 436 (part >= wd->sc_dk.dk_label->d_npartitions || 437 wd->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) { 438 error = ENXIO; 439 goto bad; 440 } 441 442 /* Insure only one open at a time. */ 443 switch (fmt) { 444 case S_IFCHR: 445 wd->sc_dk.dk_copenmask |= (1 << part); 446 break; 447 case S_IFBLK: 448 wd->sc_dk.dk_bopenmask |= (1 << part); 449 break; 450 } 451 wd->sc_dk.dk_openmask = wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask; 452 453 wdunlock(d_link); 454 return 0; 455 456 bad2: 457 d_link->sc_flags &= ~WDF_LOADED; 458 459 bad: 460 if (wd->sc_dk.dk_openmask == 0) { 461 } 462 463 bad3: 464 wdunlock(d_link); 465 return error; 466 } 467 468 int 469 wdclose(dev, flag, fmt, p) 470 dev_t dev; 471 int flag, fmt; 472 struct proc *p; 473 { 474 struct wd_softc *wd = wd_cd.cd_devs[WDUNIT(dev)]; 475 int part = WDPART(dev); 476 int error; 477 478 if ((error = wdlock(wd->d_link)) != 0) 479 return error; 480 481 switch (fmt) { 482 case S_IFCHR: 483 wd->sc_dk.dk_copenmask &= ~(1 << part); 484 break; 485 case S_IFBLK: 486 wd->sc_dk.dk_bopenmask &= ~(1 << part); 487 break; 488 } 489 wd->sc_dk.dk_openmask = wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask; 490 491 if (wd->sc_dk.dk_openmask == 0) { 492 /* XXXX Must wait for I/O to complete! */ 493 } 494 495 wdunlock(wd->d_link); 496 return 0; 497 } 498 499 /* 500 * Fabricate a default disk label, and try to read the correct one. 501 */ 502 void 503 wdgetdisklabel(wd) 504 struct wd_softc *wd; 505 { 506 struct disklabel *lp = wd->sc_dk.dk_label; 507 struct wd_link *d_link = wd->d_link; 508 char *errstring; 509 510 WDDEBUG_PRINT(("wdgetdisklabel\n")); 511 512 bzero(lp, sizeof(struct disklabel)); 513 bzero(wd->sc_dk.dk_cpulabel, sizeof(struct cpu_disklabel)); 514 515 lp->d_secsize = DEV_BSIZE; 516 lp->d_ntracks = d_link->sc_params.wdp_heads; 517 lp->d_nsectors = d_link->sc_params.wdp_sectors; 518 lp->d_ncylinders = d_link->sc_params.wdp_cylinders; 519 lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors; 520 521 #if 0 522 strncpy(lp->d_typename, "ST506 disk", 16); 523 lp->d_type = DTYPE_ST506; 524 #endif 525 strncpy(lp->d_packname, d_link->sc_params.wdp_model, 16); 526 lp->d_secperunit = lp->d_secpercyl * lp->d_ncylinders; 527 lp->d_rpm = 3600; 528 lp->d_interleave = 1; 529 lp->d_flags = 0; 530 531 lp->d_partitions[RAW_PART].p_offset = 0; 532 lp->d_partitions[RAW_PART].p_size = 533 lp->d_secperunit * (lp->d_secsize / DEV_BSIZE); 534 lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED; 535 lp->d_npartitions = RAW_PART + 1; 536 537 lp->d_magic = DISKMAGIC; 538 lp->d_magic2 = DISKMAGIC; 539 lp->d_checksum = dkcksum(lp); 540 541 d_link->sc_badsect[0] = -1; 542 543 if (d_link->sc_state > RECAL) 544 d_link->sc_state = RECAL; 545 errstring = readdisklabel(MAKEWDDEV(0, wd->sc_dev.dv_unit, RAW_PART), 546 wdstrategy, lp, wd->sc_dk.dk_cpulabel); 547 if (errstring) { 548 /* 549 * This probably happened because the drive's default 550 * geometry doesn't match the DOS geometry. We 551 * assume the DOS geometry is now in the label and try 552 * again. XXX This is a kluge. 553 */ 554 if (d_link->sc_state > GEOMETRY) 555 d_link->sc_state = GEOMETRY; 556 errstring = readdisklabel(MAKEWDDEV(0, wd->sc_dev.dv_unit, RAW_PART), 557 wdstrategy, lp, wd->sc_dk.dk_cpulabel); 558 } 559 if (errstring) { 560 printf("%s: %s\n", wd->sc_dev.dv_xname, errstring); 561 return; 562 } 563 564 if (d_link->sc_state > GEOMETRY) 565 d_link->sc_state = GEOMETRY; 566 if ((lp->d_flags & D_BADSECT) != 0) 567 bad144intern(wd); 568 } 569 570 571 /* 572 * Tell the drive what geometry to use. 573 */ 574 int 575 wdsetctlr(d_link) 576 struct wd_link *d_link; 577 { 578 struct wd_softc *wd=(struct wd_softc *)d_link->wd_softc; 579 580 WDDEBUG_PRINT(("wd(%d,%d) C%dH%dS%d\n", wd->sc_dev.dv_unit, 581 d_link->drive, wd->sc_dk.dk_label->d_ncylinders, 582 wd->sc_dk.dk_label->d_ntracks, wd->sc_dk.dk_label->d_nsectors)); 583 584 if (wdccommand((struct wdc_softc *)d_link->wdc_softc, 585 d_link, WDCC_IDP, d_link->drive, 586 wd->sc_dk.dk_label->d_ncylinders, 587 wd->sc_dk.dk_label->d_ntracks - 1, 0, 588 wd->sc_dk.dk_label->d_nsectors) != 0) { 589 wderror(d_link, NULL, "wdsetctlr: geometry upload failed"); 590 return -1; 591 } 592 593 return 0; 594 } 595 596 int 597 wdioctl(dev, xfer, addr, flag, p) 598 dev_t dev; 599 u_long xfer; 600 caddr_t addr; 601 int flag; 602 struct proc *p; 603 { 604 struct wd_softc *wd = wd_cd.cd_devs[WDUNIT(dev)]; 605 struct wd_link *d_link = wd->d_link; 606 int error; 607 608 WDDEBUG_PRINT(("wdioctl\n")); 609 610 if ((d_link->sc_flags & WDF_LOADED) == 0) 611 return EIO; 612 613 switch (xfer) { 614 case DIOCSBAD: 615 if ((flag & FWRITE) == 0) 616 return EBADF; 617 wd->sc_dk.dk_cpulabel->bad = *(struct dkbad *)addr; 618 wd->sc_dk.dk_label->d_flags |= D_BADSECT; 619 bad144intern(wd); 620 return 0; 621 622 case DIOCGDINFO: 623 *(struct disklabel *)addr = *(wd->sc_dk.dk_label); 624 return 0; 625 626 case DIOCGPART: 627 ((struct partinfo *)addr)->disklab = wd->sc_dk.dk_label; 628 ((struct partinfo *)addr)->part = 629 &wd->sc_dk.dk_label->d_partitions[WDPART(dev)]; 630 return 0; 631 632 case DIOCWDINFO: 633 case DIOCSDINFO: 634 if ((flag & FWRITE) == 0) 635 return EBADF; 636 637 if ((error = wdlock(wd->d_link)) != 0) 638 return error; 639 d_link->sc_flags |= WDF_LABELLING; 640 641 error = setdisklabel(wd->sc_dk.dk_label, 642 (struct disklabel *)addr, /*wd->sc_dk.dk_openmask : */0, 643 wd->sc_dk.dk_cpulabel); 644 if (error == 0) { 645 if (d_link->sc_state > GEOMETRY) 646 d_link->sc_state = GEOMETRY; 647 if (xfer == DIOCWDINFO) 648 error = writedisklabel(WDLABELDEV(dev), 649 wdstrategy, wd->sc_dk.dk_label, 650 wd->sc_dk.dk_cpulabel); 651 } 652 653 d_link->sc_flags &= ~WDF_LABELLING; 654 wdunlock(d_link); 655 return error; 656 657 case DIOCWLABEL: 658 if ((flag & FWRITE) == 0) 659 return EBADF; 660 if (*(int *)addr) 661 d_link->sc_flags |= WDF_WLABEL; 662 else 663 d_link->sc_flags &= ~WDF_WLABEL; 664 return 0; 665 666 #ifdef notyet 667 case DIOCWFORMAT: 668 if ((flag & FWRITE) == 0) 669 return EBADF; 670 { 671 register struct format_op *fop; 672 struct iovec aiov; 673 struct uio auio; 674 675 fop = (struct format_op *)addr; 676 aiov.iov_base = fop->df_buf; 677 aiov.iov_len = fop->df_count; 678 auio.uio_iov = &aiov; 679 auio.uio_iovcnt = 1; 680 auio.uio_resid = fop->df_count; 681 auio.uio_segflg = 0; 682 auio.uio_offset = 683 fop->df_startblk * wd->sc_dk.dk_label->d_secsize; 684 auio.uio_procp = p; 685 error = physio(wdformat, NULL, dev, B_WRITE, minphys, 686 &auio); 687 fop->df_count -= auio.uio_resid; 688 fop->df_reg[0] = wdc->sc_status; 689 fop->df_reg[1] = wdc->sc_error; 690 return error; 691 } 692 #endif 693 694 default: 695 return ENOTTY; 696 } 697 698 #ifdef DIAGNOSTIC 699 panic("wdioctl: impossible"); 700 #endif 701 } 702 703 #ifdef B_FORMAT 704 int 705 wdformat(struct buf *bp) 706 { 707 708 bp->b_flags |= B_FORMAT; 709 return wdstrategy(bp); 710 } 711 #endif 712 713 int 714 wdsize(dev) 715 dev_t dev; 716 { 717 struct wd_softc *wd; 718 int part, unit, omask; 719 int size; 720 721 WDDEBUG_PRINT(("wdsize\n")); 722 723 unit = WDUNIT(dev); 724 if (unit >= wd_cd.cd_ndevs) 725 return (-1); 726 wd = wd_cd.cd_devs[unit]; 727 if (wd == NULL) 728 return (-1); 729 730 part = WDPART(dev); 731 omask = wd->sc_dk.dk_openmask & (1 << part); 732 733 if (omask == 0 && wdopen(dev, 0, S_IFBLK, NULL) != 0) 734 return (-1); 735 if (wd->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP) 736 size = -1; 737 else 738 size = wd->sc_dk.dk_label->d_partitions[part].p_size * 739 (wd->sc_dk.dk_label->d_secsize / DEV_BSIZE); 740 if (omask == 0 && wdclose(dev, 0, S_IFBLK, NULL) != 0) 741 return (-1); 742 return (size); 743 } 744 745 746 #ifndef __BDEVSW_DUMP_OLD_TYPE 747 /* #define WD_DUMP_NOT_TRUSTED if you just want to watch */ 748 static int wddoingadump; 749 static int wddumprecalibrated; 750 751 /* 752 * Dump core after a system crash. 753 * 754 * XXX: This needs work! Currently, it's a major hack: the 755 * use of wdc_softc is very bad and should go away. 756 */ 757 int 758 wddump(dev, blkno, va, size) 759 dev_t dev; 760 daddr_t blkno; 761 caddr_t va; 762 size_t size; 763 { 764 struct wd_softc *wd; /* disk unit to do the I/O */ 765 struct wdc_softc *wdc; /* disk controller to do the I/O */ 766 struct disklabel *lp; /* disk's disklabel */ 767 struct wd_link *d_link; 768 int unit, part; 769 int nblks; /* total number of sectors left to write */ 770 771 /* Check if recursive dump; if so, punt. */ 772 if (wddoingadump) 773 return EFAULT; 774 wddoingadump = 1; 775 776 unit = WDUNIT(dev); 777 if (unit >= wd_cd.cd_ndevs) 778 return ENXIO; 779 wd = wd_cd.cd_devs[unit]; 780 if (wd == (struct wd_softc *)0) 781 return ENXIO; 782 d_link = wd->d_link; 783 784 part = WDPART(dev); 785 786 /* Make sure it was initialized. */ 787 if (d_link->sc_state < READY) 788 return ENXIO; 789 790 wdc = (void *)wd->sc_dev.dv_parent; 791 792 /* Convert to disk sectors. Request must be a multiple of size. */ 793 lp = wd->sc_dk.dk_label; 794 if ((size % lp->d_secsize) != 0) 795 return EFAULT; 796 nblks = size / lp->d_secsize; 797 blkno = blkno / (lp->d_secsize / DEV_BSIZE); 798 799 /* Check transfer bounds against partition size. */ 800 if ((blkno < 0) || ((blkno + nblks) > lp->d_partitions[part].p_size)) 801 return EINVAL; 802 803 /* Offset block number to start of partition. */ 804 blkno += lp->d_partitions[part].p_offset; 805 806 /* Recalibrate, if first dump transfer. */ 807 if (wddumprecalibrated == 0) { 808 wddumprecalibrated = 1; 809 if (wdccommandshort(wdc, d_link->drive, WDCC_RECAL) != 0 || 810 wait_for_ready(wdc) != 0 || wdsetctlr(d_link) != 0 || 811 wait_for_ready(wdc) != 0) { 812 wderror(d_link, NULL, "wddump: recal failed"); 813 return EIO; 814 } 815 } 816 817 while (nblks > 0) { 818 daddr_t xlt_blkno = blkno; 819 long cylin, head, sector; 820 821 if ((lp->d_flags & D_BADSECT) != 0) { 822 long blkdiff; 823 int i; 824 825 for (i = 0; (blkdiff = d_link->sc_badsect[i]) != -1; i++) { 826 blkdiff -= xlt_blkno; 827 if (blkdiff < 0) 828 continue; 829 if (blkdiff == 0) { 830 /* Replace current block of transfer. */ 831 xlt_blkno = lp->d_secperunit - 832 lp->d_nsectors - i - 1; 833 } 834 break; 835 } 836 /* Tranfer is okay now. */ 837 } 838 839 if ((d_link->sc_params.wdp_capabilities & WD_CAP_LBA) != 0) { 840 sector = (xlt_blkno >> 0) & 0xff; 841 cylin = (xlt_blkno >> 8) & 0xffff; 842 head = (xlt_blkno >> 24) & 0xf; 843 head |= WDSD_LBA; 844 } else { 845 sector = xlt_blkno % lp->d_nsectors; 846 sector++; /* Sectors begin with 1, not 0. */ 847 xlt_blkno /= lp->d_nsectors; 848 head = xlt_blkno % lp->d_ntracks; 849 xlt_blkno /= lp->d_ntracks; 850 cylin = xlt_blkno; 851 head |= WDSD_CHS; 852 } 853 854 #ifndef WD_DUMP_NOT_TRUSTED 855 if (wdccommand((struct wdc_softc *)d_link->wdc_softc, d_link, 856 WDCC_WRITE, d_link->drive, cylin, head, sector, 1) != 0 || 857 wait_for_drq(wdc) != 0) { 858 wderror(d_link, NULL, "wddump: write failed"); 859 return EIO; 860 } 861 862 /* XXX XXX XXX */ 863 outsw(wdc->sc_iobase + wd_data, va, lp->d_secsize >> 1); 864 865 /* Check data request (should be done). */ 866 if (wait_for_ready(wdc) != 0) { 867 wderror(d_link, NULL, 868 "wddump: timeout waiting for ready"); 869 return EIO; 870 } 871 #else /* WD_DUMP_NOT_TRUSTED */ 872 /* Let's just talk about this first... */ 873 printf("wd%d: dump addr 0x%x, cylin %d, head %d, sector %d\n", 874 unit, va, cylin, head, sector); 875 delay(500 * 1000); /* half a second */ 876 #endif 877 878 /* update block count */ 879 nblks -= 1; 880 blkno += 1; 881 va += lp->d_secsize; 882 } 883 884 wddoingadump = 0; 885 return 0; 886 } 887 #else /* __BDEVSW_DUMP_NEW_TYPE */ 888 889 890 int 891 wddump(dev, blkno, va, size) 892 dev_t dev; 893 daddr_t blkno; 894 caddr_t va; 895 size_t size; 896 { 897 898 /* Not implemented. */ 899 return ENXIO; 900 } 901 #endif /* __BDEVSW_DUMP_NEW_TYPE */ 902 903 /* 904 * Internalize the bad sector table. 905 */ 906 void 907 bad144intern(wd) 908 struct wd_softc *wd; 909 { 910 struct dkbad *bt = &wd->sc_dk.dk_cpulabel->bad; 911 struct disklabel *lp = wd->sc_dk.dk_label; 912 struct wd_link *d_link = wd->d_link; 913 int i = 0; 914 915 WDDEBUG_PRINT(("bad144intern\n")); 916 917 for (; i < 126; i++) { 918 if (bt->bt_bad[i].bt_cyl == 0xffff) 919 break; 920 d_link->sc_badsect[i] = 921 bt->bt_bad[i].bt_cyl * lp->d_secpercyl + 922 (bt->bt_bad[i].bt_trksec >> 8) * lp->d_nsectors + 923 (bt->bt_bad[i].bt_trksec & 0xff); 924 } 925 for (; i < 127; i++) 926 d_link->sc_badsect[i] = -1; 927 } 928 929 void 930 wderror(d_link, bp, msg) 931 struct wd_link *d_link; 932 struct buf *bp; 933 char *msg; 934 { 935 struct wd_softc *wd = (struct wd_softc *)d_link->wd_softc; 936 937 if (bp) { 938 diskerr(bp, "wd", msg, LOG_PRINTF, bp->b_bcount, 939 wd->sc_dk.dk_label); 940 printf("\n"); 941 } else 942 printf("%s: %s\n", wd->sc_dev.dv_xname, msg); 943 } 944 945 void 946 wddone(d_link, bp) 947 struct wd_link *d_link; 948 struct buf *bp; 949 { 950 struct wd_softc *wd = (void *)d_link->wd_softc; 951 952 disk_unbusy(&wd->sc_dk, (bp->b_bcount - bp->b_resid)); 953 } 954
Indexes created Tue Sep 30 20:09:53 GMT 2025