wd.c revision 1.62 1 /*
2 * Copyright (c) 1994 Charles Hannum.
3 * Copyright (c) 1990 The Regents of the University of California.
4 * All rights reserved.
5 *
6 * This code is derived from software contributed to Berkeley by
7 * William Jolitz.
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 the University of
20 * California, Berkeley and its contributors.
21 * 4. Neither the name of the University nor the names of its contributors
22 * may be used to endorse or promote products derived from this software
23 * without specific prior written permission.
24 *
25 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
26 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
27 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
28 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
29 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
30 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
31 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
32 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
33 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
34 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
35 * SUCH DAMAGE.
36 *
37 * from: @(#)wd.c 7.2 (Berkeley) 5/9/91
38 * $Id: wd.c,v 1.62 1994/03/07 03:18:35 mycroft Exp $
39 */
40
41 #define INSTRUMENT /* instrumentation stuff by Brad Parker */
42
43 #include "wd.h"
44 #if NWDC > 0
45
46 #include <sys/param.h>
47 #include <sys/dkbad.h>
48 #include <sys/systm.h>
49 #include <sys/kernel.h>
50 #include <sys/conf.h>
51 #include <sys/file.h>
52 #include <sys/stat.h>
53 #include <sys/ioctl.h>
54 #include <sys/disklabel.h>
55 #include <sys/buf.h>
56 #include <sys/uio.h>
57 #include <sys/malloc.h>
58 #include <sys/syslog.h>
59 #ifdef INSTRUMENT
60 #include <sys/dkstat.h>
61 #endif
62
63 #include <vm/vm.h>
64
65 #include <machine/cpu.h>
66 #include <machine/cpufunc.h>
67 #include <machine/pio.h>
68
69 #include <i386/isa/isa.h>
70 #include <i386/isa/isa_device.h>
71 #include <i386/isa/icu.h>
72 #include <i386/isa/wdreg.h>
73
74 #define WDCNDELAY 100000 /* delay = 100us; so 10s for a controller state change */
75 #define WDCDELAY 100
76
77 #if 0
78 /* if you enable this, it will report any delays more than 100us * N long */
79 #define WDCNDELAY_DEBUG 100
80 #endif
81
82 #define WDIORETRIES 5 /* number of retries before giving up */
83
84 #define WDUNIT(dev) ((minor(dev) & 0xf8) >> 3)
85 #define WDPART(dev) ((minor(dev) & 0x07) )
86 #define makewddev(maj, unit, part) (makedev(maj, ((unit << 3) + part)))
87 #define WDRAW 3 /* 'd' partition isn't a partition! */
88
89 #define b_cylin b_resid /* cylinder number for doing IO to */
90 /* shares an entry in the buf struct */
91
92 /*
93 * Drive states. Used to initialize drive.
94 */
95 #define CLOSED 0 /* disk is closed. */
96 #define WANTOPEN 1 /* open requested, not started */
97 #define RECAL 2 /* doing restore */
98 #define OPEN 3 /* done with open */
99
100 /*
101 * Drive status.
102 */
103 struct disk {
104 long dk_bc; /* byte count left */
105 long dk_bct; /* total byte count left */
106 short dk_skip; /* blocks already transferred */
107 short dk_skipm; /* blocks already transferred for multi */
108 char dk_ctrlr; /* physical controller number */
109 char dk_unit; /* physical unit number */
110 char dk_lunit; /* logical unit number */
111 char dk_state; /* control state */
112 int dk_timeout; /* timeout counter */
113 u_char dk_status; /* copy of status reg. */
114 u_char dk_error; /* copy of error reg. */
115 u_short dk_port; /* i/o port base */
116
117 u_long dk_copenpart; /* character units open on this drive */
118 u_long dk_bopenpart; /* block units open on this drive */
119 u_long dk_openpart; /* all units open on this drive */
120 short dk_wlabel; /* label writable? */
121 short dk_flags; /* drive characteistics found */
122 #define DKFL_SINGLE 0x00004 /* sector at a time mode */
123 #define DKFL_ERROR 0x00008 /* processing a disk error */
124 #define DKFL_BSDLABEL 0x00010 /* has a BSD disk label */
125 #define DKFL_BADSECT 0x00020 /* has a bad144 badsector table */
126 #define DKFL_WRITEPROT 0x00040 /* manual unit write protect */
127 struct wdparams dk_params; /* ESDI/IDE drive/controller parameters */
128 struct disklabel dk_dd; /* device configuration data */
129 struct cpu_disklabel dk_cpd;
130 long dk_badsect[127]; /* 126 plus trailing -1 marker */
131 };
132
133 struct board {
134 short dkc_port;
135 };
136
137 struct board wdcontroller[NWDC];
138 struct disk *wddrives[NWD]; /* table of units */
139 struct buf wdtab[NWDC]; /* various per-controller info */
140 struct buf wdutab[NWD]; /* head of queue per drive */
141 struct buf rwdbuf[NWD]; /* buffers for raw IO */
142 long wdxfer[NWD]; /* count of transfers */
143
144 int wdprobe(), wdattach();
145
146 struct isa_driver wdcdriver = {
147 wdprobe, wdattach, "wdc",
148 };
149
150 static void wdustart __P((struct disk *));
151 static void wdstart __P((int));
152 static int wdcommand __P((struct disk *, int, int, int, int, int));
153 static int wdcontrol __P((struct buf *));
154 static int wdsetctlr __P((struct disk *));
155 static int wdgetctlr __P((struct disk *));
156 static void bad144intern __P((struct disk *));
157 static int wdreset __P((struct disk *, int));
158 static void wdtimeout __P((caddr_t));
159 void wddisksort __P((struct buf *dp, struct buf *bp));
160 int wdc_wait __P((struct disk *, int));
161 #define wait_for_drq(d) wdc_wait(d, WDCS_DRQ)
162 #define wait_for_ready(d) wdc_wait(d, WDCS_READY | WDCS_SEEKCMPLT)
163 #define wait_for_unbusy(d) wdc_wait(d, 0)
164
165 /*
166 * Probe for controller.
167 */
168 int
169 wdprobe(isa_dev)
170 struct isa_device *isa_dev;
171 {
172 struct disk *du;
173 u_short wdc;
174
175 if (isa_dev->id_unit >= NWDC)
176 return 0;
177
178 du = (struct disk *)malloc(sizeof(struct disk), M_TEMP, M_NOWAIT);
179 bzero(du, sizeof(struct disk));
180
181 du->dk_ctrlr = isa_dev->id_unit;
182 du->dk_unit = 0;
183 du->dk_lunit = 0;
184 wdcontroller[isa_dev->id_unit].dkc_port = isa_dev->id_iobase;
185
186 wdc = du->dk_port = isa_dev->id_iobase;
187
188 /* check if we have registers that work */
189 outb(wdc+wd_error, 0x5a); /* error register not writable */
190 outb(wdc+wd_cyl_lo, 0xa5); /* but all of cyllo are implemented */
191 if (inb(wdc+wd_error) == 0x5a || inb(wdc+wd_cyl_lo) != 0xa5)
192 goto nodevice;
193
194 wdreset(du, 0);
195
196 /* execute a controller only command */
197 if (wdcommand(du, 0, 0, 0, 0, WDCC_DIAGNOSE) < 0)
198 goto nodevice;
199
200 free(du, M_TEMP);
201 return 8;
202
203 nodevice:
204 free(du, M_TEMP);
205 return 0;
206 }
207
208 /*
209 * Called for the controller too
210 * Attach each drive if possible.
211 */
212 int
213 wdattach(isa_dev)
214 struct isa_device *isa_dev;
215 {
216 int unit, lunit;
217 struct disk *du;
218 int i, blank;
219
220 if (isa_dev->id_masunit == -1)
221 return 0;
222 if (isa_dev->id_masunit >= NWDC)
223 return 0;
224
225 lunit = isa_dev->id_unit;
226 if (lunit == -1) {
227 printf("wdc%d: cannot support unit ?\n", isa_dev->id_masunit);
228 return 0;
229 }
230 if (lunit >= NWD)
231 return 0;
232 unit = isa_dev->id_physid;
233
234 du = wddrives[lunit] =
235 (struct disk *)malloc(sizeof(struct disk), M_TEMP, M_NOWAIT);
236 bzero(du, sizeof(struct disk));
237 bzero(&wdutab[lunit], sizeof(struct buf));
238 bzero(&rwdbuf[lunit], sizeof(struct buf));
239 wdxfer[lunit] = 0;
240 du->dk_ctrlr = isa_dev->id_masunit;
241 du->dk_unit = unit;
242 du->dk_lunit = lunit;
243 du->dk_port = wdcontroller[isa_dev->id_masunit].dkc_port;
244
245 if (wdgetctlr(du) != 0) {
246 /*printf("wd%d at wdc%d slave %d -- error\n", lunit,
247 isa_dev->id_masunit, unit);*/
248 wddrives[lunit] = 0;
249 free(du, M_TEMP);
250 return 0;
251 }
252
253 printf("wd%d at wdc%d targ %d: ", isa_dev->id_unit,
254 isa_dev->id_masunit, isa_dev->id_physid);
255 if (du->dk_params.wdp_heads == 0)
256 printf("(unknown size) <");
257 else
258 printf("%dMB %d cyl, %d head, %d sec <",
259 du->dk_dd.d_ncylinders * du->dk_dd.d_secpercyl /
260 (1048576 / DEV_BSIZE),
261 du->dk_dd.d_ncylinders, du->dk_dd.d_ntracks,
262 du->dk_dd.d_nsectors);
263 for (i = blank = 0; i < sizeof(du->dk_params.wdp_model); i++) {
264 char c = du->dk_params.wdp_model[i];
265 if (c == '\0')
266 break;
267 if (c != ' ') {
268 if (blank)
269 printf(" %c", c);
270 else
271 printf("%c", c);
272 blank = 0;
273 } else
274 blank = 1;
275 }
276 printf(">\n");
277
278 wdtimeout((caddr_t)du);
279
280 return 1;
281 }
282
283 /* Read/write routine for a buffer. Finds the proper unit, range checks
284 * arguments, and schedules the transfer. Does not wait for the transfer
285 * to complete. Multi-page transfers are supported. All I/O requests must
286 * be a multiple of a sector in length.
287 */
288 int
289 wdstrategy(bp)
290 struct buf *bp;
291 {
292 struct buf *dp;
293 struct disk *du; /* Disk unit to do the IO. */
294 int lunit = WDUNIT(bp->b_dev);
295 int s;
296
297 /* valid unit, controller, and request? */
298 if (lunit >= NWD || bp->b_blkno < 0 ||
299 howmany(bp->b_bcount, DEV_BSIZE) >= (1 << NBBY) ||
300 (du = wddrives[lunit]) == 0) {
301 bp->b_error = EINVAL;
302 bp->b_flags |= B_ERROR;
303 goto done;
304 }
305
306 /* "soft" write protect check */
307 if ((du->dk_flags & DKFL_WRITEPROT) && (bp->b_flags & B_READ) == 0) {
308 bp->b_error = EROFS;
309 bp->b_flags |= B_ERROR;
310 goto done;
311 }
312
313 /* have partitions and want to use them? */
314 if ((du->dk_flags & DKFL_BSDLABEL) != 0 && WDPART(bp->b_dev) != WDRAW) {
315 /*
316 * do bounds checking, adjust transfer. if error, process.
317 * if end of partition, just return
318 */
319 if (bounds_check_with_label(bp, &du->dk_dd, du->dk_wlabel) <= 0)
320 goto done;
321 /* otherwise, process transfer request */
322 }
323
324 /* don't bother */
325 bp->b_cylin = 0;
326
327 /* queue transfer on drive, activate drive and controller if idle */
328 dp = &wdutab[lunit];
329 s = splbio();
330 wddisksort(dp, bp);
331 if (dp->b_active == 0)
332 wdustart(du); /* start drive */
333 if (wdtab[du->dk_ctrlr].b_active == 0)
334 wdstart(du->dk_ctrlr); /* start controller */
335 splx(s);
336 return 0;
337
338 done:
339 /* toss transfer, we're done early */
340 biodone(bp);
341 }
342
343 /*
344 * Need to skip over multitransfer bufs.
345 */
346 void
347 wddisksort(dp, bp)
348 struct buf *dp, *bp;
349 {
350 struct buf *ap;
351
352 while ((ap = dp->b_actf) && ap->b_flags & B_XXX)
353 dp = ap;
354 disksort(dp, bp);
355 }
356
357 /*
358 * Routine to queue a command to the controller. The unit's
359 * request is linked into the active list for the controller.
360 * If the controller is idle, the transfer is started.
361 */
362 static void
363 wdustart(du)
364 struct disk *du;
365 {
366 struct buf *dp = &wdutab[du->dk_lunit];
367 int ctrlr = du->dk_ctrlr;
368
369 /* unit already active? */
370 if (dp->b_active)
371 return;
372
373 /* anything to start? */
374 if (dp->b_actf == NULL)
375 return;
376
377 /* link onto controller queue */
378 dp->b_forw = NULL;
379 if (wdtab[ctrlr].b_forw == NULL)
380 wdtab[ctrlr].b_forw = dp;
381 else
382 wdtab[ctrlr].b_actl->b_forw = dp;
383 wdtab[ctrlr].b_actl = dp;
384
385 /* mark the drive unit as busy */
386 dp->b_active = 1;
387 }
388
389 /*
390 * Controller startup routine. This does the calculation, and starts
391 * a single-sector read or write operation. Called to start a transfer,
392 * or from the interrupt routine to continue a multi-sector transfer.
393 * RESTRICTIONS:
394 * 1. The transfer length must be an exact multiple of the sector size.
395 */
396 static void
397 wdstart(ctrlr)
398 int ctrlr;
399 {
400 register struct disk *du; /* disk unit for IO */
401 register struct buf *bp;
402 struct disklabel *lp;
403 struct buf *dp;
404 long blknum, cylin, head, sector;
405 long secpertrk, secpercyl;
406 int xfrblknum;
407 int lunit;
408 u_short wdc;
409
410 loop:
411 /* is there a drive for the controller to do a transfer with? */
412 dp = wdtab[ctrlr].b_forw;
413 if (dp == NULL) {
414 wdtab[ctrlr].b_active = 0;
415 return;
416 }
417
418 /* is there a transfer to this drive ? if so, link it on
419 the controller's queue */
420 bp = dp->b_actf;
421 if (bp == NULL) {
422 dp->b_active = 0;
423 wdtab[ctrlr].b_forw = dp->b_forw;
424 goto loop;
425 }
426
427 /* obtain controller and drive information */
428 lunit = WDUNIT(bp->b_dev);
429 du = wddrives[lunit];
430
431 /* clear any pending timeout, just in case */
432 du->dk_timeout = 0;
433
434 /* if not really a transfer, do control operations specially */
435 if (du->dk_state < OPEN) {
436 (void) wdcontrol(bp);
437 return;
438 }
439
440 /* calculate transfer details */
441 blknum = bp->b_blkno + du->dk_skip;
442 #ifdef WDDEBUG
443 if (du->dk_skip == 0)
444 printf("\nwdstart %d: %s %d@%d; map ", lunit,
445 (bp->b_flags & B_READ) ? "read" : "write", bp->b_bcount,
446 blknum);
447 else
448 printf(" %d)%x", du->dk_skip, inb(du->dk_port+wd_altsts));
449 #endif
450 if (du->dk_skip == 0)
451 du->dk_bc = bp->b_bcount;
452 if (du->dk_skipm == 0) {
453 struct buf *oldbp, *nextbp;
454 oldbp = bp;
455 nextbp = bp->b_actf;
456 du->dk_bct = du->dk_bc;
457 oldbp->b_flags |= B_XXX;
458 while (nextbp && (oldbp->b_flags & DKFL_SINGLE) == 0 &&
459 oldbp->b_dev == nextbp->b_dev && nextbp->b_blkno ==
460 (oldbp->b_blkno + (oldbp->b_bcount / DEV_BSIZE)) &&
461 (oldbp->b_flags & B_READ) == (nextbp->b_flags & B_READ)) {
462 if ((du->dk_bct + nextbp->b_bcount) / DEV_BSIZE >= 240)
463 break;
464 du->dk_bct += nextbp->b_bcount;
465 nextbp->b_flags |= B_XXX;
466 oldbp = nextbp;
467 nextbp = nextbp->b_actf;
468 }
469 }
470
471 lp = &du->dk_dd;
472 secpertrk = lp->d_nsectors;
473 secpercyl = lp->d_secpercyl;
474 if ((du->dk_flags & DKFL_BSDLABEL) != 0 && WDPART(bp->b_dev) != WDRAW)
475 blknum += lp->d_partitions[WDPART(bp->b_dev)].p_offset;
476 cylin = blknum / secpercyl;
477 head = (blknum % secpercyl) / secpertrk;
478 sector = blknum % secpertrk;
479
480 /* Check for bad sectors if we have them, and not formatting */
481 /* Only do this in single-sector mode, or when starting a */
482 /* multiple-sector transfer. */
483 if ((du->dk_flags & DKFL_BADSECT) &&
484 #ifdef B_FORMAT
485 (bp->b_flags & B_FORMAT) == 0 &&
486 #endif
487 (du->dk_skipm == 0 || (du->dk_flags & DKFL_SINGLE))) {
488
489 long blkchk, blkend, blknew;
490 int i;
491
492 blkend = blknum + howmany(du->dk_bct, DEV_BSIZE) - 1;
493 for (i = 0; (blkchk = du->dk_badsect[i]) != -1; i++) {
494 if (blkchk > blkend)
495 break; /* transfer is completely OK; done */
496 if (blkchk == blknum) {
497 blknew =
498 lp->d_secperunit - lp->d_nsectors - i - 1;
499 cylin = blknew / secpercyl;
500 head = (blknew % secpercyl) / secpertrk;
501 sector = blknew % secpertrk;
502 du->dk_flags |= DKFL_SINGLE;
503 /* found and replaced first blk of transfer; done */
504 break;
505 } else if (blkchk > blknum) {
506 du->dk_flags |= DKFL_SINGLE;
507 break; /* bad block inside transfer; done */
508 }
509 }
510 }
511 if (du->dk_flags & DKFL_SINGLE) {
512 du->dk_bct = du->dk_bc;
513 du->dk_skipm = du->dk_skip;
514 }
515
516 #ifdef WDDEBUG
517 printf("c%d h%d s%d ", cylin, head, sector);
518 #endif
519
520 sector++; /* sectors begin with 1, not 0 */
521
522 wdtab[ctrlr].b_active = 1; /* mark controller active */
523 wdc = du->dk_port;
524
525 #ifdef INSTRUMENT
526 /* instrumentation */
527 if (du->dk_unit >= 0 && du->dk_skip == 0) {
528 dk_busy |= 1 << du->dk_lunit;
529 dk_wds[du->dk_lunit] += bp->b_bcount >> 6;
530 }
531 if (du->dk_unit >= 0 && du->dk_skipm == 0) {
532 ++dk_seek[du->dk_lunit];
533 ++dk_xfer[du->dk_lunit];
534 }
535 #endif
536
537 retry:
538 /* if starting a multisector transfer, or doing single transfers */
539 if (du->dk_skipm == 0 || (du->dk_flags & DKFL_SINGLE)) {
540 int command, count;
541
542 if (wdtab[ctrlr].b_errcnt && (bp->b_flags & B_READ) == 0) {
543 du->dk_bc += DEV_BSIZE;
544 du->dk_bct += DEV_BSIZE;
545 }
546
547 #ifdef B_FORMAT
548 if (bp->b_flags & B_FORMAT) {
549 sector = lp->d_gap3;
550 count = lp->d_nsectors;
551 command = WDCC_FORMAT;
552 } else {
553 if (du->dk_flags & DKFL_SINGLE)
554 count = 1;
555 else
556 count = howmany(du->dk_bct, DEV_BSIZE);
557 command =
558 (bp->b_flags & B_READ) ? WDCC_READ : WDCC_WRITE;
559 }
560 #else
561 if (du->dk_flags & DKFL_SINGLE)
562 count = 1;
563 else
564 count = howmany(du->dk_bct, DEV_BSIZE);
565 command = (bp->b_flags & B_READ) ? WDCC_READ : WDCC_WRITE;
566 #endif
567
568 /* initiate command! */
569 if (wdcommand(du, cylin, head, sector, count, command) < 0) {
570 wdreset(du, 1);
571 goto retry;
572 }
573 #ifdef WDDEBUG
574 printf("sector %d cylin %d head %d addr %x sts %x\n", sector,
575 cylin, head, bp->b_un.b_addr, inb(wdc+wd_altsts));
576 #endif
577 }
578
579 du->dk_timeout = 2;
580
581 /* if this is a read operation, just go away until it's done. */
582 if (bp->b_flags & B_READ)
583 return;
584
585 if (wait_for_drq(du) < 0) {
586 wdreset(du, 1);
587 goto retry;
588 }
589
590 /* then send it! */
591 outsw(wdc+wd_data, bp->b_un.b_addr + du->dk_skip * DEV_BSIZE,
592 DEV_BSIZE / sizeof(short));
593
594 du->dk_bc -= DEV_BSIZE;
595 du->dk_bct -= DEV_BSIZE;
596 }
597
598 /* Interrupt routine for the controller. Acknowledge the interrupt, check for
599 * errors on the current operation, mark it done if necessary, and start
600 * the next request. Also check for a partially done transfer, and
601 * continue with the next chunk if so.
602 */
603 void
604 wdintr(ctrlr)
605 int ctrlr;
606 {
607 register struct disk *du;
608 register struct buf *bp, *dp;
609 int stat;
610 u_short wdc;
611
612 /* clear the pending interrupt */
613 (void) inb(wdcontroller[ctrlr].dkc_port+wd_status);
614
615 if (!wdtab[ctrlr].b_active) {
616 printf("wdc%d: extra interrupt\n", ctrlr);
617 return;
618 }
619
620 dp = wdtab[ctrlr].b_forw;
621 bp = dp->b_actf;
622 du = wddrives[WDUNIT(bp->b_dev)];
623 wdc = du->dk_port;
624 du->dk_timeout = 0;
625
626 #ifdef WDDEBUG
627 printf("I%d ", ctrlr);
628 #endif
629
630 stat = wait_for_unbusy(du);
631 if (stat < 0) {
632 printf("wdc%d: timeout waiting for unbusy\n", ctrlr);
633 stat |= WDCS_ERR; /* XXX */
634 }
635
636 /* is it not a transfer, but a control operation? */
637 if (du->dk_state < OPEN) {
638 wdtab[ctrlr].b_active = 0;
639 switch (wdcontrol(bp)) {
640 case -1:
641 goto done;
642 case 1:
643 wdstart(ctrlr);
644 break;
645 }
646 return;
647 }
648
649 /* have we an error? */
650 if (stat & (WDCS_ERR | WDCS_ECCCOR)) {
651 lose:
652 du->dk_status = stat;
653 du->dk_error = inb(wdc+wd_error);
654 #ifdef WDDEBUG
655 printf("stat %x error %x\n", stat, du->dk_error);
656 #endif
657 if ((du->dk_flags & DKFL_SINGLE) == 0) {
658 du->dk_flags |= DKFL_ERROR;
659 goto outt;
660 }
661 #ifdef B_FORMAT
662 if (bp->b_flags & B_FORMAT) {
663 bp->b_error = EIO;
664 bp->b_flags |= B_ERROR;
665 goto done;
666 }
667 #endif
668
669 /* error or error correction? */
670 if (stat & WDCS_ERR) {
671 if (++wdtab[ctrlr].b_errcnt < WDIORETRIES)
672 wdtab[ctrlr].b_active = 0;
673 else {
674 diskerr(bp, "wd", "hard error", LOG_PRINTF,
675 du->dk_skip, &du->dk_dd);
676 #ifdef WDDEBUG
677 printf("wd%d: stat %b error %b\n", du->dk_lunit,
678 stat, WDCS_BITS, inb(wdc+wd_error),
679 WDERR_BITS);
680 #endif
681 bp->b_error = EIO;
682 bp->b_flags |= B_ERROR; /* flag the error */
683 }
684 } else
685 diskerr(bp, "wd", "soft error", 0, du->dk_skip,
686 &du->dk_dd);
687 }
688
689 /*
690 * If this was a successful read operation, fetch the data.
691 */
692 if (((bp->b_flags & (B_READ | B_ERROR)) == B_READ) &&
693 wdtab[ctrlr].b_active) {
694 int chk;
695
696 chk = min(DEV_BSIZE / sizeof(short), du->dk_bc / sizeof(short));
697
698 /* ready to receive data? */
699 if (wait_for_drq(du) < 0) {
700 printf("wdc%d: timeout waiting for drq\n", ctrlr);
701 goto lose;
702 }
703
704 /* suck in data */
705 insw(wdc+wd_data,
706 bp->b_un.b_addr + du->dk_skip * DEV_BSIZE, chk);
707 du->dk_bc -= chk * sizeof(short);
708 du->dk_bct -= chk * sizeof(short);
709
710 /* for obselete fractional sector reads */
711 while (chk++ < (DEV_BSIZE / sizeof(short)))
712 (void) inw(wdc+wd_data);
713 }
714
715 wdxfer[du->dk_lunit]++;
716 outt:
717 if (wdtab[ctrlr].b_active) {
718 #ifdef INSTRUMENT
719 if (du->dk_unit >= 0)
720 dk_busy &= ~(1 << du->dk_unit);
721 #endif
722 if ((bp->b_flags & B_ERROR) == 0) {
723 du->dk_skip++; /* Add to succ. sect */
724 du->dk_skipm++; /* Add to succ. sect for multitransfer */
725 if (wdtab[ctrlr].b_errcnt)
726 diskerr(bp, "wd", "soft error", 0, du->dk_skip,
727 &du->dk_dd);
728 wdtab[ctrlr].b_errcnt = 0;
729
730 /* see if more to transfer */
731 if (du->dk_bc > 0 && (du->dk_flags & DKFL_ERROR) == 0) {
732 wdtab[ctrlr].b_active = 0;
733 wdstart(ctrlr);
734 return; /* next chunk is started */
735 } else if ((du->dk_flags & (DKFL_SINGLE | DKFL_ERROR)) == DKFL_ERROR) {
736 du->dk_skip = 0;
737 du->dk_skipm = 0;
738 du->dk_flags &= ~DKFL_ERROR;
739 du->dk_flags |= DKFL_SINGLE;
740 wdtab[ctrlr].b_active = 0;
741 wdstart(ctrlr);
742 return; /* redo xfer sector by sector */
743 }
744 }
745
746 done:
747 /* done with this transfer, with or without error */
748 du->dk_flags &= ~DKFL_SINGLE;
749 wdtab[ctrlr].b_errcnt = 0;
750 if (du->dk_bct == 0) {
751 wdtab[ctrlr].b_forw = dp->b_forw;
752 du->dk_skipm = 0;
753 dp->b_active = 0;
754 }
755 bp->b_resid = bp->b_bcount - du->dk_skip * DEV_BSIZE;
756 bp->b_flags &= ~B_XXX;
757 du->dk_skip = 0;
758 dp->b_actf = bp->b_actf;
759 dp->b_errcnt = 0;
760 biodone(bp);
761 }
762
763 /* controller now idle */
764 wdtab[ctrlr].b_active = 0;
765
766 /* anything more on drive queue? */
767 if (dp->b_actf && du->dk_bct == 0)
768 wdustart(du);
769
770 /* anything more for controller to do? */
771 if (wdtab[ctrlr].b_forw)
772 wdstart(ctrlr);
773 }
774
775 /*
776 * Initialize a drive.
777 */
778 int
779 wdopen(dev, flag, fmt, p)
780 dev_t dev;
781 int flag;
782 int fmt;
783 struct proc *p;
784 {
785 int lunit;
786 struct disk *du;
787 int part = WDPART(dev), mask = 1 << part;
788 struct partition *pp;
789 char *msg;
790
791 lunit = WDUNIT(dev);
792 if (lunit >= NWD)
793 return ENXIO;
794 du = wddrives[lunit];
795 if (du == 0)
796 return ENXIO;
797
798 if ((du->dk_flags & DKFL_BSDLABEL) == 0) {
799 du->dk_flags |= DKFL_WRITEPROT;
800 wdutab[lunit].b_actf = NULL;
801
802 /*
803 * Use the default sizes until we've read the label,
804 * or longer if there isn't one there.
805 */
806 bzero(&du->dk_dd, sizeof(du->dk_dd));
807 du->dk_dd.d_type = DTYPE_ST506;
808 du->dk_dd.d_ncylinders = 1024;
809 du->dk_dd.d_secsize = DEV_BSIZE;
810 du->dk_dd.d_ntracks = 8;
811 du->dk_dd.d_nsectors = 17;
812 du->dk_dd.d_secpercyl = 17*8;
813 du->dk_dd.d_secperunit = 17*8*1024;
814 du->dk_state = WANTOPEN;
815
816 /* read label using "raw" partition */
817 #ifdef notdef
818 /* wdsetctlr(du); */ /* Maybe do this TIH */
819 msg = readdisklabel(makewddev(major(dev), WDUNIT(dev), WDRAW),
820 wdstrategy, &du->dk_dd, &du->dk_cpd);
821 wdsetctlr(du);
822 #endif
823 if (msg = readdisklabel(makewddev(major(dev), WDUNIT(dev),
824 WDRAW), wdstrategy, &du->dk_dd, &du->dk_cpd)) {
825 log(LOG_WARNING, "wd%d: cannot find label (%s)\n",
826 lunit, msg);
827 if (part != WDRAW)
828 return EINVAL; /* XXX needs translation */
829 } else {
830 wdsetctlr(du);
831 du->dk_flags |= DKFL_BSDLABEL;
832 du->dk_flags &= ~DKFL_WRITEPROT;
833 if (du->dk_dd.d_flags & D_BADSECT)
834 du->dk_flags |= DKFL_BADSECT;
835 }
836 }
837
838 if (du->dk_flags & DKFL_BADSECT)
839 bad144intern(du);
840
841 /*
842 * Warn if a partition is opened that overlaps another partition which
843 * is open unless one is the "raw" partition (whole disk).
844 */
845 if ((du->dk_openpart & mask) == 0 && part != WDRAW) {
846 int start, end;
847
848 pp = &du->dk_dd.d_partitions[part];
849 start = pp->p_offset;
850 end = pp->p_offset + pp->p_size;
851 for (pp = du->dk_dd.d_partitions;
852 pp < &du->dk_dd.d_partitions[du->dk_dd.d_npartitions];
853 pp++) {
854 if (pp->p_offset + pp->p_size <= start ||
855 pp->p_offset >= end)
856 continue;
857 if (pp - du->dk_dd.d_partitions == WDRAW)
858 continue;
859 if (du->dk_openpart & (1 << (pp - du->dk_dd.d_partitions)))
860 log(LOG_WARNING,
861 "wd%d%c: overlaps open partition (%c)\n",
862 lunit, part + 'a',
863 pp - du->dk_dd.d_partitions + 'a');
864 }
865 }
866 if (part >= du->dk_dd.d_npartitions && part != WDRAW)
867 return ENXIO;
868
869 /* insure only one open at a time */
870 du->dk_openpart |= mask;
871 switch (fmt) {
872 case S_IFCHR:
873 du->dk_copenpart |= mask;
874 break;
875 case S_IFBLK:
876 du->dk_bopenpart |= mask;
877 break;
878 }
879
880 return 0;
881 }
882
883 /*
884 * Implement operations other than read/write.
885 * Called from wdstart or wdintr during opens and formats.
886 * Uses finite-state-machine to track progress of operation in progress.
887 * Returns 0 if operation still in progress, 1 if completed.
888 */
889 static int
890 wdcontrol(bp)
891 struct buf *bp;
892 {
893 struct disk *du;
894 int stat;
895 int s, ctrlr;
896 u_short wdc;
897
898 du = wddrives[WDUNIT(bp->b_dev)];
899 ctrlr = du->dk_ctrlr;
900 wdc = du->dk_port;
901
902 switch (du->dk_state) {
903 case WANTOPEN: /* set SDH, step rate, do restore */
904 tryagainrecal:
905 s = splbio(); /* not called from intr level ... */
906 wdgetctlr(du); /* XXX Is this necessary? */
907 wdtab[ctrlr].b_active = 1;
908 if (wdcommand(du, 0, 0, 0, 0, WDCC_RESTORE | WD_STEP) < 0) {
909 wdreset(du, 1);
910 splx(s);
911 goto tryagainrecal;
912 }
913 du->dk_state = RECAL;
914 splx(s);
915 return 0;
916
917 case RECAL:
918 stat = inb(wdc+wd_altsts);
919 if (stat & WDCS_ERR || wdsetctlr(du) < 0) {
920 printf("wd%d: recal failed: stat %b error %b\n",
921 du->dk_lunit, stat, WDCS_BITS, inb(wdc+wd_error),
922 WDERR_BITS);
923 du->dk_state = WANTOPEN;
924 if (++wdtab[ctrlr].b_errcnt < WDIORETRIES)
925 goto tryagainrecal;
926 bp->b_error = ENXIO; /* XXX needs translation */
927 bp->b_flags |= B_ERROR;
928 return -1;
929 }
930 wdtab[ctrlr].b_errcnt = 0;
931 du->dk_state = OPEN;
932 /*
933 * The rest of the initialization can be done
934 * by normal means.
935 */
936 return 1;
937 }
938
939 #ifdef DIAGNOSTIC
940 panic("wdcontrol: impossible");
941 #endif
942 }
943
944 /*
945 * send a command and wait uninterruptibly until controller is finished.
946 * return -1 if controller busy for too long, otherwise
947 * return status. intended for brief controller commands at critical points.
948 * assumes interrupts are blocked.
949 */
950 static int
951 wdcommand(du, cylin, head, sector, count, cmd)
952 struct disk *du;
953 int cylin, head, sector, count;
954 int cmd;
955 {
956 int stat;
957 u_short wdc;
958
959 /* controller ready for command? */
960 if (wait_for_unbusy(du) < 0)
961 return -1;
962
963 /* select drive */
964 wdc = du->dk_port;
965 outb(wdc+wd_sdh, WDSD_IBM | (du->dk_unit << 4) | head);
966 if (cmd == WDCC_DIAGNOSE || cmd == WDCC_IDC)
967 stat = wait_for_unbusy(du);
968 else
969 stat = wdc_wait(du, WDCS_READY);
970 if (stat < 0)
971 return -1;
972
973 /* load parameters */
974 outb(wdc+wd_precomp, du->dk_dd.d_precompcyl / 4);
975 outb(wdc+wd_cyl_lo, cylin);
976 outb(wdc+wd_cyl_hi, cylin >> 8);
977 outb(wdc+wd_sector, sector);
978 outb(wdc+wd_seccnt, count);
979
980 /* send command, await results */
981 outb(wdc+wd_command, cmd);
982
983 switch (cmd) {
984 default:
985 #if 0
986 case WDCC_FORMAT:
987 case WDCC_RESTORE | WD_STEP:
988 case WDCC_DIAGNOSE:
989 #endif
990 return wait_for_unbusy(du);
991 case WDCC_READ:
992 case WDCC_WRITE:
993 return 0;
994 case WDCC_IDC:
995 return wdc_wait(du, WDCS_READY);
996 case WDCC_READP:
997 return wait_for_drq(du);
998 }
999 }
1000
1001 /*
1002 * issue IDC to drive to tell it just what geometry it is to be.
1003 */
1004 static int
1005 wdsetctlr(du)
1006 struct disk *du;
1007 {
1008 int stat, s;
1009
1010 #ifdef WDDEBUG
1011 printf("wd(%d,%d) C%dH%dS%d\n", du->dk_ctrlr, du->dk_unit,
1012 du->dk_dd.d_ncylinders, du->dk_dd.d_ntracks, du->dk_dd.d_nsectors);
1013 #endif
1014
1015 s = splbio();
1016 stat = wdcommand(du, du->dk_dd.d_ncylinders, du->dk_dd.d_ntracks - 1, 0,
1017 du->dk_dd.d_nsectors, WDCC_IDC);
1018 if (stat < 0 || stat & WDCS_ERR) {
1019 printf("wd%d: wdsetctlr: stat %b error %b\n", du->dk_lunit,
1020 stat, WDCS_BITS, inb(du->dk_port+wd_error), WDERR_BITS);
1021 return -1;
1022 }
1023 splx(s);
1024 return 0;
1025 }
1026
1027 /*
1028 * issue READP to drive to ask it what it is.
1029 */
1030 static int
1031 wdgetctlr(du)
1032 struct disk *du;
1033 {
1034 int stat, s, i;
1035 char tb[DEV_BSIZE];
1036 struct wdparams *wp;
1037
1038 s = splbio(); /* not called from intr level ... */
1039
1040 stat = wdcommand(du, 0, 0, 0, 0, WDCC_READP);
1041 if (stat < 0 || stat & WDCS_ERR) {
1042 /*
1043 * If WDCC_READP fails then we might have an old drive
1044 * so we try a seek to 0; if that passes then the
1045 * drive is there but it's OLD AND KRUSTY.
1046 */
1047 stat = wdcommand(du, 0, 0, 0, 0, WDCC_RESTORE | WD_STEP);
1048 if (stat < 0 || stat & WDCS_ERR) {
1049 splx(s);
1050 return -1;
1051 }
1052
1053 strncpy(du->dk_dd.d_typename, "ST506",
1054 sizeof du->dk_dd.d_typename);
1055 strncpy(du->dk_params.wdp_model, "Unknown Type",
1056 sizeof du->dk_params.wdp_model);
1057 du->dk_dd.d_type = DTYPE_ST506;
1058 } else {
1059 /* obtain parameters */
1060 wp = &du->dk_params;
1061 insw(du->dk_port+wd_data, tb, sizeof(tb) / sizeof(short));
1062 bcopy(tb, wp, sizeof(struct wdparams));
1063
1064 /* shuffle string byte order */
1065 for (i = 0; i < sizeof(wp->wdp_model); i += 2) {
1066 u_short *p;
1067 p = (u_short *)(wp->wdp_model + i);
1068 *p = ntohs(*p);
1069 }
1070
1071 strncpy(du->dk_dd.d_typename, "ESDI/IDE",
1072 sizeof du->dk_dd.d_typename);
1073 du->dk_dd.d_type = DTYPE_ESDI;
1074 bcopy(wp->wdp_model+20, du->dk_dd.d_packname, 14-1);
1075
1076 /* update disklabel given drive information */
1077 du->dk_dd.d_ncylinders =
1078 wp->wdp_fixedcyl + wp->wdp_removcyl /*+- 1*/;
1079 du->dk_dd.d_ntracks = wp->wdp_heads;
1080 du->dk_dd.d_nsectors = wp->wdp_sectors;
1081 du->dk_dd.d_secpercyl =
1082 du->dk_dd.d_ntracks * du->dk_dd.d_nsectors;
1083 du->dk_dd.d_partitions[1].p_size =
1084 du->dk_dd.d_secpercyl * wp->wdp_sectors;
1085 du->dk_dd.d_partitions[1].p_offset = 0;
1086 }
1087
1088 #if 0
1089 printf("gc %x cyl %d trk %d sec %d type %d sz %d model %s\n",
1090 wp->wdp_config, wp->wdp_fixedcyl + wp->wdp_removcyl, wp->wdp_heads,
1091 wp->wdp_sectors, wp->wdp_cntype, wp->wdp_cnsbsz, wp->wdp_model);
1092 #endif
1093
1094 /* better ... */
1095 du->dk_dd.d_subtype |= DSTYPE_GEOMETRY;
1096
1097 /* XXX sometimes possibly needed */
1098 (void) inb(du->dk_port+wd_status);
1099 splx(s);
1100 return 0;
1101 }
1102
1103 int
1104 wdclose(dev, flag, fmt)
1105 dev_t dev;
1106 int flag;
1107 int fmt;
1108 {
1109 struct disk *du = wddrives[WDUNIT(dev)];
1110 int part = WDPART(dev), mask = 1 << part;
1111
1112 du->dk_openpart &= ~mask;
1113 switch (fmt) {
1114 case S_IFCHR:
1115 du->dk_copenpart &= ~mask;
1116 break;
1117 case S_IFBLK:
1118 du->dk_bopenpart &= ~mask;
1119 break;
1120 }
1121
1122 return 0;
1123 }
1124
1125 int
1126 wdioctl(dev, cmd, addr, flag, p)
1127 dev_t dev;
1128 int cmd;
1129 caddr_t addr;
1130 int flag;
1131 struct proc *p;
1132 {
1133 int lunit = WDUNIT(dev);
1134 struct disk *du = wddrives[lunit];
1135 int error;
1136
1137 switch (cmd) {
1138 case DIOCSBAD:
1139 if ((flag & FWRITE) == 0)
1140 return EBADF;
1141 du->dk_cpd.bad = *(struct dkbad *)addr;
1142 bad144intern(du);
1143 return 0;
1144
1145 case DIOCGDINFO:
1146 *(struct disklabel *)addr = du->dk_dd;
1147 return 0;
1148
1149 case DIOCGPART:
1150 ((struct partinfo *)addr)->disklab = &du->dk_dd;
1151 ((struct partinfo *)addr)->part =
1152 &du->dk_dd.d_partitions[WDPART(dev)];
1153 return 0;
1154
1155 case DIOCSDINFO:
1156 if ((flag & FWRITE) == 0)
1157 return EBADF;
1158 error = setdisklabel(&du->dk_dd,
1159 (struct disklabel *)addr,
1160 /*(du->dk_flags & DKFL_BSDLABEL) ? du->dk_openpart : */0,
1161 &du->dk_cpd);
1162 if (error == 0) {
1163 du->dk_flags |= DKFL_BSDLABEL;
1164 wdsetctlr(du);
1165 }
1166 return error;
1167
1168 case DIOCWLABEL:
1169 du->dk_flags &= ~DKFL_WRITEPROT;
1170 if ((flag & FWRITE) == 0)
1171 return EBADF;
1172 du->dk_wlabel = *(int *)addr;
1173 return 0;
1174
1175 case DIOCWDINFO:
1176 du->dk_flags &= ~DKFL_WRITEPROT;
1177 if ((flag & FWRITE) == 0)
1178 return EBADF;
1179 error = setdisklabel(&du->dk_dd,
1180 (struct disklabel *)addr,
1181 /*(du->dk_flags & DKFL_BSDLABEL) ? du->dk_openpart :*/0,
1182 &du->dk_cpd);
1183 if (error == 0) {
1184 int wlab;
1185
1186 du->dk_flags |= DKFL_BSDLABEL;
1187 wdsetctlr(du);
1188
1189 /* simulate opening partition 0 so write succeeds */
1190 du->dk_openpart |= (1 << 0); /* XXX */
1191 wlab = du->dk_wlabel;
1192 du->dk_wlabel = 1;
1193 error = writedisklabel(dev, wdstrategy, &du->dk_dd,
1194 &du->dk_cpd);
1195 du->dk_openpart = du->dk_copenpart | du->dk_bopenpart;
1196 du->dk_wlabel = wlab;
1197 }
1198 return error;
1199
1200 #ifdef notyet
1201 case DIOCGDINFOP:
1202 *(struct disklabel **)addr = &du->dk_dd;
1203 return 0;
1204
1205 case DIOCWFORMAT:
1206 if ((flag & FWRITE) == 0)
1207 return EBADF;
1208 {
1209 register struct format_op *fop;
1210 struct iovec aiov;
1211 struct uio auio;
1212
1213 fop = (struct format_op *)addr;
1214 aiov.iov_base = fop->df_buf;
1215 aiov.iov_len = fop->df_count;
1216 auio.uio_iov = &aiov;
1217 auio.uio_iovcnt = 1;
1218 auio.uio_resid = fop->df_count;
1219 auio.uio_segflg = 0;
1220 auio.uio_offset =
1221 fop->df_startblk * du->dk_dd.d_secsize;
1222 error = physio(wdformat, &rwdbuf[lunit], dev, B_WRITE,
1223 minphys, &auio);
1224 fop->df_count -= auio.uio_resid;
1225 fop->df_reg[0] = du->dk_status;
1226 fop->df_reg[1] = du->dk_error;
1227 return error;
1228 }
1229 #endif
1230
1231 default:
1232 return ENOTTY;
1233 }
1234
1235 #ifdef DIAGNOSTIC
1236 panic("wdioctl: impossible");
1237 #endif
1238 }
1239
1240 #ifdef B_FORMAT
1241 int
1242 wdformat(struct buf *bp)
1243 {
1244
1245 bp->b_flags |= B_FORMAT;
1246 return wdstrategy(bp);
1247 }
1248 #endif
1249
1250 int
1251 wdsize(dev)
1252 dev_t dev;
1253 {
1254 int lunit = WDUNIT(dev), part = WDPART(dev);
1255 struct disk *du;
1256
1257 if (lunit >= NWD)
1258 return -1;
1259 du = wddrives[lunit];
1260 if (du == 0)
1261 return -1;
1262
1263 if (du->dk_state < OPEN || (du->dk_flags & DKFL_BSDLABEL) == 0) {
1264 int val;
1265 val = wdopen(makewddev(major(dev), lunit, WDRAW), FREAD,
1266 S_IFBLK, 0);
1267 /* XXX Clear the open flag? */
1268 if (val != 0)
1269 return -1;
1270 }
1271
1272 if ((du->dk_flags & (DKFL_WRITEPROT | DKFL_BSDLABEL)) != DKFL_BSDLABEL)
1273 return -1;
1274
1275 return (int)du->dk_dd.d_partitions[part].p_size;
1276 }
1277
1278 /* dump core after a system crash */
1279 int
1280 wddump(dev)
1281 dev_t dev;
1282 {
1283 register struct disk *du; /* disk unit to do the IO */
1284 long num; /* number of sectors to write */
1285 int ctrlr, lunit, part;
1286 u_short wdc;
1287 long blkoff, blknum;
1288 long cylin, head, sector, stat;
1289 long secpertrk, secpercyl, nblocks;
1290 char *addr;
1291 static wddoingadump = 0;
1292 extern caddr_t CADDR1;
1293 extern struct pte *CMAP1;
1294
1295 addr = (char *)0; /* starting address */
1296
1297 #if DO_NOT_KNOW_HOW
1298 /* toss any characters present prior to dump, ie. non-blocking getc */
1299 while (cngetc())
1300 ;
1301 #endif
1302
1303 /* size of memory to dump */
1304 lunit = WDUNIT(dev);
1305 part = WDPART(dev); /* file system */
1306 /* check for acceptable drive number */
1307 if (lunit >= NWD)
1308 return ENXIO;
1309 du = wddrives[lunit];
1310 /* was it ever initialized ? */
1311 if (du == 0 || du->dk_state < OPEN || du->dk_flags & DKFL_WRITEPROT)
1312 return ENXIO;
1313
1314 wdc = du->dk_port;
1315 ctrlr = du->dk_ctrlr;
1316
1317 /* Convert to disk sectors */
1318 num = ctob(physmem) / du->dk_dd.d_secsize;
1319
1320 secpertrk = du->dk_dd.d_nsectors;
1321 secpercyl = du->dk_dd.d_secpercyl;
1322 nblocks = du->dk_dd.d_partitions[part].p_size;
1323 blkoff = du->dk_dd.d_partitions[part].p_offset;
1324
1325 /*printf("part %x, nblocks %d, dumplo %d, num %d\n", part, nblocks,
1326 dumplo, num);*/
1327
1328 /* check transfer bounds against partition size */
1329 if (dumplo < 0 || dumplo + num > nblocks)
1330 return EINVAL;
1331
1332 /* check if controller active */
1333 /*if (wdtab[ctrlr].b_active)
1334 return EFAULT;*/
1335 if (wddoingadump)
1336 return EFAULT;
1337
1338 /* mark controller active for if we panic during the dump */
1339 /*wdtab[ctrlr].b_active = 1;*/
1340 wddoingadump = 1;
1341
1342 /* Recalibrate. */
1343 if (wdcommand(du, 0, 0, 0, 0, WDCC_RESTORE | WD_STEP) < 0 ||
1344 wdsetctlr(du) < 0)
1345 return EIO;
1346
1347 blknum = dumplo + blkoff;
1348 while (num > 0) {
1349 /* compute disk address */
1350 cylin = blknum / secpercyl;
1351 head = (blknum % secpercyl) / secpertrk;
1352 sector = blknum % secpertrk;
1353
1354 if (du->dk_flags & DKFL_BADSECT) {
1355 long newblk;
1356 int i;
1357
1358 for (i = 0; du->dk_badsect[i] != -1; i++) {
1359 if (blknum < du->dk_badsect[i]) {
1360 /* sorted list, passed our block by */
1361 break;
1362 } else if (blknum == du->dk_badsect[i]) {
1363 newblk = du->dk_dd.d_secperunit -
1364 du->dk_dd.d_nsectors - i - 1;
1365 cylin = newblk / secpercyl;
1366 head = (newblk % secpercyl) / secpertrk;
1367 sector = newblk % secpertrk;
1368 /* found and replaced; done */
1369 break;
1370 }
1371 }
1372 }
1373 sector++; /* origin 1 */
1374
1375 #ifdef notdef
1376 /* lets just talk about this first...*/
1377 printf("cylin %d, head %d, sector %d, addr 0x%x", cylin, head,
1378 sector, addr);
1379 #endif
1380 stat = wdcommand(du, cylin, head, sector, 1, WDCC_WRITE);
1381 if (stat < 0 || stat & WDCS_ERR || wait_for_drq(du) < 0)
1382 return EIO;
1383
1384 #ifdef notdef /* cannot use this since this address was mapped differently */
1385 pmap_enter(kernel_pmap, CADDR1, trunc_page(addr), VM_PROT_READ, TRUE);
1386 #else
1387 *(int *)CMAP1 = PG_V | PG_KW | ctob((long)addr);
1388 tlbflush();
1389 #endif
1390
1391 outsw(wdc+wd_data, CADDR1 + ((int)addr & PGOFSET),
1392 DEV_BSIZE / sizeof(short));
1393
1394 /* Check data request (should be done). */
1395 stat = wait_for_ready(du);
1396 if (stat < 0 || stat & (WDCS_ERR | WDCS_DRQ))
1397 return EIO;
1398
1399 if ((unsigned)addr % 1048576 == 0)
1400 printf("%d ", num / (1048576 / DEV_BSIZE));
1401
1402 /* update block count */
1403 num--;
1404 blknum++;
1405 (int)addr += DEV_BSIZE;
1406
1407 #if DO_NOT_KNOW_HOW
1408 /* operator aborting dump? non-blocking getc() */
1409 if (cngetc())
1410 return EINTR;
1411 #endif
1412 }
1413 return 0;
1414 }
1415
1416 /*
1417 * Internalize the bad sector table.
1418 */
1419 void
1420 bad144intern(du)
1421 struct disk *du;
1422 {
1423 int i;
1424
1425 if ((du->dk_flags & DKFL_BADSECT) == 0)
1426 return;
1427
1428 for (i = 0; i < 127; i++)
1429 du->dk_badsect[i] = -1;
1430 for (i = 0; i < 126; i++) {
1431 if (du->dk_cpd.bad.bt_bad[i].bt_cyl == 0xffff)
1432 break;
1433 du->dk_badsect[i] =
1434 du->dk_cpd.bad.bt_bad[i].bt_cyl * du->dk_dd.d_secpercyl +
1435 (du->dk_cpd.bad.bt_bad[i].bt_trksec >> 8) *
1436 du->dk_dd.d_nsectors +
1437 (du->dk_cpd.bad.bt_bad[i].bt_trksec & 0x00ff);
1438 }
1439 }
1440
1441 static int
1442 wdreset(du, err)
1443 struct disk *du;
1444 int err;
1445 {
1446 int wdc = du->dk_port;
1447 int stat;
1448
1449 if (err)
1450 printf("wdc%d: busy too long, resetting\n", du->dk_ctrlr);
1451
1452 /* reset the device */
1453 outb(wdc+wd_ctlr, WDCTL_RST | WDCTL_IDS);
1454 delay(1000);
1455 outb(wdc+wd_ctlr, WDCTL_IDS);
1456 delay(1000);
1457 (void) inb(wdc+wd_error);
1458 outb(wdc+wd_ctlr, WDCTL_4BIT);
1459
1460 if (wait_for_unbusy(du) < 0)
1461 printf("wdc%d: failed to reset controller\n", du->dk_ctrlr);
1462 }
1463
1464 int
1465 wdc_wait(du, mask)
1466 struct disk *du;
1467 int mask;
1468 {
1469 int wdc = du->dk_port;
1470 int timeout = 0;
1471 int stat;
1472
1473 for (;;) {
1474 stat = inb(wdc+wd_altsts);
1475 if ((stat & WDCS_BUSY) == 0 && (stat & mask) == mask)
1476 break;
1477 if (++timeout > WDCNDELAY)
1478 return -1;
1479 delay(WDCDELAY);
1480 }
1481 #ifdef WDCNDELAY_DEBUG
1482 if (timeout > WDCNDELAY_DEBUG)
1483 printf("wdc%d: timeout took %dus\n", du->dk_ctrlr,
1484 WDCDELAY * timeout);
1485 #endif
1486 return stat;
1487 }
1488
1489 static void
1490 wdtimeout(arg)
1491 caddr_t arg;
1492 {
1493 int s = splbio();
1494 struct disk *du = (void *)arg;
1495
1496 if (du->dk_timeout && --du->dk_timeout == 0) {
1497 int wdc = du->dk_port;
1498
1499 printf("wd%d: lost interrupt: stat %x error %x\n",
1500 du->dk_lunit, inb(wdc+wd_status), inb(wdc+wd_error));
1501 wdreset(du, 0);
1502 /* XXX Need to recalibrate and upload geometry. */
1503 du->dk_skip = 0;
1504 du->dk_flags |= DKFL_SINGLE;
1505 wdstart(du->dk_ctrlr);
1506 }
1507 timeout((timeout_t)wdtimeout, arg, hz);
1508 splx(s);
1509 }
1510
1511 #endif /* NWDC > 0 */
1512