wd.c revision 1.362 1 /* $NetBSD: wd.c,v 1.362 2008/05/02 21:11:00 plunky Exp $ */
2
3 /*
4 * Copyright (c) 1998, 2001 Manuel Bouyer. All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * 3. All advertising materials mentioning features or use of this software
15 * must display the following acknowledgement:
16 * This product includes software developed by Manuel Bouyer.
17 * 4. The name of the author may not be used to endorse or promote products
18 * derived from this software without specific prior written permission.
19 *
20 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 /*-
33 * Copyright (c) 1998, 2003, 2004 The NetBSD Foundation, Inc.
34 * All rights reserved.
35 *
36 * This code is derived from software contributed to The NetBSD Foundation
37 * by Charles M. Hannum and by Onno van der Linden.
38 *
39 * Redistribution and use in source and binary forms, with or without
40 * modification, are permitted provided that the following conditions
41 * are met:
42 * 1. Redistributions of source code must retain the above copyright
43 * notice, this list of conditions and the following disclaimer.
44 * 2. Redistributions in binary form must reproduce the above copyright
45 * notice, this list of conditions and the following disclaimer in the
46 * documentation and/or other materials provided with the distribution.
47 *
48 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
49 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
50 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
51 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
52 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
53 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
54 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
55 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
56 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
57 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
58 * POSSIBILITY OF SUCH DAMAGE.
59 */
60
61 #include <sys/cdefs.h>
62 __KERNEL_RCSID(0, "$NetBSD: wd.c,v 1.362 2008/05/02 21:11:00 plunky Exp $");
63
64 #include "opt_ata.h"
65
66 #include "rnd.h"
67
68 #include <sys/param.h>
69 #include <sys/systm.h>
70 #include <sys/kernel.h>
71 #include <sys/conf.h>
72 #include <sys/file.h>
73 #include <sys/stat.h>
74 #include <sys/ioctl.h>
75 #include <sys/buf.h>
76 #include <sys/bufq.h>
77 #include <sys/uio.h>
78 #include <sys/malloc.h>
79 #include <sys/device.h>
80 #include <sys/disklabel.h>
81 #include <sys/disk.h>
82 #include <sys/syslog.h>
83 #include <sys/proc.h>
84 #include <sys/reboot.h>
85 #include <sys/vnode.h>
86 #if NRND > 0
87 #include <sys/rnd.h>
88 #endif
89
90 #include <sys/intr.h>
91 #include <sys/bus.h>
92
93 #include <dev/ata/atareg.h>
94 #include <dev/ata/atavar.h>
95 #include <dev/ata/wdvar.h>
96 #include <dev/ic/wdcreg.h>
97 #include <sys/ataio.h>
98 #include "locators.h"
99
100 #include <prop/proplib.h>
101
102 #define LBA48_THRESHOLD (0xfffffff) /* 128GB / DEV_BSIZE */
103
104 #define WDIORETRIES_SINGLE 4 /* number of retries before single-sector */
105 #define WDIORETRIES 5 /* number of retries before giving up */
106 #define RECOVERYTIME hz/2 /* time to wait before retrying a cmd */
107
108 #define WDUNIT(dev) DISKUNIT(dev)
109 #define WDPART(dev) DISKPART(dev)
110 #define WDMINOR(unit, part) DISKMINOR(unit, part)
111 #define MAKEWDDEV(maj, unit, part) MAKEDISKDEV(maj, unit, part)
112
113 #define WDLABELDEV(dev) (MAKEWDDEV(major(dev), WDUNIT(dev), RAW_PART))
114
115 #define DEBUG_INTR 0x01
116 #define DEBUG_XFERS 0x02
117 #define DEBUG_STATUS 0x04
118 #define DEBUG_FUNCS 0x08
119 #define DEBUG_PROBE 0x10
120 #ifdef ATADEBUG
121 int wdcdebug_wd_mask = 0x0;
122 #define ATADEBUG_PRINT(args, level) \
123 if (wdcdebug_wd_mask & (level)) \
124 printf args
125 #else
126 #define ATADEBUG_PRINT(args, level)
127 #endif
128
129 int wdprobe(struct device *, struct cfdata *, void *);
130 void wdattach(struct device *, struct device *, void *);
131 int wddetach(struct device *, int);
132 int wdactivate(struct device *, enum devact);
133 int wdprint(void *, char *);
134 void wdperror(const struct wd_softc *);
135
136 static bool wd_suspend(device_t PMF_FN_PROTO);
137 static int wd_standby(struct wd_softc *, int);
138
139 CFATTACH_DECL_NEW(wd, sizeof(struct wd_softc),
140 wdprobe, wdattach, wddetach, wdactivate);
141
142 extern struct cfdriver wd_cd;
143
144 dev_type_open(wdopen);
145 dev_type_close(wdclose);
146 dev_type_read(wdread);
147 dev_type_write(wdwrite);
148 dev_type_ioctl(wdioctl);
149 dev_type_strategy(wdstrategy);
150 dev_type_dump(wddump);
151 dev_type_size(wdsize);
152
153 const struct bdevsw wd_bdevsw = {
154 wdopen, wdclose, wdstrategy, wdioctl, wddump, wdsize, D_DISK
155 };
156
157 const struct cdevsw wd_cdevsw = {
158 wdopen, wdclose, wdread, wdwrite, wdioctl,
159 nostop, notty, nopoll, nommap, nokqfilter, D_DISK
160 };
161
162 /*
163 * Glue necessary to hook WDCIOCCOMMAND into physio
164 */
165
166 struct wd_ioctl {
167 LIST_ENTRY(wd_ioctl) wi_list;
168 struct buf wi_bp;
169 struct uio wi_uio;
170 struct iovec wi_iov;
171 atareq_t wi_atareq;
172 struct wd_softc *wi_softc;
173 };
174
175 LIST_HEAD(, wd_ioctl) wi_head;
176
177 struct wd_ioctl *wi_find(struct buf *);
178 void wi_free(struct wd_ioctl *);
179 struct wd_ioctl *wi_get(void);
180 void wdioctlstrategy(struct buf *);
181
182 void wdgetdefaultlabel(struct wd_softc *, struct disklabel *);
183 void wdgetdisklabel(struct wd_softc *);
184 void wdstart(void *);
185 void __wdstart(struct wd_softc*, struct buf *);
186 void wdrestart(void *);
187 void wddone(void *);
188 int wd_get_params(struct wd_softc *, u_int8_t, struct ataparams *);
189 int wd_flushcache(struct wd_softc *, int);
190 bool wd_shutdown(device_t, int);
191
192 int wd_getcache(struct wd_softc *, int *);
193 int wd_setcache(struct wd_softc *, int);
194
195 struct dkdriver wddkdriver = { wdstrategy, minphys };
196
197 #ifdef HAS_BAD144_HANDLING
198 static void bad144intern(struct wd_softc *);
199 #endif
200
201 #define WD_QUIRK_SPLIT_MOD15_WRITE 0x0001 /* must split certain writes */
202 #define WD_QUIRK_FORCE_LBA48 0x0002 /* must use LBA48 commands */
203
204 #define WD_QUIRK_FMT "\20\1SPLIT_MOD15_WRITE\2FORCE_LBA48"
205
206 /*
207 * Quirk table for IDE drives. Put more-specific matches first, since
208 * a simple globbing routine is used for matching.
209 */
210 static const struct wd_quirk {
211 const char *wdq_match; /* inquiry pattern to match */
212 int wdq_quirks; /* drive quirks */
213 } wd_quirk_table[] = {
214 /*
215 * Some Seagate S-ATA drives have a PHY which can get confused
216 * with the way data is packetized by some S-ATA controllers.
217 *
218 * The work-around is to split in two any write transfer whose
219 * sector count % 15 == 1 (assuming 512 byte sectors).
220 *
221 * XXX This is an incomplete list. There are at least a couple
222 * XXX more model numbers. If you have trouble with such transfers
223 * XXX (8K is the most common) on Seagate S-ATA drives, please
224 * XXX notify thorpej (at) NetBSD.org.
225 */
226 { "ST3120023AS",
227 WD_QUIRK_SPLIT_MOD15_WRITE },
228 { "ST380023AS",
229 WD_QUIRK_SPLIT_MOD15_WRITE },
230
231 /*
232 * These seagate drives seems to have issue addressing sector 0xfffffff
233 * (aka LBA48_THRESHOLD) in LBA mode. The workaround is to force
234 * LBA48
235 * Note that we can't just change the code to always use LBA48 for
236 * sector 0xfffffff, because this would break valid and working
237 * setups using LBA48 drives on non-LBA48-capable controllers
238 * (and it's hard to get a list of such controllers)
239 */
240 { "ST3160021A*",
241 WD_QUIRK_FORCE_LBA48 },
242 { "ST3160811A*",
243 WD_QUIRK_FORCE_LBA48 },
244 { "ST3160812A*",
245 WD_QUIRK_FORCE_LBA48 },
246 { "ST3160023A*",
247 WD_QUIRK_FORCE_LBA48 },
248 { "ST3160827A*",
249 WD_QUIRK_FORCE_LBA48 },
250 /* Attempt to catch all seagate drives larger than 200GB */
251 { "ST3[2-9][0-9][0-9][0-9][0-9][0-9][A-Z]*",
252 WD_QUIRK_FORCE_LBA48 },
253 { "ST3[1-9][0-9][0-9][0-9][0-9][0-9][0-9][A-Z]*",
254 WD_QUIRK_FORCE_LBA48 },
255 { NULL,
256 0 }
257 };
258
259 static const struct wd_quirk *
260 wd_lookup_quirks(const char *name)
261 {
262 const struct wd_quirk *wdq;
263 const char *estr;
264
265 for (wdq = wd_quirk_table; wdq->wdq_match != NULL; wdq++) {
266 /*
267 * We only want exact matches (which include matches
268 * against globbing characters).
269 */
270 if (pmatch(name, wdq->wdq_match, &estr) == 2)
271 return (wdq);
272 }
273 return (NULL);
274 }
275
276 int
277 wdprobe(struct device *parent, struct cfdata *match, void *aux)
278 {
279 struct ata_device *adev = aux;
280
281 if (adev == NULL)
282 return 0;
283 if (adev->adev_bustype->bustype_type != SCSIPI_BUSTYPE_ATA)
284 return 0;
285
286 if (match->cf_loc[ATA_HLCF_DRIVE] != ATA_HLCF_DRIVE_DEFAULT &&
287 match->cf_loc[ATA_HLCF_DRIVE] != adev->adev_drv_data->drive)
288 return 0;
289 return 1;
290 }
291
292 void
293 wdattach(struct device *parent, struct device *self, void *aux)
294 {
295 struct wd_softc *wd = device_private(self);
296 struct ata_device *adev= aux;
297 int i, blank;
298 char tbuf[41], pbuf[9], c, *p, *q;
299 const struct wd_quirk *wdq;
300
301 wd->sc_dev = self;
302
303 ATADEBUG_PRINT(("wdattach\n"), DEBUG_FUNCS | DEBUG_PROBE);
304 callout_init(&wd->sc_restart_ch, 0);
305 bufq_alloc(&wd->sc_q, BUFQ_DISK_DEFAULT_STRAT, BUFQ_SORT_RAWBLOCK);
306 #ifdef WD_SOFTBADSECT
307 SLIST_INIT(&wd->sc_bslist);
308 #endif
309 wd->atabus = adev->adev_bustype;
310 wd->openings = adev->adev_openings;
311 wd->drvp = adev->adev_drv_data;
312
313 wd->drvp->drv_done = wddone;
314 wd->drvp->drv_softc = wd->sc_dev;
315
316 aprint_naive("\n");
317
318 /* read our drive info */
319 if (wd_get_params(wd, AT_WAIT, &wd->sc_params) != 0) {
320 aprint_error("\n%s: IDENTIFY failed\n", device_xname(self));
321 return;
322 }
323
324 for (blank = 0, p = wd->sc_params.atap_model, q = tbuf, i = 0;
325 i < sizeof(wd->sc_params.atap_model); i++) {
326 c = *p++;
327 if (c == '\0')
328 break;
329 if (c != ' ') {
330 if (blank) {
331 *q++ = ' ';
332 blank = 0;
333 }
334 *q++ = c;
335 } else
336 blank = 1;
337 }
338 *q++ = '\0';
339
340 aprint_normal(": <%s>\n", tbuf);
341
342 wdq = wd_lookup_quirks(tbuf);
343 if (wdq != NULL)
344 wd->sc_quirks = wdq->wdq_quirks;
345
346 if (wd->sc_quirks != 0) {
347 char sbuf[sizeof(WD_QUIRK_FMT) + 64];
348 bitmask_snprintf(wd->sc_quirks, WD_QUIRK_FMT,
349 sbuf, sizeof(sbuf));
350 aprint_normal_dev(self, "quirks %s\n", sbuf);
351 }
352
353 if ((wd->sc_params.atap_multi & 0xff) > 1) {
354 wd->sc_multi = wd->sc_params.atap_multi & 0xff;
355 } else {
356 wd->sc_multi = 1;
357 }
358
359 aprint_verbose_dev(self, "drive supports %d-sector PIO transfers,",
360 wd->sc_multi);
361
362 /* 48-bit LBA addressing */
363 if ((wd->sc_params.atap_cmd2_en & ATA_CMD2_LBA48) != 0)
364 wd->sc_flags |= WDF_LBA48;
365
366 /* Prior to ATA-4, LBA was optional. */
367 if ((wd->sc_params.atap_capabilities1 & WDC_CAP_LBA) != 0)
368 wd->sc_flags |= WDF_LBA;
369 #if 0
370 /* ATA-4 requires LBA. */
371 if (wd->sc_params.atap_ataversion != 0xffff &&
372 wd->sc_params.atap_ataversion >= WDC_VER_ATA4)
373 wd->sc_flags |= WDF_LBA;
374 #endif
375
376 if ((wd->sc_flags & WDF_LBA48) != 0) {
377 aprint_verbose(" LBA48 addressing\n");
378 wd->sc_capacity =
379 ((u_int64_t) wd->sc_params.__reserved6[11] << 48) |
380 ((u_int64_t) wd->sc_params.__reserved6[10] << 32) |
381 ((u_int64_t) wd->sc_params.__reserved6[9] << 16) |
382 ((u_int64_t) wd->sc_params.__reserved6[8] << 0);
383 } else if ((wd->sc_flags & WDF_LBA) != 0) {
384 aprint_verbose(" LBA addressing\n");
385 wd->sc_capacity =
386 ((u_int64_t)wd->sc_params.atap_capacity[1] << 16) |
387 wd->sc_params.atap_capacity[0];
388 } else {
389 aprint_verbose(" chs addressing\n");
390 wd->sc_capacity =
391 wd->sc_params.atap_cylinders *
392 wd->sc_params.atap_heads *
393 wd->sc_params.atap_sectors;
394 }
395 format_bytes(pbuf, sizeof(pbuf), wd->sc_capacity * DEV_BSIZE);
396 aprint_normal_dev(self, "%s, %d cyl, %d head, %d sec, "
397 "%d bytes/sect x %llu sectors\n",
398 pbuf,
399 (wd->sc_flags & WDF_LBA) ? (int)(wd->sc_capacity /
400 (wd->sc_params.atap_heads * wd->sc_params.atap_sectors)) :
401 wd->sc_params.atap_cylinders,
402 wd->sc_params.atap_heads, wd->sc_params.atap_sectors,
403 DEV_BSIZE, (unsigned long long)wd->sc_capacity);
404
405 ATADEBUG_PRINT(("%s: atap_dmatiming_mimi=%d, atap_dmatiming_recom=%d\n",
406 device_xname(self), wd->sc_params.atap_dmatiming_mimi,
407 wd->sc_params.atap_dmatiming_recom), DEBUG_PROBE);
408 /*
409 * Initialize and attach the disk structure.
410 */
411 /* we fill in dk_info later */
412 disk_init(&wd->sc_dk, device_xname(wd->sc_dev), &wddkdriver);
413 disk_attach(&wd->sc_dk);
414 wd->sc_wdc_bio.lp = wd->sc_dk.dk_label;
415 #if NRND > 0
416 rnd_attach_source(&wd->rnd_source, device_xname(wd->sc_dev),
417 RND_TYPE_DISK, 0);
418 #endif
419
420 /* Discover wedges on this disk. */
421 dkwedge_discover(&wd->sc_dk);
422
423 if (!pmf_device_register1(self, wd_suspend, NULL, wd_shutdown))
424 aprint_error_dev(self, "couldn't establish power handler\n");
425 }
426
427 static bool
428 wd_suspend(device_t dv PMF_FN_ARGS)
429 {
430 struct wd_softc *sc = device_private(dv);
431
432 wd_flushcache(sc, AT_WAIT);
433 wd_standby(sc, AT_WAIT);
434 return true;
435 }
436
437 int
438 wdactivate(struct device *self, enum devact act)
439 {
440 int rv = 0;
441
442 switch (act) {
443 case DVACT_ACTIVATE:
444 rv = EOPNOTSUPP;
445 break;
446
447 case DVACT_DEACTIVATE:
448 /*
449 * Nothing to do; we key off the device's DVF_ACTIVATE.
450 */
451 break;
452 }
453 return (rv);
454 }
455
456 int
457 wddetach(struct device *self, int flags)
458 {
459 struct wd_softc *sc = device_private(self);
460 int s, bmaj, cmaj, i, mn;
461
462 /* locate the major number */
463 bmaj = bdevsw_lookup_major(&wd_bdevsw);
464 cmaj = cdevsw_lookup_major(&wd_cdevsw);
465
466 /* Nuke the vnodes for any open instances. */
467 for (i = 0; i < MAXPARTITIONS; i++) {
468 mn = WDMINOR(device_unit(self), i);
469 vdevgone(bmaj, mn, mn, VBLK);
470 vdevgone(cmaj, mn, mn, VCHR);
471 }
472
473 /* Delete all of our wedges. */
474 dkwedge_delall(&sc->sc_dk);
475
476 s = splbio();
477
478 /* Kill off any queued buffers. */
479 bufq_drain(sc->sc_q);
480
481 bufq_free(sc->sc_q);
482 sc->atabus->ata_killpending(sc->drvp);
483
484 splx(s);
485
486 /* Detach disk. */
487 disk_detach(&sc->sc_dk);
488 disk_destroy(&sc->sc_dk);
489
490 #ifdef WD_SOFTBADSECT
491 /* Clean out the bad sector list */
492 while (!SLIST_EMPTY(&sc->sc_bslist)) {
493 void *head = SLIST_FIRST(&sc->sc_bslist);
494 SLIST_REMOVE_HEAD(&sc->sc_bslist, dbs_next);
495 free(head, M_TEMP);
496 }
497 sc->sc_bscount = 0;
498 #endif
499
500 pmf_device_deregister(self);
501
502 #if NRND > 0
503 /* Unhook the entropy source. */
504 rnd_detach_source(&sc->rnd_source);
505 #endif
506
507 sc->drvp->drive_flags = 0; /* no drive any more here */
508
509 return (0);
510 }
511
512 /*
513 * Read/write routine for a buffer. Validates the arguments and schedules the
514 * transfer. Does not wait for the transfer to complete.
515 */
516 void
517 wdstrategy(struct buf *bp)
518 {
519 struct wd_softc *wd =
520 device_private(device_lookup(&wd_cd, WDUNIT(bp->b_dev)));
521 struct disklabel *lp = wd->sc_dk.dk_label;
522 daddr_t blkno;
523 int s;
524
525 ATADEBUG_PRINT(("wdstrategy (%s)\n", device_xname(wd->sc_dev)),
526 DEBUG_XFERS);
527
528 /* Valid request? */
529 if (bp->b_blkno < 0 ||
530 (bp->b_bcount % lp->d_secsize) != 0 ||
531 (bp->b_bcount / lp->d_secsize) >= (1 << NBBY)) {
532 bp->b_error = EINVAL;
533 goto done;
534 }
535
536 /* If device invalidated (e.g. media change, door open), error. */
537 if ((wd->sc_flags & WDF_LOADED) == 0) {
538 bp->b_error = EIO;
539 goto done;
540 }
541
542 /* If it's a null transfer, return immediately. */
543 if (bp->b_bcount == 0)
544 goto done;
545
546 /*
547 * Do bounds checking, adjust transfer. if error, process.
548 * If end of partition, just return.
549 */
550 if (WDPART(bp->b_dev) == RAW_PART) {
551 if (bounds_check_with_mediasize(bp, DEV_BSIZE,
552 wd->sc_capacity) <= 0)
553 goto done;
554 } else {
555 if (bounds_check_with_label(&wd->sc_dk, bp,
556 (wd->sc_flags & (WDF_WLABEL|WDF_LABELLING)) != 0) <= 0)
557 goto done;
558 }
559
560 /*
561 * Now convert the block number to absolute and put it in
562 * terms of the device's logical block size.
563 */
564 if (lp->d_secsize >= DEV_BSIZE)
565 blkno = bp->b_blkno / (lp->d_secsize / DEV_BSIZE);
566 else
567 blkno = bp->b_blkno * (DEV_BSIZE / lp->d_secsize);
568
569 if (WDPART(bp->b_dev) != RAW_PART)
570 blkno += lp->d_partitions[WDPART(bp->b_dev)].p_offset;
571
572 bp->b_rawblkno = blkno;
573
574 #ifdef WD_SOFTBADSECT
575 /*
576 * If the transfer about to be attempted contains only a block that
577 * is known to be bad then return an error for the transfer without
578 * even attempting to start a transfer up under the premis that we
579 * will just end up doing more retries for a transfer that will end
580 * up failing again.
581 * XXX:SMP - mutex required to protect with DIOCBSFLUSH
582 */
583 if (__predict_false(!SLIST_EMPTY(&wd->sc_bslist))) {
584 struct disk_badsectors *dbs;
585 daddr_t maxblk = blkno + (bp->b_bcount >> DEV_BSHIFT) - 1;
586
587 SLIST_FOREACH(dbs, &wd->sc_bslist, dbs_next)
588 if ((dbs->dbs_min <= blkno && blkno <= dbs->dbs_max) ||
589 (dbs->dbs_min <= maxblk && maxblk <= dbs->dbs_max)){
590 bp->b_error = EIO;
591 goto done;
592 }
593 }
594 #endif
595
596 /* Queue transfer on drive, activate drive and controller if idle. */
597 s = splbio();
598 BUFQ_PUT(wd->sc_q, bp);
599 wdstart(wd);
600 splx(s);
601 return;
602 done:
603 /* Toss transfer; we're done early. */
604 bp->b_resid = bp->b_bcount;
605 biodone(bp);
606 }
607
608 /*
609 * Queue a drive for I/O.
610 */
611 void
612 wdstart(void *arg)
613 {
614 struct wd_softc *wd = arg;
615 struct buf *bp = NULL;
616
617 ATADEBUG_PRINT(("wdstart %s\n", device_xname(wd->sc_dev)),
618 DEBUG_XFERS);
619 while (wd->openings > 0) {
620
621 /* Is there a buf for us ? */
622 if ((bp = BUFQ_GET(wd->sc_q)) == NULL)
623 return;
624
625 /*
626 * Make the command. First lock the device
627 */
628 wd->openings--;
629
630 wd->retries = 0;
631 __wdstart(wd, bp);
632 }
633 }
634
635 static void
636 wd_split_mod15_write(struct buf *bp)
637 {
638 struct buf *obp = bp->b_private;
639 struct wd_softc *sc =
640 device_private(wd_cd.cd_devs[DISKUNIT(obp->b_dev)]);
641
642 if (__predict_false(bp->b_error != 0)) {
643 /*
644 * Propagate the error. If this was the first half of
645 * the original transfer, make sure to account for that
646 * in the residual.
647 */
648 if (bp->b_data == obp->b_data)
649 bp->b_resid += bp->b_bcount;
650 goto done;
651 }
652
653 /*
654 * If this was the second half of the transfer, we're all done!
655 */
656 if (bp->b_data != obp->b_data)
657 goto done;
658
659 /*
660 * Advance the pointer to the second half and issue that command
661 * using the same opening.
662 */
663 bp->b_flags = obp->b_flags;
664 bp->b_oflags = obp->b_oflags;
665 bp->b_cflags = obp->b_cflags;
666 bp->b_data = (char *)bp->b_data + bp->b_bcount;
667 bp->b_blkno += (bp->b_bcount / 512);
668 bp->b_rawblkno += (bp->b_bcount / 512);
669 __wdstart(sc, bp);
670 return;
671
672 done:
673 obp->b_error = bp->b_error;
674 obp->b_resid = bp->b_resid;
675 putiobuf(bp);
676 biodone(obp);
677 sc->openings++;
678 /* wddone() will call wdstart() */
679 }
680
681 void
682 __wdstart(struct wd_softc *wd, struct buf *bp)
683 {
684
685 /*
686 * Deal with the "split mod15 write" quirk. We just divide the
687 * transfer in two, doing the first half and then then second half
688 * with the same command opening.
689 *
690 * Note we MUST do this here, because we can't let insertion
691 * into the bufq cause the transfers to be re-merged.
692 */
693 if (__predict_false((wd->sc_quirks & WD_QUIRK_SPLIT_MOD15_WRITE) != 0 &&
694 (bp->b_flags & B_READ) == 0 &&
695 bp->b_bcount > 512 &&
696 ((bp->b_bcount / 512) % 15) == 1)) {
697 struct buf *nbp;
698
699 /* already at splbio */
700 nbp = getiobuf(NULL, false);
701 if (__predict_false(nbp == NULL)) {
702 /* No memory -- fail the iop. */
703 bp->b_error = ENOMEM;
704 bp->b_resid = bp->b_bcount;
705 biodone(bp);
706 wd->openings++;
707 return;
708 }
709
710 nbp->b_error = 0;
711 nbp->b_proc = bp->b_proc;
712 nbp->b_dev = bp->b_dev;
713
714 nbp->b_bcount = bp->b_bcount / 2;
715 nbp->b_bufsize = bp->b_bcount / 2;
716 nbp->b_data = bp->b_data;
717
718 nbp->b_blkno = bp->b_blkno;
719 nbp->b_rawblkno = bp->b_rawblkno;
720
721 nbp->b_flags = bp->b_flags;
722 nbp->b_oflags = bp->b_oflags;
723 nbp->b_cflags = bp->b_cflags;
724 nbp->b_iodone = wd_split_mod15_write;
725
726 /* Put ptr to orig buf in b_private and use new buf */
727 nbp->b_private = bp;
728
729 BIO_COPYPRIO(nbp, bp);
730
731 bp = nbp;
732 }
733
734 wd->sc_wdc_bio.blkno = bp->b_rawblkno;
735 wd->sc_wdc_bio.blkdone =0;
736 wd->sc_bp = bp;
737 /*
738 * If we're retrying, retry in single-sector mode. This will give us
739 * the sector number of the problem, and will eventually allow the
740 * transfer to succeed.
741 */
742 if (wd->retries >= WDIORETRIES_SINGLE)
743 wd->sc_wdc_bio.flags = ATA_SINGLE;
744 else
745 wd->sc_wdc_bio.flags = 0;
746 if (wd->sc_flags & WDF_LBA48 &&
747 (wd->sc_wdc_bio.blkno > LBA48_THRESHOLD ||
748 (wd->sc_quirks & WD_QUIRK_FORCE_LBA48) != 0))
749 wd->sc_wdc_bio.flags |= ATA_LBA48;
750 if (wd->sc_flags & WDF_LBA)
751 wd->sc_wdc_bio.flags |= ATA_LBA;
752 if (bp->b_flags & B_READ)
753 wd->sc_wdc_bio.flags |= ATA_READ;
754 wd->sc_wdc_bio.bcount = bp->b_bcount;
755 wd->sc_wdc_bio.databuf = bp->b_data;
756 /* Instrumentation. */
757 disk_busy(&wd->sc_dk);
758 switch (wd->atabus->ata_bio(wd->drvp, &wd->sc_wdc_bio)) {
759 case ATACMD_TRY_AGAIN:
760 callout_reset(&wd->sc_restart_ch, hz, wdrestart, wd);
761 break;
762 case ATACMD_QUEUED:
763 case ATACMD_COMPLETE:
764 break;
765 default:
766 panic("__wdstart: bad return code from ata_bio()");
767 }
768 }
769
770 void
771 wddone(void *v)
772 {
773 struct wd_softc *wd = device_private(v);
774 struct buf *bp = wd->sc_bp;
775 const char *errmsg;
776 int do_perror = 0;
777 int nblks;
778
779 ATADEBUG_PRINT(("wddone %s\n", device_xname(wd->sc_dev)),
780 DEBUG_XFERS);
781 if (bp == NULL)
782 return;
783 bp->b_resid = wd->sc_wdc_bio.bcount;
784 switch (wd->sc_wdc_bio.error) {
785 case ERR_DMA:
786 errmsg = "DMA error";
787 goto retry;
788 case ERR_DF:
789 errmsg = "device fault";
790 goto retry;
791 case TIMEOUT:
792 errmsg = "device timeout";
793 goto retry;
794 case ERR_RESET:
795 errmsg = "channel reset";
796 goto retry2;
797 case ERROR:
798 /* Don't care about media change bits */
799 if (wd->sc_wdc_bio.r_error != 0 &&
800 (wd->sc_wdc_bio.r_error & ~(WDCE_MC | WDCE_MCR)) == 0)
801 goto noerror;
802 errmsg = "error";
803 do_perror = 1;
804 if ((wd->sc_wdc_bio.r_error & (WDCE_IDNF | WDCE_ABRT)) &&
805 (wd->sc_quirks & WD_QUIRK_FORCE_LBA48) == 0) {
806 nblks = wd->sc_wdc_bio.bcount /
807 wd->sc_dk.dk_label->d_secsize;
808 /*
809 * If we get a "id not found" when crossing the
810 * LBA48_THRESHOLD, and the drive is larger than
811 * 128GB, then we can assume the drive has the
812 * LBA48 bug and we switch to LBA48.
813 */
814 if (wd->sc_wdc_bio.blkno <= LBA48_THRESHOLD &&
815 wd->sc_wdc_bio.blkno + nblks > LBA48_THRESHOLD &&
816 wd->sc_capacity > LBA48_THRESHOLD + 1) {
817 errmsg = "LBA48 bug";
818 wd->sc_quirks |= WD_QUIRK_FORCE_LBA48;
819 do_perror = 0;
820 goto retry2;
821 }
822 }
823 retry: /* Just reset and retry. Can we do more ? */
824 (*wd->atabus->ata_reset_drive)(wd->drvp, AT_RST_NOCMD);
825 retry2:
826 diskerr(bp, "wd", errmsg, LOG_PRINTF,
827 wd->sc_wdc_bio.blkdone, wd->sc_dk.dk_label);
828 if (wd->retries < WDIORETRIES)
829 printf(", retrying");
830 printf("\n");
831 if (do_perror)
832 wdperror(wd);
833 if (wd->retries < WDIORETRIES) {
834 wd->retries++;
835 callout_reset(&wd->sc_restart_ch, RECOVERYTIME,
836 wdrestart, wd);
837 return;
838 }
839
840 #ifdef WD_SOFTBADSECT
841 /*
842 * Not all errors indicate a failed block but those that do,
843 * put the block on the bad-block list for the device. Only
844 * do this for reads because the drive should do it for writes,
845 * itself, according to Manuel.
846 */
847 if ((bp->b_flags & B_READ) &&
848 ((wd->drvp->ata_vers >= 4 && wd->sc_wdc_bio.r_error & 64) ||
849 (wd->drvp->ata_vers < 4 && wd->sc_wdc_bio.r_error & 192))) {
850 struct disk_badsectors *dbs;
851
852 dbs = malloc(sizeof *dbs, M_TEMP, M_WAITOK);
853 dbs->dbs_min = bp->b_rawblkno;
854 dbs->dbs_max = dbs->dbs_min + (bp->b_bcount >> DEV_BSHIFT) - 1;
855 microtime(&dbs->dbs_failedat);
856 SLIST_INSERT_HEAD(&wd->sc_bslist, dbs, dbs_next);
857 wd->sc_bscount++;
858 }
859 #endif
860 bp->b_error = EIO;
861 break;
862 case NOERROR:
863 noerror: if ((wd->sc_wdc_bio.flags & ATA_CORR) || wd->retries > 0)
864 aprint_error_dev(wd->sc_dev,
865 "soft error (corrected)\n");
866 break;
867 case ERR_NODEV:
868 bp->b_error = EIO;
869 break;
870 }
871 disk_unbusy(&wd->sc_dk, (bp->b_bcount - bp->b_resid),
872 (bp->b_flags & B_READ));
873 #if NRND > 0
874 rnd_add_uint32(&wd->rnd_source, bp->b_blkno);
875 #endif
876 /* XXX Yuck, but we don't want to increment openings in this case */
877 if (__predict_false(bp->b_iodone == wd_split_mod15_write))
878 biodone(bp);
879 else {
880 biodone(bp);
881 wd->openings++;
882 }
883 wdstart(wd);
884 }
885
886 void
887 wdrestart(void *v)
888 {
889 struct wd_softc *wd = v;
890 struct buf *bp = wd->sc_bp;
891 int s;
892
893 ATADEBUG_PRINT(("wdrestart %s\n", device_xname(wd->sc_dev)),
894 DEBUG_XFERS);
895 s = splbio();
896 __wdstart(v, bp);
897 splx(s);
898 }
899
900 int
901 wdread(dev_t dev, struct uio *uio, int flags)
902 {
903
904 ATADEBUG_PRINT(("wdread\n"), DEBUG_XFERS);
905 return (physio(wdstrategy, NULL, dev, B_READ, minphys, uio));
906 }
907
908 int
909 wdwrite(dev_t dev, struct uio *uio, int flags)
910 {
911
912 ATADEBUG_PRINT(("wdwrite\n"), DEBUG_XFERS);
913 return (physio(wdstrategy, NULL, dev, B_WRITE, minphys, uio));
914 }
915
916 int
917 wdopen(dev_t dev, int flag, int fmt, struct lwp *l)
918 {
919 struct wd_softc *wd;
920 int part, error;
921
922 ATADEBUG_PRINT(("wdopen\n"), DEBUG_FUNCS);
923 wd = device_private(device_lookup(&wd_cd, WDUNIT(dev)));
924 if (wd == NULL)
925 return (ENXIO);
926
927 if (! device_is_active(wd->sc_dev))
928 return (ENODEV);
929
930 part = WDPART(dev);
931
932 mutex_enter(&wd->sc_dk.dk_openlock);
933
934 /*
935 * If there are wedges, and this is not RAW_PART, then we
936 * need to fail.
937 */
938 if (wd->sc_dk.dk_nwedges != 0 && part != RAW_PART) {
939 error = EBUSY;
940 goto bad1;
941 }
942
943 /*
944 * If this is the first open of this device, add a reference
945 * to the adapter.
946 */
947 if (wd->sc_dk.dk_openmask == 0 &&
948 (error = wd->atabus->ata_addref(wd->drvp)) != 0)
949 goto bad1;
950
951 if (wd->sc_dk.dk_openmask != 0) {
952 /*
953 * If any partition is open, but the disk has been invalidated,
954 * disallow further opens.
955 */
956 if ((wd->sc_flags & WDF_LOADED) == 0) {
957 error = EIO;
958 goto bad2;
959 }
960 } else {
961 if ((wd->sc_flags & WDF_LOADED) == 0) {
962 wd->sc_flags |= WDF_LOADED;
963
964 /* Load the physical device parameters. */
965 wd_get_params(wd, AT_WAIT, &wd->sc_params);
966
967 /* Load the partition info if not already loaded. */
968 wdgetdisklabel(wd);
969 }
970 }
971
972 /* Check that the partition exists. */
973 if (part != RAW_PART &&
974 (part >= wd->sc_dk.dk_label->d_npartitions ||
975 wd->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) {
976 error = ENXIO;
977 goto bad2;
978 }
979
980 /* Insure only one open at a time. */
981 switch (fmt) {
982 case S_IFCHR:
983 wd->sc_dk.dk_copenmask |= (1 << part);
984 break;
985 case S_IFBLK:
986 wd->sc_dk.dk_bopenmask |= (1 << part);
987 break;
988 }
989 wd->sc_dk.dk_openmask =
990 wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
991
992 mutex_exit(&wd->sc_dk.dk_openlock);
993 return 0;
994
995 bad2:
996 if (wd->sc_dk.dk_openmask == 0)
997 wd->atabus->ata_delref(wd->drvp);
998 bad1:
999 mutex_exit(&wd->sc_dk.dk_openlock);
1000 return error;
1001 }
1002
1003 int
1004 wdclose(dev_t dev, int flag, int fmt, struct lwp *l)
1005 {
1006 struct wd_softc *wd =
1007 device_private(device_lookup(&wd_cd, WDUNIT(dev)));
1008 int part = WDPART(dev);
1009
1010 ATADEBUG_PRINT(("wdclose\n"), DEBUG_FUNCS);
1011
1012 mutex_enter(&wd->sc_dk.dk_openlock);
1013
1014 switch (fmt) {
1015 case S_IFCHR:
1016 wd->sc_dk.dk_copenmask &= ~(1 << part);
1017 break;
1018 case S_IFBLK:
1019 wd->sc_dk.dk_bopenmask &= ~(1 << part);
1020 break;
1021 }
1022 wd->sc_dk.dk_openmask =
1023 wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
1024
1025 if (wd->sc_dk.dk_openmask == 0) {
1026 wd_flushcache(wd, AT_WAIT);
1027
1028 if (! (wd->sc_flags & WDF_KLABEL))
1029 wd->sc_flags &= ~WDF_LOADED;
1030
1031 wd->atabus->ata_delref(wd->drvp);
1032 }
1033
1034 mutex_exit(&wd->sc_dk.dk_openlock);
1035 return 0;
1036 }
1037
1038 void
1039 wdgetdefaultlabel(struct wd_softc *wd, struct disklabel *lp)
1040 {
1041
1042 ATADEBUG_PRINT(("wdgetdefaultlabel\n"), DEBUG_FUNCS);
1043 memset(lp, 0, sizeof(struct disklabel));
1044
1045 lp->d_secsize = DEV_BSIZE;
1046 lp->d_ntracks = wd->sc_params.atap_heads;
1047 lp->d_nsectors = wd->sc_params.atap_sectors;
1048 lp->d_ncylinders = (wd->sc_flags & WDF_LBA) ? wd->sc_capacity /
1049 (wd->sc_params.atap_heads * wd->sc_params.atap_sectors) :
1050 wd->sc_params.atap_cylinders;
1051 lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
1052
1053 if (strcmp(wd->sc_params.atap_model, "ST506") == 0)
1054 lp->d_type = DTYPE_ST506;
1055 else
1056 lp->d_type = DTYPE_ESDI;
1057
1058 strncpy(lp->d_typename, wd->sc_params.atap_model, 16);
1059 strncpy(lp->d_packname, "fictitious", 16);
1060 if (wd->sc_capacity > UINT32_MAX)
1061 lp->d_secperunit = UINT32_MAX;
1062 else
1063 lp->d_secperunit = wd->sc_capacity;
1064 lp->d_rpm = 3600;
1065 lp->d_interleave = 1;
1066 lp->d_flags = 0;
1067
1068 lp->d_partitions[RAW_PART].p_offset = 0;
1069 lp->d_partitions[RAW_PART].p_size =
1070 lp->d_secperunit * (lp->d_secsize / DEV_BSIZE);
1071 lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED;
1072 lp->d_npartitions = RAW_PART + 1;
1073
1074 lp->d_magic = DISKMAGIC;
1075 lp->d_magic2 = DISKMAGIC;
1076 lp->d_checksum = dkcksum(lp);
1077 }
1078
1079 /*
1080 * Fabricate a default disk label, and try to read the correct one.
1081 */
1082 void
1083 wdgetdisklabel(struct wd_softc *wd)
1084 {
1085 struct disklabel *lp = wd->sc_dk.dk_label;
1086 const char *errstring;
1087 int s;
1088
1089 ATADEBUG_PRINT(("wdgetdisklabel\n"), DEBUG_FUNCS);
1090
1091 memset(wd->sc_dk.dk_cpulabel, 0, sizeof(struct cpu_disklabel));
1092
1093 wdgetdefaultlabel(wd, lp);
1094
1095 wd->sc_badsect[0] = -1;
1096
1097 if (wd->drvp->state > RESET) {
1098 s = splbio();
1099 wd->drvp->drive_flags |= DRIVE_RESET;
1100 splx(s);
1101 }
1102 errstring = readdisklabel(MAKEWDDEV(0, device_unit(wd->sc_dev),
1103 RAW_PART), wdstrategy, lp,
1104 wd->sc_dk.dk_cpulabel);
1105 if (errstring) {
1106 /*
1107 * This probably happened because the drive's default
1108 * geometry doesn't match the DOS geometry. We
1109 * assume the DOS geometry is now in the label and try
1110 * again. XXX This is a kluge.
1111 */
1112 if (wd->drvp->state > RESET) {
1113 s = splbio();
1114 wd->drvp->drive_flags |= DRIVE_RESET;
1115 splx(s);
1116 }
1117 errstring = readdisklabel(MAKEWDDEV(0, device_unit(wd->sc_dev),
1118 RAW_PART), wdstrategy, lp, wd->sc_dk.dk_cpulabel);
1119 }
1120 if (errstring) {
1121 aprint_error_dev(wd->sc_dev, "%s\n", errstring);
1122 return;
1123 }
1124
1125 if (wd->drvp->state > RESET) {
1126 s = splbio();
1127 wd->drvp->drive_flags |= DRIVE_RESET;
1128 splx(s);
1129 }
1130 #ifdef HAS_BAD144_HANDLING
1131 if ((lp->d_flags & D_BADSECT) != 0)
1132 bad144intern(wd);
1133 #endif
1134 }
1135
1136 void
1137 wdperror(const struct wd_softc *wd)
1138 {
1139 static const char *const errstr0_3[] = {"address mark not found",
1140 "track 0 not found", "aborted command", "media change requested",
1141 "id not found", "media changed", "uncorrectable data error",
1142 "bad block detected"};
1143 static const char *const errstr4_5[] = {
1144 "obsolete (address mark not found)",
1145 "no media/write protected", "aborted command",
1146 "media change requested", "id not found", "media changed",
1147 "uncorrectable data error", "interface CRC error"};
1148 const char *const *errstr;
1149 int i;
1150 const char *sep = "";
1151
1152 const char *devname = device_xname(wd->sc_dev);
1153 struct ata_drive_datas *drvp = wd->drvp;
1154 int errno = wd->sc_wdc_bio.r_error;
1155
1156 if (drvp->ata_vers >= 4)
1157 errstr = errstr4_5;
1158 else
1159 errstr = errstr0_3;
1160
1161 printf("%s: (", devname);
1162
1163 if (errno == 0)
1164 printf("error not notified");
1165
1166 for (i = 0; i < 8; i++) {
1167 if (errno & (1 << i)) {
1168 printf("%s%s", sep, errstr[i]);
1169 sep = ", ";
1170 }
1171 }
1172 printf(")\n");
1173 }
1174
1175 int
1176 wdioctl(dev_t dev, u_long xfer, void *addr, int flag, struct lwp *l)
1177 {
1178 struct wd_softc *wd =
1179 device_private(device_lookup(&wd_cd, WDUNIT(dev)));
1180 int error = 0, s;
1181 #ifdef __HAVE_OLD_DISKLABEL
1182 struct disklabel *newlabel = NULL;
1183 #endif
1184
1185 ATADEBUG_PRINT(("wdioctl\n"), DEBUG_FUNCS);
1186
1187 if ((wd->sc_flags & WDF_LOADED) == 0)
1188 return EIO;
1189
1190 error = disk_ioctl(&wd->sc_dk, xfer, addr, flag, l);
1191 if (error != EPASSTHROUGH)
1192 return (error);
1193
1194 switch (xfer) {
1195 #ifdef HAS_BAD144_HANDLING
1196 case DIOCSBAD:
1197 if ((flag & FWRITE) == 0)
1198 return EBADF;
1199 wd->sc_dk.dk_cpulabel->bad = *(struct dkbad *)addr;
1200 wd->sc_dk.dk_label->d_flags |= D_BADSECT;
1201 bad144intern(wd);
1202 return 0;
1203 #endif
1204 #ifdef WD_SOFTBADSECT
1205 case DIOCBSLIST :
1206 {
1207 u_int32_t count, missing, skip;
1208 struct disk_badsecinfo dbsi;
1209 struct disk_badsectors *dbs;
1210 size_t available;
1211 uint8_t *laddr;
1212
1213 dbsi = *(struct disk_badsecinfo *)addr;
1214 missing = wd->sc_bscount;
1215 count = 0;
1216 available = dbsi.dbsi_bufsize;
1217 skip = dbsi.dbsi_skip;
1218 laddr = (uint8_t *)dbsi.dbsi_buffer;
1219
1220 /*
1221 * We start this loop with the expectation that all of the
1222 * entries will be missed and decrement this counter each
1223 * time we either skip over one (already copied out) or
1224 * we actually copy it back to user space. The structs
1225 * holding the bad sector information are copied directly
1226 * back to user space whilst the summary is returned via
1227 * the struct passed in via the ioctl.
1228 */
1229 SLIST_FOREACH(dbs, &wd->sc_bslist, dbs_next) {
1230 if (skip > 0) {
1231 missing--;
1232 skip--;
1233 continue;
1234 }
1235 if (available < sizeof(*dbs))
1236 break;
1237 available -= sizeof(*dbs);
1238 copyout(dbs, laddr, sizeof(*dbs));
1239 laddr += sizeof(*dbs);
1240 missing--;
1241 count++;
1242 }
1243 dbsi.dbsi_left = missing;
1244 dbsi.dbsi_copied = count;
1245 *(struct disk_badsecinfo *)addr = dbsi;
1246 return 0;
1247 }
1248
1249 case DIOCBSFLUSH :
1250 /* Clean out the bad sector list */
1251 while (!SLIST_EMPTY(&wd->sc_bslist)) {
1252 void *head = SLIST_FIRST(&wd->sc_bslist);
1253 SLIST_REMOVE_HEAD(&wd->sc_bslist, dbs_next);
1254 free(head, M_TEMP);
1255 }
1256 wd->sc_bscount = 0;
1257 return 0;
1258 #endif
1259 case DIOCGDINFO:
1260 *(struct disklabel *)addr = *(wd->sc_dk.dk_label);
1261 return 0;
1262 #ifdef __HAVE_OLD_DISKLABEL
1263 case ODIOCGDINFO:
1264 newlabel = malloc(sizeof *newlabel, M_TEMP, M_WAITOK);
1265 if (newlabel == NULL)
1266 return EIO;
1267 *newlabel = *(wd->sc_dk.dk_label);
1268 if (newlabel->d_npartitions <= OLDMAXPARTITIONS)
1269 memcpy(addr, newlabel, sizeof (struct olddisklabel));
1270 else
1271 error = ENOTTY;
1272 free(newlabel, M_TEMP);
1273 return error;
1274 #endif
1275
1276 case DIOCGPART:
1277 ((struct partinfo *)addr)->disklab = wd->sc_dk.dk_label;
1278 ((struct partinfo *)addr)->part =
1279 &wd->sc_dk.dk_label->d_partitions[WDPART(dev)];
1280 return 0;
1281
1282 case DIOCWDINFO:
1283 case DIOCSDINFO:
1284 #ifdef __HAVE_OLD_DISKLABEL
1285 case ODIOCWDINFO:
1286 case ODIOCSDINFO:
1287 #endif
1288 {
1289 struct disklabel *lp;
1290
1291 if ((flag & FWRITE) == 0)
1292 return EBADF;
1293
1294 #ifdef __HAVE_OLD_DISKLABEL
1295 if (xfer == ODIOCSDINFO || xfer == ODIOCWDINFO) {
1296 newlabel = malloc(sizeof *newlabel, M_TEMP, M_WAITOK);
1297 if (newlabel == NULL)
1298 return EIO;
1299 memset(newlabel, 0, sizeof newlabel);
1300 memcpy(newlabel, addr, sizeof (struct olddisklabel));
1301 lp = newlabel;
1302 } else
1303 #endif
1304 lp = (struct disklabel *)addr;
1305
1306 mutex_enter(&wd->sc_dk.dk_openlock);
1307 wd->sc_flags |= WDF_LABELLING;
1308
1309 error = setdisklabel(wd->sc_dk.dk_label,
1310 lp, /*wd->sc_dk.dk_openmask : */0,
1311 wd->sc_dk.dk_cpulabel);
1312 if (error == 0) {
1313 if (wd->drvp->state > RESET) {
1314 s = splbio();
1315 wd->drvp->drive_flags |= DRIVE_RESET;
1316 splx(s);
1317 }
1318 if (xfer == DIOCWDINFO
1319 #ifdef __HAVE_OLD_DISKLABEL
1320 || xfer == ODIOCWDINFO
1321 #endif
1322 )
1323 error = writedisklabel(WDLABELDEV(dev),
1324 wdstrategy, wd->sc_dk.dk_label,
1325 wd->sc_dk.dk_cpulabel);
1326 }
1327
1328 wd->sc_flags &= ~WDF_LABELLING;
1329 mutex_exit(&wd->sc_dk.dk_openlock);
1330 #ifdef __HAVE_OLD_DISKLABEL
1331 if (newlabel != NULL)
1332 free(newlabel, M_TEMP);
1333 #endif
1334 return error;
1335 }
1336
1337 case DIOCKLABEL:
1338 if (*(int *)addr)
1339 wd->sc_flags |= WDF_KLABEL;
1340 else
1341 wd->sc_flags &= ~WDF_KLABEL;
1342 return 0;
1343
1344 case DIOCWLABEL:
1345 if ((flag & FWRITE) == 0)
1346 return EBADF;
1347 if (*(int *)addr)
1348 wd->sc_flags |= WDF_WLABEL;
1349 else
1350 wd->sc_flags &= ~WDF_WLABEL;
1351 return 0;
1352
1353 case DIOCGDEFLABEL:
1354 wdgetdefaultlabel(wd, (struct disklabel *)addr);
1355 return 0;
1356 #ifdef __HAVE_OLD_DISKLABEL
1357 case ODIOCGDEFLABEL:
1358 newlabel = malloc(sizeof *newlabel, M_TEMP, M_WAITOK);
1359 if (newlabel == NULL)
1360 return EIO;
1361 wdgetdefaultlabel(wd, newlabel);
1362 if (newlabel->d_npartitions <= OLDMAXPARTITIONS)
1363 memcpy(addr, &newlabel, sizeof (struct olddisklabel));
1364 else
1365 error = ENOTTY;
1366 free(newlabel, M_TEMP);
1367 return error;
1368 #endif
1369
1370 #ifdef notyet
1371 case DIOCWFORMAT:
1372 if ((flag & FWRITE) == 0)
1373 return EBADF;
1374 {
1375 register struct format_op *fop;
1376 struct iovec aiov;
1377 struct uio auio;
1378
1379 fop = (struct format_op *)addr;
1380 aiov.iov_base = fop->df_buf;
1381 aiov.iov_len = fop->df_count;
1382 auio.uio_iov = &aiov;
1383 auio.uio_iovcnt = 1;
1384 auio.uio_resid = fop->df_count;
1385 auio.uio_offset =
1386 fop->df_startblk * wd->sc_dk.dk_label->d_secsize;
1387 auio.uio_vmspace = l->l_proc->p_vmspace;
1388 error = physio(wdformat, NULL, dev, B_WRITE, minphys,
1389 &auio);
1390 fop->df_count -= auio.uio_resid;
1391 fop->df_reg[0] = wdc->sc_status;
1392 fop->df_reg[1] = wdc->sc_error;
1393 return error;
1394 }
1395 #endif
1396 case DIOCGCACHE:
1397 return wd_getcache(wd, (int *)addr);
1398
1399 case DIOCSCACHE:
1400 return wd_setcache(wd, *(int *)addr);
1401
1402 case DIOCCACHESYNC:
1403 return wd_flushcache(wd, AT_WAIT);
1404
1405 case ATAIOCCOMMAND:
1406 /*
1407 * Make sure this command is (relatively) safe first
1408 */
1409 if ((((atareq_t *) addr)->flags & ATACMD_READ) == 0 &&
1410 (flag & FWRITE) == 0)
1411 return (EBADF);
1412 {
1413 struct wd_ioctl *wi;
1414 atareq_t *atareq = (atareq_t *) addr;
1415 int error1;
1416
1417 wi = wi_get();
1418 wi->wi_softc = wd;
1419 wi->wi_atareq = *atareq;
1420
1421 if (atareq->datalen && atareq->flags &
1422 (ATACMD_READ | ATACMD_WRITE)) {
1423 void *tbuf;
1424 if (atareq->datalen < DEV_BSIZE
1425 && atareq->command == WDCC_IDENTIFY) {
1426 tbuf = malloc(DEV_BSIZE, M_TEMP, M_WAITOK);
1427 wi->wi_iov.iov_base = tbuf;
1428 wi->wi_iov.iov_len = DEV_BSIZE;
1429 UIO_SETUP_SYSSPACE(&wi->wi_uio);
1430 } else {
1431 tbuf = NULL;
1432 wi->wi_iov.iov_base = atareq->databuf;
1433 wi->wi_iov.iov_len = atareq->datalen;
1434 wi->wi_uio.uio_vmspace = l->l_proc->p_vmspace;
1435 }
1436 wi->wi_uio.uio_iov = &wi->wi_iov;
1437 wi->wi_uio.uio_iovcnt = 1;
1438 wi->wi_uio.uio_resid = atareq->datalen;
1439 wi->wi_uio.uio_offset = 0;
1440 wi->wi_uio.uio_rw =
1441 (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE;
1442 error1 = physio(wdioctlstrategy, &wi->wi_bp, dev,
1443 (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE,
1444 minphys, &wi->wi_uio);
1445 if (tbuf != NULL && error1 == 0) {
1446 error1 = copyout(tbuf, atareq->databuf,
1447 atareq->datalen);
1448 free(tbuf, M_TEMP);
1449 }
1450 } else {
1451 /* No need to call physio if we don't have any
1452 user data */
1453 wi->wi_bp.b_flags = 0;
1454 wi->wi_bp.b_data = 0;
1455 wi->wi_bp.b_bcount = 0;
1456 wi->wi_bp.b_dev = 0;
1457 wi->wi_bp.b_proc = l->l_proc;
1458 wdioctlstrategy(&wi->wi_bp);
1459 error1 = wi->wi_bp.b_error;
1460 }
1461 *atareq = wi->wi_atareq;
1462 wi_free(wi);
1463 return(error1);
1464 }
1465
1466 case DIOCAWEDGE:
1467 {
1468 struct dkwedge_info *dkw = (void *) addr;
1469
1470 if ((flag & FWRITE) == 0)
1471 return (EBADF);
1472
1473 /* If the ioctl happens here, the parent is us. */
1474 strcpy(dkw->dkw_parent, device_xname(wd->sc_dev));
1475 return (dkwedge_add(dkw));
1476 }
1477
1478 case DIOCDWEDGE:
1479 {
1480 struct dkwedge_info *dkw = (void *) addr;
1481
1482 if ((flag & FWRITE) == 0)
1483 return (EBADF);
1484
1485 /* If the ioctl happens here, the parent is us. */
1486 strcpy(dkw->dkw_parent, device_xname(wd->sc_dev));
1487 return (dkwedge_del(dkw));
1488 }
1489
1490 case DIOCLWEDGES:
1491 {
1492 struct dkwedge_list *dkwl = (void *) addr;
1493
1494 return (dkwedge_list(&wd->sc_dk, dkwl, l));
1495 }
1496
1497 case DIOCGSTRATEGY:
1498 {
1499 struct disk_strategy *dks = (void *)addr;
1500
1501 s = splbio();
1502 strlcpy(dks->dks_name, bufq_getstrategyname(wd->sc_q),
1503 sizeof(dks->dks_name));
1504 splx(s);
1505 dks->dks_paramlen = 0;
1506
1507 return 0;
1508 }
1509
1510 case DIOCSSTRATEGY:
1511 {
1512 struct disk_strategy *dks = (void *)addr;
1513 struct bufq_state *new;
1514 struct bufq_state *old;
1515
1516 if ((flag & FWRITE) == 0) {
1517 return EBADF;
1518 }
1519 if (dks->dks_param != NULL) {
1520 return EINVAL;
1521 }
1522 dks->dks_name[sizeof(dks->dks_name) - 1] = 0; /* ensure term */
1523 error = bufq_alloc(&new, dks->dks_name,
1524 BUFQ_EXACT|BUFQ_SORT_RAWBLOCK);
1525 if (error) {
1526 return error;
1527 }
1528 s = splbio();
1529 old = wd->sc_q;
1530 bufq_move(new, old);
1531 wd->sc_q = new;
1532 splx(s);
1533 bufq_free(old);
1534
1535 return 0;
1536 }
1537
1538 default:
1539 return ENOTTY;
1540 }
1541
1542 #ifdef DIAGNOSTIC
1543 panic("wdioctl: impossible");
1544 #endif
1545 }
1546
1547 #ifdef B_FORMAT
1548 int
1549 wdformat(struct buf *bp)
1550 {
1551
1552 bp->b_flags |= B_FORMAT;
1553 return wdstrategy(bp);
1554 }
1555 #endif
1556
1557 int
1558 wdsize(dev_t dev)
1559 {
1560 struct wd_softc *wd;
1561 int part, omask;
1562 int size;
1563
1564 ATADEBUG_PRINT(("wdsize\n"), DEBUG_FUNCS);
1565
1566 wd = device_private(device_lookup(&wd_cd, WDUNIT(dev)));
1567 if (wd == NULL)
1568 return (-1);
1569
1570 part = WDPART(dev);
1571 omask = wd->sc_dk.dk_openmask & (1 << part);
1572
1573 if (omask == 0 && wdopen(dev, 0, S_IFBLK, NULL) != 0)
1574 return (-1);
1575 if (wd->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP)
1576 size = -1;
1577 else
1578 size = wd->sc_dk.dk_label->d_partitions[part].p_size *
1579 (wd->sc_dk.dk_label->d_secsize / DEV_BSIZE);
1580 if (omask == 0 && wdclose(dev, 0, S_IFBLK, NULL) != 0)
1581 return (-1);
1582 return (size);
1583 }
1584
1585 /* #define WD_DUMP_NOT_TRUSTED if you just want to watch */
1586 static int wddoingadump = 0;
1587 static int wddumprecalibrated = 0;
1588
1589 /*
1590 * Dump core after a system crash.
1591 */
1592 int
1593 wddump(dev_t dev, daddr_t blkno, void *va, size_t size)
1594 {
1595 struct wd_softc *wd; /* disk unit to do the I/O */
1596 struct disklabel *lp; /* disk's disklabel */
1597 int part, err;
1598 int nblks; /* total number of sectors left to write */
1599
1600 /* Check if recursive dump; if so, punt. */
1601 if (wddoingadump)
1602 return EFAULT;
1603 wddoingadump = 1;
1604
1605 wd = device_private(device_lookup(&wd_cd, WDUNIT(dev)));
1606 if (wd == NULL)
1607 return (ENXIO);
1608
1609 part = WDPART(dev);
1610
1611 /* Convert to disk sectors. Request must be a multiple of size. */
1612 lp = wd->sc_dk.dk_label;
1613 if ((size % lp->d_secsize) != 0)
1614 return EFAULT;
1615 nblks = size / lp->d_secsize;
1616 blkno = blkno / (lp->d_secsize / DEV_BSIZE);
1617
1618 /* Check transfer bounds against partition size. */
1619 if ((blkno < 0) || ((blkno + nblks) > lp->d_partitions[part].p_size))
1620 return EINVAL;
1621
1622 /* Offset block number to start of partition. */
1623 blkno += lp->d_partitions[part].p_offset;
1624
1625 /* Recalibrate, if first dump transfer. */
1626 if (wddumprecalibrated == 0) {
1627 wddumprecalibrated = 1;
1628 (*wd->atabus->ata_reset_drive)(wd->drvp,
1629 AT_POLL | AT_RST_EMERG);
1630 wd->drvp->state = RESET;
1631 }
1632
1633 wd->sc_bp = NULL;
1634 wd->sc_wdc_bio.blkno = blkno;
1635 wd->sc_wdc_bio.flags = ATA_POLL;
1636 if (wd->sc_flags & WDF_LBA48 &&
1637 (blkno > LBA48_THRESHOLD ||
1638 (wd->sc_quirks & WD_QUIRK_FORCE_LBA48) != 0))
1639 wd->sc_wdc_bio.flags |= ATA_LBA48;
1640 if (wd->sc_flags & WDF_LBA)
1641 wd->sc_wdc_bio.flags |= ATA_LBA;
1642 wd->sc_wdc_bio.bcount = nblks * lp->d_secsize;
1643 wd->sc_wdc_bio.databuf = va;
1644 #ifndef WD_DUMP_NOT_TRUSTED
1645 switch (wd->atabus->ata_bio(wd->drvp, &wd->sc_wdc_bio)) {
1646 case ATACMD_TRY_AGAIN:
1647 panic("wddump: try again");
1648 break;
1649 case ATACMD_QUEUED:
1650 panic("wddump: polled command has been queued");
1651 break;
1652 case ATACMD_COMPLETE:
1653 break;
1654 }
1655 switch(wd->sc_wdc_bio.error) {
1656 case TIMEOUT:
1657 printf("wddump: device timed out");
1658 err = EIO;
1659 break;
1660 case ERR_DF:
1661 printf("wddump: drive fault");
1662 err = EIO;
1663 break;
1664 case ERR_DMA:
1665 printf("wddump: DMA error");
1666 err = EIO;
1667 break;
1668 case ERROR:
1669 printf("wddump: ");
1670 wdperror(wd);
1671 err = EIO;
1672 break;
1673 case NOERROR:
1674 err = 0;
1675 break;
1676 default:
1677 panic("wddump: unknown error type");
1678 }
1679 if (err != 0) {
1680 printf("\n");
1681 return err;
1682 }
1683 #else /* WD_DUMP_NOT_TRUSTED */
1684 /* Let's just talk about this first... */
1685 printf("wd%d: dump addr 0x%x, cylin %d, head %d, sector %d\n",
1686 unit, va, cylin, head, sector);
1687 delay(500 * 1000); /* half a second */
1688 #endif
1689
1690 wddoingadump = 0;
1691 return 0;
1692 }
1693
1694 #ifdef HAS_BAD144_HANDLING
1695 /*
1696 * Internalize the bad sector table.
1697 */
1698 void
1699 bad144intern(struct wd_softc *wd)
1700 {
1701 struct dkbad *bt = &wd->sc_dk.dk_cpulabel->bad;
1702 struct disklabel *lp = wd->sc_dk.dk_label;
1703 int i = 0;
1704
1705 ATADEBUG_PRINT(("bad144intern\n"), DEBUG_XFERS);
1706
1707 for (; i < NBT_BAD; i++) {
1708 if (bt->bt_bad[i].bt_cyl == 0xffff)
1709 break;
1710 wd->sc_badsect[i] =
1711 bt->bt_bad[i].bt_cyl * lp->d_secpercyl +
1712 (bt->bt_bad[i].bt_trksec >> 8) * lp->d_nsectors +
1713 (bt->bt_bad[i].bt_trksec & 0xff);
1714 }
1715 for (; i < NBT_BAD+1; i++)
1716 wd->sc_badsect[i] = -1;
1717 }
1718 #endif
1719
1720 static void
1721 wd_params_to_properties(struct wd_softc *wd, struct ataparams *params)
1722 {
1723 prop_dictionary_t disk_info, odisk_info, geom;
1724 const char *cp;
1725
1726 disk_info = prop_dictionary_create();
1727
1728 if (strcmp(wd->sc_params.atap_model, "ST506") == 0)
1729 cp = "ST506";
1730 else {
1731 /* XXX Should have a case for ATA here, too. */
1732 cp = "ESDI";
1733 }
1734 prop_dictionary_set_cstring_nocopy(disk_info, "type", cp);
1735
1736 geom = prop_dictionary_create();
1737
1738 prop_dictionary_set_uint64(geom, "sectors-per-unit", wd->sc_capacity);
1739
1740 prop_dictionary_set_uint32(geom, "sector-size",
1741 DEV_BSIZE /* XXX 512? */);
1742
1743 prop_dictionary_set_uint16(geom, "sectors-per-track",
1744 wd->sc_params.atap_sectors);
1745
1746 prop_dictionary_set_uint16(geom, "tracks-per-cylinder",
1747 wd->sc_params.atap_heads);
1748
1749 if (wd->sc_flags & WDF_LBA)
1750 prop_dictionary_set_uint64(geom, "cylinders-per-unit",
1751 wd->sc_capacity /
1752 (wd->sc_params.atap_heads *
1753 wd->sc_params.atap_sectors));
1754 else
1755 prop_dictionary_set_uint16(geom, "cylinders-per-unit",
1756 wd->sc_params.atap_cylinders);
1757
1758 prop_dictionary_set(disk_info, "geometry", geom);
1759 prop_object_release(geom);
1760
1761 prop_dictionary_set(device_properties(wd->sc_dev),
1762 "disk-info", disk_info);
1763
1764 /*
1765 * Don't release disk_info here; we keep a reference to it.
1766 * disk_detach() will release it when we go away.
1767 */
1768
1769 odisk_info = wd->sc_dk.dk_info;
1770 wd->sc_dk.dk_info = disk_info;
1771 if (odisk_info)
1772 prop_object_release(odisk_info);
1773 }
1774
1775 int
1776 wd_get_params(struct wd_softc *wd, u_int8_t flags, struct ataparams *params)
1777 {
1778
1779 switch (wd->atabus->ata_get_params(wd->drvp, flags, params)) {
1780 case CMD_AGAIN:
1781 return 1;
1782 case CMD_ERR:
1783 /*
1784 * We `know' there's a drive here; just assume it's old.
1785 * This geometry is only used to read the MBR and print a
1786 * (false) attach message.
1787 */
1788 strncpy(params->atap_model, "ST506",
1789 sizeof params->atap_model);
1790 params->atap_config = ATA_CFG_FIXED;
1791 params->atap_cylinders = 1024;
1792 params->atap_heads = 8;
1793 params->atap_sectors = 17;
1794 params->atap_multi = 1;
1795 params->atap_capabilities1 = params->atap_capabilities2 = 0;
1796 wd->drvp->ata_vers = -1; /* Mark it as pre-ATA */
1797 /* FALLTHROUGH */
1798 case CMD_OK:
1799 wd_params_to_properties(wd, params);
1800 return 0;
1801 default:
1802 panic("wd_get_params: bad return code from ata_get_params");
1803 /* NOTREACHED */
1804 }
1805 }
1806
1807 int
1808 wd_getcache(struct wd_softc *wd, int *bitsp)
1809 {
1810 struct ataparams params;
1811
1812 if (wd_get_params(wd, AT_WAIT, ¶ms) != 0)
1813 return EIO;
1814 if (params.atap_cmd_set1 == 0x0000 ||
1815 params.atap_cmd_set1 == 0xffff ||
1816 (params.atap_cmd_set1 & WDC_CMD1_CACHE) == 0) {
1817 *bitsp = 0;
1818 return 0;
1819 }
1820 *bitsp = DKCACHE_WCHANGE | DKCACHE_READ;
1821 if (params.atap_cmd1_en & WDC_CMD1_CACHE)
1822 *bitsp |= DKCACHE_WRITE;
1823
1824 return 0;
1825 }
1826
1827 const char at_errbits[] = "\20\10ERROR\11TIMEOU\12DF";
1828
1829 int
1830 wd_setcache(struct wd_softc *wd, int bits)
1831 {
1832 struct ataparams params;
1833 struct ata_command ata_c;
1834
1835 if (wd_get_params(wd, AT_WAIT, ¶ms) != 0)
1836 return EIO;
1837
1838 if (params.atap_cmd_set1 == 0x0000 ||
1839 params.atap_cmd_set1 == 0xffff ||
1840 (params.atap_cmd_set1 & WDC_CMD1_CACHE) == 0)
1841 return EOPNOTSUPP;
1842
1843 if ((bits & DKCACHE_READ) == 0 ||
1844 (bits & DKCACHE_SAVE) != 0)
1845 return EOPNOTSUPP;
1846
1847 memset(&ata_c, 0, sizeof(struct ata_command));
1848 ata_c.r_command = SET_FEATURES;
1849 ata_c.r_st_bmask = 0;
1850 ata_c.r_st_pmask = 0;
1851 ata_c.timeout = 30000; /* 30s timeout */
1852 ata_c.flags = AT_WAIT;
1853 if (bits & DKCACHE_WRITE)
1854 ata_c.r_features = WDSF_WRITE_CACHE_EN;
1855 else
1856 ata_c.r_features = WDSF_WRITE_CACHE_DS;
1857 if (wd->atabus->ata_exec_command(wd->drvp, &ata_c) != ATACMD_COMPLETE) {
1858 aprint_error_dev(wd->sc_dev,
1859 "wd_setcache command not complete\n");
1860 return EIO;
1861 }
1862 if (ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
1863 char sbuf[sizeof(at_errbits) + 64];
1864 bitmask_snprintf(ata_c.flags, at_errbits, sbuf, sizeof(sbuf));
1865 aprint_error_dev(wd->sc_dev, "wd_setcache: status=%s\n", sbuf);
1866 return EIO;
1867 }
1868 return 0;
1869 }
1870
1871 static int
1872 wd_standby(struct wd_softc *wd, int flags)
1873 {
1874 struct ata_command ata_c;
1875
1876 memset(&ata_c, 0, sizeof(struct ata_command));
1877 ata_c.r_command = WDCC_STANDBY_IMMED;
1878 ata_c.r_st_bmask = WDCS_DRDY;
1879 ata_c.r_st_pmask = WDCS_DRDY;
1880 ata_c.flags = flags;
1881 ata_c.timeout = 30000; /* 30s timeout */
1882 if (wd->atabus->ata_exec_command(wd->drvp, &ata_c) != ATACMD_COMPLETE) {
1883 aprint_error_dev(wd->sc_dev,
1884 "standby immediate command didn't complete\n");
1885 return EIO;
1886 }
1887 if (ata_c.flags & AT_ERROR) {
1888 if (ata_c.r_error == WDCE_ABRT) /* command not supported */
1889 return ENODEV;
1890 }
1891 if (ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
1892 char sbuf[sizeof(at_errbits) + 64];
1893 bitmask_snprintf(ata_c.flags, at_errbits, sbuf, sizeof(sbuf));
1894 aprint_error_dev(wd->sc_dev, "wd_standby: status=%s\n", sbuf);
1895 return EIO;
1896 }
1897 return 0;
1898 }
1899
1900 int
1901 wd_flushcache(struct wd_softc *wd, int flags)
1902 {
1903 struct ata_command ata_c;
1904
1905 /*
1906 * WDCC_FLUSHCACHE is here since ATA-4, but some drives report
1907 * only ATA-2 and still support it.
1908 */
1909 if (wd->drvp->ata_vers < 4 &&
1910 ((wd->sc_params.atap_cmd_set2 & WDC_CMD2_FC) == 0 ||
1911 wd->sc_params.atap_cmd_set2 == 0xffff))
1912 return ENODEV;
1913 memset(&ata_c, 0, sizeof(struct ata_command));
1914 if ((wd->sc_params.atap_cmd2_en & ATA_CMD2_LBA48) != 0 &&
1915 (wd->sc_params.atap_cmd2_en & ATA_CMD2_FCE) != 0)
1916 ata_c.r_command = WDCC_FLUSHCACHE_EXT;
1917 else
1918 ata_c.r_command = WDCC_FLUSHCACHE;
1919 ata_c.r_st_bmask = WDCS_DRDY;
1920 ata_c.r_st_pmask = WDCS_DRDY;
1921 ata_c.flags = flags;
1922 ata_c.timeout = 30000; /* 30s timeout */
1923 if (wd->atabus->ata_exec_command(wd->drvp, &ata_c) != ATACMD_COMPLETE) {
1924 aprint_error_dev(wd->sc_dev,
1925 "flush cache command didn't complete\n");
1926 return EIO;
1927 }
1928 if (ata_c.flags & AT_ERROR) {
1929 if (ata_c.r_error == WDCE_ABRT) /* command not supported */
1930 return ENODEV;
1931 }
1932 if (ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
1933 char sbuf[sizeof(at_errbits) + 64];
1934 bitmask_snprintf(ata_c.flags, at_errbits, sbuf, sizeof(sbuf));
1935 aprint_error_dev(wd->sc_dev, "wd_flushcache: status=%s\n",
1936 sbuf);
1937 return EIO;
1938 }
1939 return 0;
1940 }
1941
1942 bool
1943 wd_shutdown(device_t dev, int how)
1944 {
1945
1946 struct wd_softc *wd = device_private(dev);
1947 wd_flushcache(wd, AT_POLL);
1948 if ((how & RB_POWERDOWN) == RB_POWERDOWN)
1949 wd_standby(wd, AT_POLL);
1950 return true;
1951 }
1952
1953 /*
1954 * Allocate space for a ioctl queue structure. Mostly taken from
1955 * scsipi_ioctl.c
1956 */
1957 struct wd_ioctl *
1958 wi_get(void)
1959 {
1960 struct wd_ioctl *wi;
1961 int s;
1962
1963 wi = malloc(sizeof(struct wd_ioctl), M_TEMP, M_WAITOK|M_ZERO);
1964 buf_init(&wi->wi_bp);
1965 s = splbio();
1966 LIST_INSERT_HEAD(&wi_head, wi, wi_list);
1967 splx(s);
1968 return (wi);
1969 }
1970
1971 /*
1972 * Free an ioctl structure and remove it from our list
1973 */
1974
1975 void
1976 wi_free(struct wd_ioctl *wi)
1977 {
1978 int s;
1979
1980 s = splbio();
1981 LIST_REMOVE(wi, wi_list);
1982 splx(s);
1983 buf_destroy(&wi->wi_bp);
1984 free(wi, M_TEMP);
1985 }
1986
1987 /*
1988 * Find a wd_ioctl structure based on the struct buf.
1989 */
1990
1991 struct wd_ioctl *
1992 wi_find(struct buf *bp)
1993 {
1994 struct wd_ioctl *wi;
1995 int s;
1996
1997 s = splbio();
1998 for (wi = wi_head.lh_first; wi != 0; wi = wi->wi_list.le_next)
1999 if (bp == &wi->wi_bp)
2000 break;
2001 splx(s);
2002 return (wi);
2003 }
2004
2005 /*
2006 * Ioctl pseudo strategy routine
2007 *
2008 * This is mostly stolen from scsipi_ioctl.c:scsistrategy(). What
2009 * happens here is:
2010 *
2011 * - wdioctl() queues a wd_ioctl structure.
2012 *
2013 * - wdioctl() calls physio/wdioctlstrategy based on whether or not
2014 * user space I/O is required. If physio() is called, physio() eventually
2015 * calls wdioctlstrategy().
2016 *
2017 * - In either case, wdioctlstrategy() calls wd->atabus->ata_exec_command()
2018 * to perform the actual command
2019 *
2020 * The reason for the use of the pseudo strategy routine is because
2021 * when doing I/O to/from user space, physio _really_ wants to be in
2022 * the loop. We could put the entire buffer into the ioctl request
2023 * structure, but that won't scale if we want to do things like download
2024 * microcode.
2025 */
2026
2027 void
2028 wdioctlstrategy(struct buf *bp)
2029 {
2030 struct wd_ioctl *wi;
2031 struct ata_command ata_c;
2032 int error = 0;
2033
2034 wi = wi_find(bp);
2035 if (wi == NULL) {
2036 printf("wdioctlstrategy: "
2037 "No matching ioctl request found in queue\n");
2038 error = EINVAL;
2039 goto bad;
2040 }
2041
2042 memset(&ata_c, 0, sizeof(ata_c));
2043
2044 /*
2045 * Abort if physio broke up the transfer
2046 */
2047
2048 if (bp->b_bcount != wi->wi_atareq.datalen) {
2049 printf("physio split wd ioctl request... cannot proceed\n");
2050 error = EIO;
2051 goto bad;
2052 }
2053
2054 /*
2055 * Abort if we didn't get a buffer size that was a multiple of
2056 * our sector size (or was larger than NBBY)
2057 */
2058
2059 if ((bp->b_bcount % wi->wi_softc->sc_dk.dk_label->d_secsize) != 0 ||
2060 (bp->b_bcount / wi->wi_softc->sc_dk.dk_label->d_secsize) >=
2061 (1 << NBBY)) {
2062 error = EINVAL;
2063 goto bad;
2064 }
2065
2066 /*
2067 * Make sure a timeout was supplied in the ioctl request
2068 */
2069
2070 if (wi->wi_atareq.timeout == 0) {
2071 error = EINVAL;
2072 goto bad;
2073 }
2074
2075 if (wi->wi_atareq.flags & ATACMD_READ)
2076 ata_c.flags |= AT_READ;
2077 else if (wi->wi_atareq.flags & ATACMD_WRITE)
2078 ata_c.flags |= AT_WRITE;
2079
2080 if (wi->wi_atareq.flags & ATACMD_READREG)
2081 ata_c.flags |= AT_READREG;
2082
2083 ata_c.flags |= AT_WAIT;
2084
2085 ata_c.timeout = wi->wi_atareq.timeout;
2086 ata_c.r_command = wi->wi_atareq.command;
2087 ata_c.r_head = wi->wi_atareq.head & 0x0f;
2088 ata_c.r_cyl = wi->wi_atareq.cylinder;
2089 ata_c.r_sector = wi->wi_atareq.sec_num;
2090 ata_c.r_count = wi->wi_atareq.sec_count;
2091 ata_c.r_features = wi->wi_atareq.features;
2092 ata_c.r_st_bmask = WDCS_DRDY;
2093 ata_c.r_st_pmask = WDCS_DRDY;
2094 ata_c.data = wi->wi_bp.b_data;
2095 ata_c.bcount = wi->wi_bp.b_bcount;
2096
2097 if (wi->wi_softc->atabus->ata_exec_command(wi->wi_softc->drvp, &ata_c)
2098 != ATACMD_COMPLETE) {
2099 wi->wi_atareq.retsts = ATACMD_ERROR;
2100 goto bad;
2101 }
2102
2103 if (ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
2104 if (ata_c.flags & AT_ERROR) {
2105 wi->wi_atareq.retsts = ATACMD_ERROR;
2106 wi->wi_atareq.error = ata_c.r_error;
2107 } else if (ata_c.flags & AT_DF)
2108 wi->wi_atareq.retsts = ATACMD_DF;
2109 else
2110 wi->wi_atareq.retsts = ATACMD_TIMEOUT;
2111 } else {
2112 wi->wi_atareq.retsts = ATACMD_OK;
2113 if (wi->wi_atareq.flags & ATACMD_READREG) {
2114 wi->wi_atareq.head = ata_c.r_head ;
2115 wi->wi_atareq.cylinder = ata_c.r_cyl;
2116 wi->wi_atareq.sec_num = ata_c.r_sector;
2117 wi->wi_atareq.sec_count = ata_c.r_count;
2118 wi->wi_atareq.features = ata_c.r_features;
2119 wi->wi_atareq.error = ata_c.r_error;
2120 }
2121 }
2122
2123 bp->b_error = 0;
2124 biodone(bp);
2125 return;
2126 bad:
2127 bp->b_error = error;
2128 biodone(bp);
2129 }
2130