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