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