wd.c revision 1.434 1 1.434 mlelstv /* $NetBSD: wd.c,v 1.434 2017/11/01 19:34:46 mlelstv Exp $ */
2 1.181 bouyer
3 1.181 bouyer /*
4 1.218 bouyer * Copyright (c) 1998, 2001 Manuel Bouyer. All rights reserved.
5 1.181 bouyer *
6 1.181 bouyer * Redistribution and use in source and binary forms, with or without
7 1.181 bouyer * modification, are permitted provided that the following conditions
8 1.181 bouyer * are met:
9 1.181 bouyer * 1. Redistributions of source code must retain the above copyright
10 1.181 bouyer * notice, this list of conditions and the following disclaimer.
11 1.181 bouyer * 2. Redistributions in binary form must reproduce the above copyright
12 1.181 bouyer * notice, this list of conditions and the following disclaimer in the
13 1.181 bouyer * documentation and/or other materials provided with the distribution.
14 1.181 bouyer *
15 1.181 bouyer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 1.181 bouyer * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17 1.181 bouyer * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18 1.259 dsl * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19 1.181 bouyer * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20 1.181 bouyer * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21 1.181 bouyer * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22 1.181 bouyer * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23 1.181 bouyer * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24 1.181 bouyer * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25 1.181 bouyer */
26 1.100 cgd
27 1.178 mycroft /*-
28 1.280 mycroft * Copyright (c) 1998, 2003, 2004 The NetBSD Foundation, Inc.
29 1.178 mycroft * All rights reserved.
30 1.119 mycroft *
31 1.178 mycroft * This code is derived from software contributed to The NetBSD Foundation
32 1.178 mycroft * by Charles M. Hannum and by Onno van der Linden.
33 1.168 cgd *
34 1.113 mycroft * Redistribution and use in source and binary forms, with or without
35 1.113 mycroft * modification, are permitted provided that the following conditions
36 1.113 mycroft * are met:
37 1.113 mycroft * 1. Redistributions of source code must retain the above copyright
38 1.113 mycroft * notice, this list of conditions and the following disclaimer.
39 1.113 mycroft * 2. Redistributions in binary form must reproduce the above copyright
40 1.113 mycroft * notice, this list of conditions and the following disclaimer in the
41 1.113 mycroft * documentation and/or other materials provided with the distribution.
42 1.113 mycroft *
43 1.178 mycroft * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
44 1.178 mycroft * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
45 1.178 mycroft * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
46 1.178 mycroft * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
47 1.178 mycroft * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
48 1.178 mycroft * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
49 1.178 mycroft * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
50 1.178 mycroft * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
51 1.178 mycroft * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
52 1.178 mycroft * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
53 1.178 mycroft * POSSIBILITY OF SUCH DAMAGE.
54 1.1 cgd */
55 1.215 lukem
56 1.215 lukem #include <sys/cdefs.h>
57 1.434 mlelstv __KERNEL_RCSID(0, "$NetBSD: wd.c,v 1.434 2017/11/01 19:34:46 mlelstv Exp $");
58 1.1 cgd
59 1.338 dyoung #include "opt_ata.h"
60 1.430 jdolecek #include "opt_wd.h"
61 1.181 bouyer
62 1.29 mycroft #include <sys/param.h>
63 1.29 mycroft #include <sys/systm.h>
64 1.43 mycroft #include <sys/kernel.h>
65 1.29 mycroft #include <sys/conf.h>
66 1.29 mycroft #include <sys/file.h>
67 1.29 mycroft #include <sys/stat.h>
68 1.29 mycroft #include <sys/ioctl.h>
69 1.29 mycroft #include <sys/buf.h>
70 1.296 yamt #include <sys/bufq.h>
71 1.29 mycroft #include <sys/uio.h>
72 1.29 mycroft #include <sys/malloc.h>
73 1.64 mycroft #include <sys/device.h>
74 1.94 mycroft #include <sys/disklabel.h>
75 1.94 mycroft #include <sys/disk.h>
76 1.29 mycroft #include <sys/syslog.h>
77 1.149 christos #include <sys/proc.h>
78 1.354 joerg #include <sys/reboot.h>
79 1.196 enami #include <sys/vnode.h>
80 1.419 riastrad #include <sys/rndsource.h>
81 1.29 mycroft
82 1.347 ad #include <sys/intr.h>
83 1.347 ad #include <sys/bus.h>
84 1.237 thorpej
85 1.181 bouyer #include <dev/ata/atareg.h>
86 1.181 bouyer #include <dev/ata/atavar.h>
87 1.181 bouyer #include <dev/ata/wdvar.h>
88 1.181 bouyer #include <dev/ic/wdcreg.h>
89 1.186 kenh #include <sys/ataio.h>
90 1.163 bouyer #include "locators.h"
91 1.1 cgd
92 1.330 thorpej #include <prop/proplib.h>
93 1.330 thorpej
94 1.430 jdolecek #define WDIORETRIES_SINGLE 4 /* number of retries for single-sector */
95 1.181 bouyer #define WDIORETRIES 5 /* number of retries before giving up */
96 1.181 bouyer #define RECOVERYTIME hz/2 /* time to wait before retrying a cmd */
97 1.23 deraadt
98 1.181 bouyer #define WDUNIT(dev) DISKUNIT(dev)
99 1.181 bouyer #define WDPART(dev) DISKPART(dev)
100 1.196 enami #define WDMINOR(unit, part) DISKMINOR(unit, part)
101 1.92 cgd #define MAKEWDDEV(maj, unit, part) MAKEDISKDEV(maj, unit, part)
102 1.92 cgd
103 1.92 cgd #define WDLABELDEV(dev) (MAKEWDDEV(major(dev), WDUNIT(dev), RAW_PART))
104 1.1 cgd
105 1.181 bouyer #define DEBUG_FUNCS 0x08
106 1.181 bouyer #define DEBUG_PROBE 0x10
107 1.433 jdolecek #define DEBUG_DETACH 0x20
108 1.433 jdolecek #define DEBUG_XFERS 0x40
109 1.289 thorpej #ifdef ATADEBUG
110 1.434 mlelstv #ifndef ATADEBUG_WD_MASK
111 1.434 mlelstv #define ATADEBUG_WD_MASK 0x0
112 1.434 mlelstv #endif
113 1.434 mlelstv int wdcdebug_wd_mask = ATADEBUG_WD_MASK;
114 1.289 thorpej #define ATADEBUG_PRINT(args, level) \
115 1.181 bouyer if (wdcdebug_wd_mask & (level)) \
116 1.181 bouyer printf args
117 1.163 bouyer #else
118 1.289 thorpej #define ATADEBUG_PRINT(args, level)
119 1.163 bouyer #endif
120 1.181 bouyer
121 1.434 mlelstv static int wdprobe(device_t, cfdata_t, void *);
122 1.434 mlelstv static void wdattach(device_t, device_t, void *);
123 1.434 mlelstv static int wddetach(device_t, int);
124 1.434 mlelstv static void wdperror(const struct wd_softc *, struct ata_xfer *);
125 1.102 mycroft
126 1.388 jakllsch static void wdminphys(struct buf *);
127 1.388 jakllsch
128 1.434 mlelstv static int wd_firstopen(device_t, dev_t, int, int);
129 1.434 mlelstv static int wd_lastclose(device_t);
130 1.384 dyoung static bool wd_suspend(device_t, const pmf_qual_t *);
131 1.353 jmcneill static int wd_standby(struct wd_softc *, int);
132 1.351 jmcneill
133 1.371 dyoung CFATTACH_DECL3_NEW(wd, sizeof(struct wd_softc),
134 1.375 dyoung wdprobe, wdattach, wddetach, NULL, NULL, NULL, DVF_DETACH_SHUTDOWN);
135 1.147 thorpej
136 1.167 thorpej extern struct cfdriver wd_cd;
137 1.108 mycroft
138 1.434 mlelstv static dev_type_open(wdopen);
139 1.434 mlelstv static dev_type_close(wdclose);
140 1.434 mlelstv static dev_type_read(wdread);
141 1.434 mlelstv static dev_type_write(wdwrite);
142 1.434 mlelstv static dev_type_ioctl(wdioctl);
143 1.434 mlelstv static dev_type_strategy(wdstrategy);
144 1.434 mlelstv static dev_type_dump(wddump);
145 1.434 mlelstv static dev_type_size(wdsize);
146 1.410 dholland static dev_type_discard(wddiscard);
147 1.225 gehenna
148 1.225 gehenna const struct bdevsw wd_bdevsw = {
149 1.407 dholland .d_open = wdopen,
150 1.407 dholland .d_close = wdclose,
151 1.407 dholland .d_strategy = wdstrategy,
152 1.407 dholland .d_ioctl = wdioctl,
153 1.407 dholland .d_dump = wddump,
154 1.407 dholland .d_psize = wdsize,
155 1.410 dholland .d_discard = wddiscard,
156 1.407 dholland .d_flag = D_DISK
157 1.225 gehenna };
158 1.225 gehenna
159 1.225 gehenna const struct cdevsw wd_cdevsw = {
160 1.407 dholland .d_open = wdopen,
161 1.407 dholland .d_close = wdclose,
162 1.407 dholland .d_read = wdread,
163 1.407 dholland .d_write = wdwrite,
164 1.407 dholland .d_ioctl = wdioctl,
165 1.407 dholland .d_stop = nostop,
166 1.407 dholland .d_tty = notty,
167 1.407 dholland .d_poll = nopoll,
168 1.407 dholland .d_mmap = nommap,
169 1.407 dholland .d_kqfilter = nokqfilter,
170 1.410 dholland .d_discard = wddiscard,
171 1.407 dholland .d_flag = D_DISK
172 1.225 gehenna };
173 1.225 gehenna
174 1.430 jdolecek /* #define WD_DUMP_NOT_TRUSTED if you just want to watch */
175 1.430 jdolecek static int wddoingadump = 0;
176 1.430 jdolecek static int wddumprecalibrated = 0;
177 1.430 jdolecek
178 1.185 kenh /*
179 1.185 kenh * Glue necessary to hook WDCIOCCOMMAND into physio
180 1.185 kenh */
181 1.185 kenh
182 1.185 kenh struct wd_ioctl {
183 1.185 kenh LIST_ENTRY(wd_ioctl) wi_list;
184 1.185 kenh struct buf wi_bp;
185 1.185 kenh struct uio wi_uio;
186 1.185 kenh struct iovec wi_iov;
187 1.186 kenh atareq_t wi_atareq;
188 1.185 kenh struct wd_softc *wi_softc;
189 1.185 kenh };
190 1.185 kenh
191 1.434 mlelstv static struct wd_ioctl *wi_find(struct buf *);
192 1.434 mlelstv static void wi_free(struct wd_ioctl *);
193 1.434 mlelstv static struct wd_ioctl *wi_get(struct wd_softc *);
194 1.434 mlelstv static void wdioctlstrategy(struct buf *);
195 1.434 mlelstv
196 1.434 mlelstv static void wdstart(device_t);
197 1.434 mlelstv static int wd_diskstart(device_t, struct buf *);
198 1.434 mlelstv static int wd_dumpblocks(device_t, void *, daddr_t, int);
199 1.434 mlelstv static void wd_iosize(device_t, int *);
200 1.434 mlelstv static int wd_discard(device_t, off_t, off_t);
201 1.434 mlelstv static void wdbiorestart(void *);
202 1.434 mlelstv static void wddone(device_t, struct ata_xfer *);
203 1.434 mlelstv static int wd_get_params(struct wd_softc *, uint8_t, struct ataparams *);
204 1.434 mlelstv static void wd_set_geometry(struct wd_softc *);
205 1.434 mlelstv static int wd_flushcache(struct wd_softc *, int, bool);
206 1.434 mlelstv static int wd_trim(struct wd_softc *, daddr_t, long);
207 1.434 mlelstv static bool wd_shutdown(device_t, int);
208 1.108 mycroft
209 1.434 mlelstv static int wd_getcache(struct wd_softc *, int *);
210 1.434 mlelstv static int wd_setcache(struct wd_softc *, int);
211 1.248 bouyer
212 1.430 jdolecek static void wd_sysctl_attach(struct wd_softc *);
213 1.430 jdolecek static void wd_sysctl_detach(struct wd_softc *);
214 1.430 jdolecek
215 1.420 mlelstv struct dkdriver wddkdriver = {
216 1.434 mlelstv .d_open = wdopen,
217 1.434 mlelstv .d_close = wdclose,
218 1.420 mlelstv .d_strategy = wdstrategy,
219 1.434 mlelstv .d_minphys = wdminphys,
220 1.434 mlelstv .d_diskstart = wd_diskstart,
221 1.434 mlelstv .d_dumpblocks = wd_dumpblocks,
222 1.434 mlelstv .d_iosize = wd_iosize,
223 1.434 mlelstv .d_firstopen = wd_firstopen,
224 1.434 mlelstv .d_lastclose = wd_lastclose,
225 1.434 mlelstv .d_discard = wd_discard
226 1.420 mlelstv };
227 1.65 mycroft
228 1.170 leo #ifdef HAS_BAD144_HANDLING
229 1.259 dsl static void bad144intern(struct wd_softc *);
230 1.170 leo #endif
231 1.1 cgd
232 1.239 thorpej #define WD_QUIRK_SPLIT_MOD15_WRITE 0x0001 /* must split certain writes */
233 1.239 thorpej
234 1.327 lukem #define WD_QUIRK_FMT "\20\1SPLIT_MOD15_WRITE\2FORCE_LBA48"
235 1.327 lukem
236 1.239 thorpej /*
237 1.239 thorpej * Quirk table for IDE drives. Put more-specific matches first, since
238 1.389 jakllsch * a simple globing routine is used for matching.
239 1.239 thorpej */
240 1.239 thorpej static const struct wd_quirk {
241 1.239 thorpej const char *wdq_match; /* inquiry pattern to match */
242 1.239 thorpej int wdq_quirks; /* drive quirks */
243 1.239 thorpej } wd_quirk_table[] = {
244 1.239 thorpej /*
245 1.239 thorpej * Some Seagate S-ATA drives have a PHY which can get confused
246 1.239 thorpej * with the way data is packetized by some S-ATA controllers.
247 1.239 thorpej *
248 1.246 mason * The work-around is to split in two any write transfer whose
249 1.239 thorpej * sector count % 15 == 1 (assuming 512 byte sectors).
250 1.239 thorpej *
251 1.239 thorpej * XXX This is an incomplete list. There are at least a couple
252 1.239 thorpej * XXX more model numbers. If you have trouble with such transfers
253 1.239 thorpej * XXX (8K is the most common) on Seagate S-ATA drives, please
254 1.269 keihan * XXX notify thorpej (at) NetBSD.org.
255 1.389 jakllsch *
256 1.389 jakllsch * The ST360015AS has not yet been confirmed to have this
257 1.389 jakllsch * issue, however, it is the only other drive in the
258 1.389 jakllsch * Seagate Barracuda Serial ATA V family.
259 1.389 jakllsch *
260 1.239 thorpej */
261 1.239 thorpej { "ST3120023AS",
262 1.247 explorer WD_QUIRK_SPLIT_MOD15_WRITE },
263 1.247 explorer { "ST380023AS",
264 1.239 thorpej WD_QUIRK_SPLIT_MOD15_WRITE },
265 1.425 jakllsch { "ST360015AS",
266 1.389 jakllsch WD_QUIRK_SPLIT_MOD15_WRITE },
267 1.239 thorpej { NULL,
268 1.239 thorpej 0 }
269 1.239 thorpej };
270 1.239 thorpej
271 1.239 thorpej static const struct wd_quirk *
272 1.239 thorpej wd_lookup_quirks(const char *name)
273 1.239 thorpej {
274 1.239 thorpej const struct wd_quirk *wdq;
275 1.239 thorpej const char *estr;
276 1.239 thorpej
277 1.239 thorpej for (wdq = wd_quirk_table; wdq->wdq_match != NULL; wdq++) {
278 1.239 thorpej /*
279 1.239 thorpej * We only want exact matches (which include matches
280 1.239 thorpej * against globbing characters).
281 1.239 thorpej */
282 1.239 thorpej if (pmatch(name, wdq->wdq_match, &estr) == 2)
283 1.239 thorpej return (wdq);
284 1.239 thorpej }
285 1.239 thorpej return (NULL);
286 1.239 thorpej }
287 1.239 thorpej
288 1.434 mlelstv static int
289 1.373 cegger wdprobe(device_t parent, cfdata_t match, void *aux)
290 1.1 cgd {
291 1.216 bouyer struct ata_device *adev = aux;
292 1.167 thorpej
293 1.216 bouyer if (adev == NULL)
294 1.181 bouyer return 0;
295 1.216 bouyer if (adev->adev_bustype->bustype_type != SCSIPI_BUSTYPE_ATA)
296 1.64 mycroft return 0;
297 1.181 bouyer
298 1.263 bouyer if (match->cf_loc[ATA_HLCF_DRIVE] != ATA_HLCF_DRIVE_DEFAULT &&
299 1.263 bouyer match->cf_loc[ATA_HLCF_DRIVE] != adev->adev_drv_data->drive)
300 1.74 mycroft return 0;
301 1.74 mycroft return 1;
302 1.74 mycroft }
303 1.64 mycroft
304 1.434 mlelstv static void
305 1.373 cegger wdattach(device_t parent, device_t self, void *aux)
306 1.74 mycroft {
307 1.360 cube struct wd_softc *wd = device_private(self);
308 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
309 1.216 bouyer struct ata_device *adev= aux;
310 1.74 mycroft int i, blank;
311 1.301 christos char tbuf[41], pbuf[9], c, *p, *q;
312 1.239 thorpej const struct wd_quirk *wdq;
313 1.434 mlelstv int dtype = DKTYPE_UNKNOWN;
314 1.350 itohy
315 1.434 mlelstv dksc->sc_dev = self;
316 1.360 cube
317 1.289 thorpej ATADEBUG_PRINT(("wdattach\n"), DEBUG_FUNCS | DEBUG_PROBE);
318 1.430 jdolecek mutex_init(&wd->sc_lock, MUTEX_DEFAULT, IPL_BIO);
319 1.292 drochner #ifdef WD_SOFTBADSECT
320 1.241 darrenr SLIST_INIT(&wd->sc_bslist);
321 1.292 drochner #endif
322 1.217 bouyer wd->atabus = adev->adev_bustype;
323 1.235 simonb wd->drvp = adev->adev_drv_data;
324 1.270 thorpej
325 1.430 jdolecek wd->drvp->drv_openings = 1;
326 1.430 jdolecek wd->drvp->drv_start = wdstart;
327 1.270 thorpej wd->drvp->drv_done = wddone;
328 1.434 mlelstv wd->drvp->drv_softc = dksc->sc_dev; /* done in atabusconfig_thread()
329 1.400 bouyer but too late */
330 1.181 bouyer
331 1.253 thorpej aprint_naive("\n");
332 1.386 enami aprint_normal("\n");
333 1.253 thorpej
334 1.181 bouyer /* read our drive info */
335 1.261 mycroft if (wd_get_params(wd, AT_WAIT, &wd->sc_params) != 0) {
336 1.386 enami aprint_error_dev(self, "IDENTIFY failed\n");
337 1.400 bouyer goto out;
338 1.181 bouyer }
339 1.163 bouyer
340 1.301 christos for (blank = 0, p = wd->sc_params.atap_model, q = tbuf, i = 0;
341 1.181 bouyer i < sizeof(wd->sc_params.atap_model); i++) {
342 1.135 mycroft c = *p++;
343 1.135 mycroft if (c == '\0')
344 1.135 mycroft break;
345 1.135 mycroft if (c != ' ') {
346 1.135 mycroft if (blank) {
347 1.135 mycroft *q++ = ' ';
348 1.135 mycroft blank = 0;
349 1.135 mycroft }
350 1.135 mycroft *q++ = c;
351 1.135 mycroft } else
352 1.135 mycroft blank = 1;
353 1.195 enami }
354 1.135 mycroft *q++ = '\0';
355 1.135 mycroft
356 1.386 enami aprint_normal_dev(self, "<%s>\n", tbuf);
357 1.113 mycroft
358 1.301 christos wdq = wd_lookup_quirks(tbuf);
359 1.239 thorpej if (wdq != NULL)
360 1.239 thorpej wd->sc_quirks = wdq->wdq_quirks;
361 1.239 thorpej
362 1.327 lukem if (wd->sc_quirks != 0) {
363 1.327 lukem char sbuf[sizeof(WD_QUIRK_FMT) + 64];
364 1.366 christos snprintb(sbuf, sizeof(sbuf), WD_QUIRK_FMT, wd->sc_quirks);
365 1.360 cube aprint_normal_dev(self, "quirks %s\n", sbuf);
366 1.429 jdolecek
367 1.429 jdolecek if (wd->sc_quirks & WD_QUIRK_SPLIT_MOD15_WRITE) {
368 1.429 jdolecek aprint_error_dev(self, "drive corrupts write transfers with certain controllers, consider replacing\n");
369 1.429 jdolecek }
370 1.327 lukem }
371 1.327 lukem
372 1.181 bouyer if ((wd->sc_params.atap_multi & 0xff) > 1) {
373 1.430 jdolecek wd->drvp->multi = wd->sc_params.atap_multi & 0xff;
374 1.113 mycroft } else {
375 1.430 jdolecek wd->drvp->multi = 1;
376 1.113 mycroft }
377 1.113 mycroft
378 1.360 cube aprint_verbose_dev(self, "drive supports %d-sector PIO transfers,",
379 1.430 jdolecek wd->drvp->multi);
380 1.172 mycroft
381 1.220 christos /* 48-bit LBA addressing */
382 1.268 yamt if ((wd->sc_params.atap_cmd2_en & ATA_CMD2_LBA48) != 0)
383 1.220 christos wd->sc_flags |= WDF_LBA48;
384 1.220 christos
385 1.172 mycroft /* Prior to ATA-4, LBA was optional. */
386 1.181 bouyer if ((wd->sc_params.atap_capabilities1 & WDC_CAP_LBA) != 0)
387 1.181 bouyer wd->sc_flags |= WDF_LBA;
388 1.174 mycroft #if 0
389 1.172 mycroft /* ATA-4 requires LBA. */
390 1.181 bouyer if (wd->sc_params.atap_ataversion != 0xffff &&
391 1.181 bouyer wd->sc_params.atap_ataversion >= WDC_VER_ATA4)
392 1.181 bouyer wd->sc_flags |= WDF_LBA;
393 1.174 mycroft #endif
394 1.172 mycroft
395 1.220 christos if ((wd->sc_flags & WDF_LBA48) != 0) {
396 1.336 ad aprint_verbose(" LBA48 addressing\n");
397 1.220 christos wd->sc_capacity =
398 1.413 matt ((uint64_t) wd->sc_params.atap_max_lba[3] << 48) |
399 1.413 matt ((uint64_t) wd->sc_params.atap_max_lba[2] << 32) |
400 1.413 matt ((uint64_t) wd->sc_params.atap_max_lba[1] << 16) |
401 1.413 matt ((uint64_t) wd->sc_params.atap_max_lba[0] << 0);
402 1.380 bouyer wd->sc_capacity28 =
403 1.380 bouyer (wd->sc_params.atap_capacity[1] << 16) |
404 1.380 bouyer wd->sc_params.atap_capacity[0];
405 1.220 christos } else if ((wd->sc_flags & WDF_LBA) != 0) {
406 1.336 ad aprint_verbose(" LBA addressing\n");
407 1.380 bouyer wd->sc_capacity28 = wd->sc_capacity =
408 1.380 bouyer (wd->sc_params.atap_capacity[1] << 16) |
409 1.181 bouyer wd->sc_params.atap_capacity[0];
410 1.172 mycroft } else {
411 1.336 ad aprint_verbose(" chs addressing\n");
412 1.380 bouyer wd->sc_capacity28 = wd->sc_capacity =
413 1.181 bouyer wd->sc_params.atap_cylinders *
414 1.181 bouyer wd->sc_params.atap_heads *
415 1.181 bouyer wd->sc_params.atap_sectors;
416 1.172 mycroft }
417 1.424 jakllsch if ((wd->sc_params.atap_secsz & ATA_SECSZ_VALID_MASK) == ATA_SECSZ_VALID
418 1.424 jakllsch && ((wd->sc_params.atap_secsz & ATA_SECSZ_LLS) != 0)) {
419 1.424 jakllsch wd->sc_blksize = 2ULL *
420 1.426 christos ((uint32_t)((wd->sc_params.atap_lls_secsz[1] << 16) |
421 1.426 christos wd->sc_params.atap_lls_secsz[0]));
422 1.424 jakllsch } else {
423 1.424 jakllsch wd->sc_blksize = 512;
424 1.424 jakllsch }
425 1.424 jakllsch wd->sc_capacity512 = (wd->sc_capacity * wd->sc_blksize) / DEV_BSIZE;
426 1.424 jakllsch format_bytes(pbuf, sizeof(pbuf), wd->sc_capacity * wd->sc_blksize);
427 1.360 cube aprint_normal_dev(self, "%s, %d cyl, %d head, %d sec, "
428 1.240 fvdl "%d bytes/sect x %llu sectors\n",
429 1.360 cube pbuf,
430 1.260 bouyer (wd->sc_flags & WDF_LBA) ? (int)(wd->sc_capacity /
431 1.260 bouyer (wd->sc_params.atap_heads * wd->sc_params.atap_sectors)) :
432 1.260 bouyer wd->sc_params.atap_cylinders,
433 1.201 enami wd->sc_params.atap_heads, wd->sc_params.atap_sectors,
434 1.424 jakllsch wd->sc_blksize, (unsigned long long)wd->sc_capacity);
435 1.201 enami
436 1.289 thorpej ATADEBUG_PRINT(("%s: atap_dmatiming_mimi=%d, atap_dmatiming_recom=%d\n",
437 1.360 cube device_xname(self), wd->sc_params.atap_dmatiming_mimi,
438 1.181 bouyer wd->sc_params.atap_dmatiming_recom), DEBUG_PROBE);
439 1.424 jakllsch
440 1.424 jakllsch if (wd->sc_blksize <= 0 || !powerof2(wd->sc_blksize) ||
441 1.424 jakllsch wd->sc_blksize < DEV_BSIZE || wd->sc_blksize > MAXPHYS) {
442 1.424 jakllsch aprint_normal_dev(self, "WARNING: block size %u "
443 1.424 jakllsch "might not actually work\n", wd->sc_blksize);
444 1.424 jakllsch }
445 1.430 jdolecek
446 1.434 mlelstv if (strcmp(wd->sc_params.atap_model, "ST506") == 0)
447 1.434 mlelstv dtype = DKTYPE_ST506;
448 1.434 mlelstv else
449 1.434 mlelstv dtype = DKTYPE_ESDI;
450 1.434 mlelstv
451 1.400 bouyer out:
452 1.181 bouyer /*
453 1.181 bouyer * Initialize and attach the disk structure.
454 1.181 bouyer */
455 1.434 mlelstv dk_init(dksc, self, dtype);
456 1.434 mlelstv disk_init(&dksc->sc_dkdev, dksc->sc_xname, &wddkdriver);
457 1.434 mlelstv
458 1.434 mlelstv /* Attach dk and disk subsystems */
459 1.434 mlelstv dk_attach(dksc);
460 1.434 mlelstv disk_attach(&dksc->sc_dkdev);
461 1.434 mlelstv wd_set_geometry(wd);
462 1.434 mlelstv
463 1.434 mlelstv bufq_alloc(&dksc->sc_bufq, BUFQ_DISK_DEFAULT_STRAT, BUFQ_SORT_RAWBLOCK);
464 1.434 mlelstv
465 1.434 mlelstv /* reference to label structure, used by ata code */
466 1.434 mlelstv wd->drvp->lp = dksc->sc_dkdev.dk_label;
467 1.294 thorpej
468 1.294 thorpej /* Discover wedges on this disk. */
469 1.434 mlelstv dkwedge_discover(&dksc->sc_dkdev);
470 1.351 jmcneill
471 1.357 drochner if (!pmf_device_register1(self, wd_suspend, NULL, wd_shutdown))
472 1.351 jmcneill aprint_error_dev(self, "couldn't establish power handler\n");
473 1.430 jdolecek
474 1.430 jdolecek wd_sysctl_attach(wd);
475 1.351 jmcneill }
476 1.351 jmcneill
477 1.351 jmcneill static bool
478 1.384 dyoung wd_suspend(device_t dv, const pmf_qual_t *qual)
479 1.351 jmcneill {
480 1.351 jmcneill struct wd_softc *sc = device_private(dv);
481 1.351 jmcneill
482 1.406 drochner /* the adapter needs to be enabled */
483 1.406 drochner if (sc->atabus->ata_addref(sc->drvp))
484 1.406 drochner return true; /* no need to complain */
485 1.406 drochner
486 1.430 jdolecek wd_flushcache(sc, AT_WAIT, false);
487 1.356 drochner wd_standby(sc, AT_WAIT);
488 1.406 drochner
489 1.406 drochner sc->atabus->ata_delref(sc->drvp);
490 1.351 jmcneill return true;
491 1.196 enami }
492 1.196 enami
493 1.434 mlelstv static int
494 1.373 cegger wddetach(device_t self, int flags)
495 1.196 enami {
496 1.434 mlelstv struct wd_softc *wd = device_private(self);
497 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
498 1.430 jdolecek int bmaj, cmaj, i, mn, rc;
499 1.374 dyoung
500 1.434 mlelstv if ((rc = disk_begindetach(&dksc->sc_dkdev, wd_lastclose, self, flags)) != 0)
501 1.374 dyoung return rc;
502 1.196 enami
503 1.196 enami /* locate the major number */
504 1.225 gehenna bmaj = bdevsw_lookup_major(&wd_bdevsw);
505 1.225 gehenna cmaj = cdevsw_lookup_major(&wd_cdevsw);
506 1.196 enami
507 1.286 mycroft /* Nuke the vnodes for any open instances. */
508 1.286 mycroft for (i = 0; i < MAXPARTITIONS; i++) {
509 1.321 thorpej mn = WDMINOR(device_unit(self), i);
510 1.286 mycroft vdevgone(bmaj, mn, mn, VBLK);
511 1.286 mycroft vdevgone(cmaj, mn, mn, VCHR);
512 1.286 mycroft }
513 1.286 mycroft
514 1.434 mlelstv dk_drain(dksc);
515 1.294 thorpej
516 1.434 mlelstv /* Kill off any pending commands. */
517 1.434 mlelstv mutex_enter(&wd->sc_lock);
518 1.434 mlelstv wd->atabus->ata_killpending(wd->drvp);
519 1.434 mlelstv mutex_exit(&wd->sc_lock);
520 1.196 enami
521 1.434 mlelstv bufq_free(dksc->sc_bufq);
522 1.224 hannken
523 1.434 mlelstv if (flags & DETACH_POWEROFF)
524 1.434 mlelstv wd_standby(wd, AT_POLL);
525 1.430 jdolecek
526 1.434 mlelstv /* Delete all of our wedges. */
527 1.434 mlelstv dkwedge_delall(&dksc->sc_dkdev);
528 1.196 enami
529 1.434 mlelstv /* Detach from the disk list. */
530 1.434 mlelstv disk_detach(&dksc->sc_dkdev);
531 1.434 mlelstv disk_destroy(&dksc->sc_dkdev);
532 1.196 enami
533 1.434 mlelstv dk_detach(dksc);
534 1.196 enami
535 1.292 drochner #ifdef WD_SOFTBADSECT
536 1.282 bouyer /* Clean out the bad sector list */
537 1.282 bouyer while (!SLIST_EMPTY(&sc->sc_bslist)) {
538 1.282 bouyer void *head = SLIST_FIRST(&sc->sc_bslist);
539 1.282 bouyer SLIST_REMOVE_HEAD(&sc->sc_bslist, dbs_next);
540 1.282 bouyer free(head, M_TEMP);
541 1.282 bouyer }
542 1.282 bouyer sc->sc_bscount = 0;
543 1.292 drochner #endif
544 1.282 bouyer
545 1.351 jmcneill pmf_device_deregister(self);
546 1.196 enami
547 1.434 mlelstv wd_sysctl_detach(wd);
548 1.430 jdolecek
549 1.434 mlelstv mutex_destroy(&wd->sc_lock);
550 1.196 enami
551 1.434 mlelstv wd->drvp->drive_type = ATA_DRIVET_NONE; /* no drive any more here */
552 1.434 mlelstv wd->drvp->drive_flags = 0;
553 1.283 bouyer
554 1.196 enami return (0);
555 1.1 cgd }
556 1.1 cgd
557 1.64 mycroft /*
558 1.135 mycroft * Read/write routine for a buffer. Validates the arguments and schedules the
559 1.135 mycroft * transfer. Does not wait for the transfer to complete.
560 1.1 cgd */
561 1.434 mlelstv static void
562 1.259 dsl wdstrategy(struct buf *bp)
563 1.1 cgd {
564 1.360 cube struct wd_softc *wd =
565 1.363 tsutsui device_lookup_private(&wd_cd, WDUNIT(bp->b_dev));
566 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
567 1.202 thorpej
568 1.434 mlelstv ATADEBUG_PRINT(("wdstrategy (%s)\n", dksc->sc_xname),
569 1.182 bouyer DEBUG_XFERS);
570 1.259 dsl
571 1.375 dyoung /* If device invalidated (e.g. media change, door open,
572 1.385 dyoung * device detachment), then error.
573 1.375 dyoung */
574 1.385 dyoung if ((wd->sc_flags & WDF_LOADED) == 0 ||
575 1.434 mlelstv !device_is_enabled(dksc->sc_dev))
576 1.434 mlelstv goto err;
577 1.202 thorpej
578 1.292 drochner #ifdef WD_SOFTBADSECT
579 1.241 darrenr /*
580 1.241 darrenr * If the transfer about to be attempted contains only a block that
581 1.241 darrenr * is known to be bad then return an error for the transfer without
582 1.241 darrenr * even attempting to start a transfer up under the premis that we
583 1.241 darrenr * will just end up doing more retries for a transfer that will end
584 1.241 darrenr * up failing again.
585 1.241 darrenr */
586 1.241 darrenr if (__predict_false(!SLIST_EMPTY(&wd->sc_bslist))) {
587 1.241 darrenr struct disk_badsectors *dbs;
588 1.424 jakllsch daddr_t maxblk = blkno + (bp->b_bcount / wd->sc_blksize) - 1;
589 1.241 darrenr
590 1.430 jdolecek mutex_enter(&wd->sc_lock);
591 1.241 darrenr SLIST_FOREACH(dbs, &wd->sc_bslist, dbs_next)
592 1.243 darrenr if ((dbs->dbs_min <= blkno && blkno <= dbs->dbs_max) ||
593 1.245 darrenr (dbs->dbs_min <= maxblk && maxblk <= dbs->dbs_max)){
594 1.430 jdolecek mutex_exit(&wd->sc_lock);
595 1.434 mlelstv goto err;
596 1.245 darrenr }
597 1.430 jdolecek mutex_exit(&wd->sc_lock);
598 1.241 darrenr }
599 1.292 drochner #endif
600 1.241 darrenr
601 1.434 mlelstv dk_strategy(dksc, bp);
602 1.434 mlelstv return;
603 1.430 jdolecek
604 1.434 mlelstv err:
605 1.434 mlelstv bp->b_error = EIO;
606 1.135 mycroft bp->b_resid = bp->b_bcount;
607 1.1 cgd biodone(bp);
608 1.1 cgd }
609 1.1 cgd
610 1.434 mlelstv static int
611 1.434 mlelstv wd_diskstart(device_t dev, struct buf *bp)
612 1.1 cgd {
613 1.434 mlelstv struct wd_softc *wd = device_private(dev);
614 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
615 1.430 jdolecek struct ata_xfer *xfer;
616 1.163 bouyer
617 1.430 jdolecek mutex_enter(&wd->sc_lock);
618 1.163 bouyer
619 1.434 mlelstv xfer = ata_get_xfer_ext(wd->drvp->chnl_softc, 0,
620 1.434 mlelstv WD_USE_NCQ(wd) ? WD_MAX_OPENINGS(wd) : 0);
621 1.434 mlelstv if (xfer == NULL) {
622 1.434 mlelstv ATADEBUG_PRINT(("wdstart %s no xfer\n",
623 1.434 mlelstv dksc->sc_xname), DEBUG_XFERS);
624 1.434 mlelstv mutex_exit(&wd->sc_lock);
625 1.434 mlelstv return EAGAIN;
626 1.433 jdolecek }
627 1.430 jdolecek
628 1.430 jdolecek KASSERT(bp == xfer->c_bio.bp || xfer->c_bio.bp == NULL);
629 1.430 jdolecek KASSERT((xfer->c_flags & (C_WAITACT|C_FREE)) == 0);
630 1.430 jdolecek
631 1.430 jdolecek /* Reset state, so that retries don't use stale info */
632 1.430 jdolecek if (__predict_false(xfer->c_retries > 0)) {
633 1.430 jdolecek xfer->c_flags = 0;
634 1.430 jdolecek memset(&xfer->c_bio, 0, sizeof(xfer->c_bio));
635 1.430 jdolecek }
636 1.430 jdolecek
637 1.430 jdolecek xfer->c_bio.blkno = bp->b_rawblkno;
638 1.430 jdolecek xfer->c_bio.bcount = bp->b_bcount;
639 1.430 jdolecek xfer->c_bio.databuf = bp->b_data;
640 1.430 jdolecek xfer->c_bio.blkdone = 0;
641 1.430 jdolecek xfer->c_bio.bp = bp;
642 1.430 jdolecek
643 1.430 jdolecek #ifdef WD_CHAOS_MONKEY
644 1.430 jdolecek /*
645 1.430 jdolecek * Override blkno to be over device capacity to trigger error,
646 1.430 jdolecek * but only if it's read, to avoid trashing disk contents should
647 1.430 jdolecek * the command be clipped, or otherwise misinterpreted, by the
648 1.430 jdolecek * driver or controller.
649 1.430 jdolecek */
650 1.430 jdolecek if (BUF_ISREAD(bp) && xfer->c_retries == 0 && wd->drv_chaos_freq > 0 &&
651 1.430 jdolecek (++wd->drv_chaos_cnt % wd->drv_chaos_freq) == 0) {
652 1.434 mlelstv aprint_normal_dev(dksc->sc_dev, "%s: chaos xfer %d\n",
653 1.430 jdolecek __func__, xfer->c_slot);
654 1.430 jdolecek xfer->c_bio.blkno = 7777777 + wd->sc_capacity;
655 1.430 jdolecek xfer->c_flags |= C_CHAOS;
656 1.430 jdolecek }
657 1.430 jdolecek #endif
658 1.202 thorpej
659 1.181 bouyer /*
660 1.181 bouyer * If we're retrying, retry in single-sector mode. This will give us
661 1.181 bouyer * the sector number of the problem, and will eventually allow the
662 1.430 jdolecek * transfer to succeed. If FUA is requested, we can't actually
663 1.430 jdolecek * do this, as ATA_SINGLE is usually executed as PIO transfer by drivers
664 1.430 jdolecek * which support it, and that isn't compatible with NCQ/FUA.
665 1.181 bouyer */
666 1.430 jdolecek if (xfer->c_retries >= WDIORETRIES_SINGLE &&
667 1.430 jdolecek (bp->b_flags & B_MEDIA_FUA) == 0)
668 1.430 jdolecek xfer->c_bio.flags = ATA_SINGLE;
669 1.181 bouyer else
670 1.430 jdolecek xfer->c_bio.flags = 0;
671 1.434 mlelstv
672 1.434 mlelstv /*
673 1.434 mlelstv * request LBA48 transfers when supported by the controller
674 1.434 mlelstv * and needed by transfer offset or size.
675 1.434 mlelstv */
676 1.295 bouyer if (wd->sc_flags & WDF_LBA48 &&
677 1.430 jdolecek (((xfer->c_bio.blkno +
678 1.434 mlelstv xfer->c_bio.bcount / dksc->sc_dkdev.dk_geom.dg_secsize) >
679 1.430 jdolecek wd->sc_capacity28) ||
680 1.434 mlelstv ((xfer->c_bio.bcount / dksc->sc_dkdev.dk_geom.dg_secsize) > 128)))
681 1.430 jdolecek xfer->c_bio.flags |= ATA_LBA48;
682 1.430 jdolecek
683 1.430 jdolecek /*
684 1.430 jdolecek * If NCQ was negotiated, always use it for the first several attempts.
685 1.430 jdolecek * Since device cancels all outstanding requests on error, downgrade
686 1.430 jdolecek * to non-NCQ on retry, so that the retried transfer would not cause
687 1.430 jdolecek * cascade failure for the other transfers if it fails again.
688 1.430 jdolecek * If FUA was requested, we can't downgrade, as that would violate
689 1.430 jdolecek * the semantics - FUA would not be honored. In that case, continue
690 1.430 jdolecek * retrying with NCQ.
691 1.430 jdolecek */
692 1.430 jdolecek if (WD_USE_NCQ(wd) && (xfer->c_retries < WDIORETRIES_SINGLE ||
693 1.430 jdolecek (bp->b_flags & B_MEDIA_FUA) != 0)) {
694 1.430 jdolecek xfer->c_bio.flags |= ATA_LBA48;
695 1.430 jdolecek xfer->c_flags |= C_NCQ;
696 1.430 jdolecek
697 1.430 jdolecek if (WD_USE_NCQ_PRIO(wd) &&
698 1.430 jdolecek BIO_GETPRIO(bp) == BPRIO_TIMECRITICAL)
699 1.430 jdolecek xfer->c_bio.flags |= ATA_PRIO_HIGH;
700 1.430 jdolecek }
701 1.430 jdolecek
702 1.181 bouyer if (wd->sc_flags & WDF_LBA)
703 1.430 jdolecek xfer->c_bio.flags |= ATA_LBA;
704 1.181 bouyer if (bp->b_flags & B_READ)
705 1.430 jdolecek xfer->c_bio.flags |= ATA_READ;
706 1.430 jdolecek if (bp->b_flags & B_MEDIA_FUA) {
707 1.430 jdolecek /* If not using NCQ, the command WRITE DMA FUA EXT is LBA48 */
708 1.430 jdolecek KASSERT((wd->sc_flags & WDF_LBA48) != 0);
709 1.430 jdolecek if ((xfer->c_flags & C_NCQ) == 0)
710 1.430 jdolecek xfer->c_bio.flags |= ATA_LBA48;
711 1.430 jdolecek
712 1.430 jdolecek xfer->c_bio.flags |= ATA_FUA;
713 1.430 jdolecek }
714 1.430 jdolecek
715 1.430 jdolecek switch (wd->atabus->ata_bio(wd->drvp, xfer)) {
716 1.288 thorpej case ATACMD_TRY_AGAIN:
717 1.430 jdolecek panic("wdstart1: try again");
718 1.181 bouyer break;
719 1.288 thorpej case ATACMD_QUEUED:
720 1.288 thorpej case ATACMD_COMPLETE:
721 1.181 bouyer break;
722 1.181 bouyer default:
723 1.382 pooka panic("wdstart1: bad return code from ata_bio()");
724 1.181 bouyer }
725 1.434 mlelstv
726 1.434 mlelstv mutex_exit(&wd->sc_lock);
727 1.434 mlelstv
728 1.434 mlelstv return 0;
729 1.181 bouyer }
730 1.181 bouyer
731 1.434 mlelstv /*
732 1.434 mlelstv * Queue a drive for I/O.
733 1.434 mlelstv */
734 1.434 mlelstv static void
735 1.434 mlelstv wdstart(device_t self)
736 1.434 mlelstv {
737 1.434 mlelstv struct wd_softc *wd = device_private(self);
738 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
739 1.434 mlelstv
740 1.434 mlelstv ATADEBUG_PRINT(("wdstart %s\n", dksc->sc_xname),
741 1.434 mlelstv DEBUG_XFERS);
742 1.434 mlelstv
743 1.434 mlelstv if (!device_is_active(dksc->sc_dev))
744 1.434 mlelstv return;
745 1.434 mlelstv
746 1.434 mlelstv /*
747 1.434 mlelstv * Do not queue any transfers until flush is finished, so that
748 1.434 mlelstv * once flush is pending, it will get handled as soon as xfer
749 1.434 mlelstv * is available.
750 1.434 mlelstv */
751 1.434 mlelstv if (ISSET(wd->sc_flags, WDF_FLUSH_PEND)) {
752 1.434 mlelstv ATADEBUG_PRINT(("wdstart %s flush pend\n",
753 1.434 mlelstv dksc->sc_xname), DEBUG_XFERS);
754 1.434 mlelstv return;
755 1.434 mlelstv }
756 1.434 mlelstv
757 1.434 mlelstv dk_start(dksc, NULL);
758 1.434 mlelstv }
759 1.434 mlelstv
760 1.434 mlelstv static void
761 1.430 jdolecek wddone(device_t self, struct ata_xfer *xfer)
762 1.181 bouyer {
763 1.430 jdolecek struct wd_softc *wd = device_private(self);
764 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
765 1.221 yamt const char *errmsg;
766 1.221 yamt int do_perror = 0;
767 1.430 jdolecek struct buf *bp;
768 1.349 itohy
769 1.434 mlelstv ATADEBUG_PRINT(("wddone %s\n", dksc->sc_xname),
770 1.182 bouyer DEBUG_XFERS);
771 1.430 jdolecek
772 1.430 jdolecek if (__predict_false(wddoingadump)) {
773 1.430 jdolecek /* just drop it to the floor */
774 1.430 jdolecek ata_free_xfer(wd->drvp->chnl_softc, xfer);
775 1.214 bjh21 return;
776 1.430 jdolecek }
777 1.430 jdolecek
778 1.430 jdolecek bp = xfer->c_bio.bp;
779 1.430 jdolecek KASSERT(bp != NULL);
780 1.430 jdolecek
781 1.430 jdolecek bp->b_resid = xfer->c_bio.bcount;
782 1.430 jdolecek switch (xfer->c_bio.error) {
783 1.181 bouyer case ERR_DMA:
784 1.221 yamt errmsg = "DMA error";
785 1.181 bouyer goto retry;
786 1.181 bouyer case ERR_DF:
787 1.221 yamt errmsg = "device fault";
788 1.181 bouyer goto retry;
789 1.181 bouyer case TIMEOUT:
790 1.221 yamt errmsg = "device timeout";
791 1.181 bouyer goto retry;
792 1.430 jdolecek case REQUEUE:
793 1.430 jdolecek errmsg = "requeue";
794 1.430 jdolecek goto retry2;
795 1.281 bouyer case ERR_RESET:
796 1.281 bouyer errmsg = "channel reset";
797 1.281 bouyer goto retry2;
798 1.181 bouyer case ERROR:
799 1.181 bouyer /* Don't care about media change bits */
800 1.430 jdolecek if (xfer->c_bio.r_error != 0 &&
801 1.430 jdolecek (xfer->c_bio.r_error & ~(WDCE_MC | WDCE_MCR)) == 0)
802 1.181 bouyer goto noerror;
803 1.221 yamt errmsg = "error";
804 1.221 yamt do_perror = 1;
805 1.181 bouyer retry: /* Just reset and retry. Can we do more ? */
806 1.431 jdolecek if ((xfer->c_flags & C_RECOVERED) == 0) {
807 1.431 jdolecek int wflags = (xfer->c_flags & C_POLL) ? AT_POLL : 0;
808 1.431 jdolecek (*wd->atabus->ata_reset_drive)(wd->drvp, wflags, NULL);
809 1.431 jdolecek }
810 1.281 bouyer retry2:
811 1.430 jdolecek mutex_enter(&wd->sc_lock);
812 1.430 jdolecek
813 1.221 yamt diskerr(bp, "wd", errmsg, LOG_PRINTF,
814 1.434 mlelstv xfer->c_bio.blkdone, dksc->sc_dkdev.dk_label);
815 1.430 jdolecek if (xfer->c_retries < WDIORETRIES)
816 1.430 jdolecek printf(", slot %d, retry %d", xfer->c_slot,
817 1.430 jdolecek xfer->c_retries + 1);
818 1.345 bouyer printf("\n");
819 1.221 yamt if (do_perror)
820 1.430 jdolecek wdperror(wd, xfer);
821 1.430 jdolecek
822 1.430 jdolecek if (xfer->c_retries < WDIORETRIES) {
823 1.430 jdolecek xfer->c_retries++;
824 1.430 jdolecek
825 1.430 jdolecek /* Rerun ASAP if just requeued */
826 1.430 jdolecek callout_reset(&xfer->c_retry_callout,
827 1.430 jdolecek (xfer->c_bio.error == REQUEUE) ? 1 : RECOVERYTIME,
828 1.434 mlelstv wdbiorestart, wd);
829 1.430 jdolecek
830 1.430 jdolecek mutex_exit(&wd->sc_lock);
831 1.181 bouyer return;
832 1.181 bouyer }
833 1.241 darrenr
834 1.430 jdolecek mutex_exit(&wd->sc_lock);
835 1.430 jdolecek
836 1.292 drochner #ifdef WD_SOFTBADSECT
837 1.241 darrenr /*
838 1.241 darrenr * Not all errors indicate a failed block but those that do,
839 1.241 darrenr * put the block on the bad-block list for the device. Only
840 1.241 darrenr * do this for reads because the drive should do it for writes,
841 1.241 darrenr * itself, according to Manuel.
842 1.241 darrenr */
843 1.242 dogcow if ((bp->b_flags & B_READ) &&
844 1.430 jdolecek ((wd->drvp->ata_vers >= 4 && xfer->c_bio.r_error & 64) ||
845 1.430 jdolecek (wd->drvp->ata_vers < 4 && xfer->c_bio.r_error & 192))) {
846 1.241 darrenr struct disk_badsectors *dbs;
847 1.241 darrenr
848 1.430 jdolecek dbs = malloc(sizeof *dbs, M_TEMP, M_NOWAIT);
849 1.430 jdolecek if (dbs == NULL) {
850 1.434 mlelstv aprint_error_dev(dksc->sc_dev,
851 1.430 jdolecek "failed to add bad block to list\n");
852 1.430 jdolecek goto out;
853 1.430 jdolecek }
854 1.430 jdolecek
855 1.241 darrenr dbs->dbs_min = bp->b_rawblkno;
856 1.424 jakllsch dbs->dbs_max = dbs->dbs_min +
857 1.424 jakllsch (bp->b_bcount /wd->sc_blksize) - 1;
858 1.241 darrenr microtime(&dbs->dbs_failedat);
859 1.430 jdolecek
860 1.430 jdolecek mutex_enter(&wd->sc_lock);
861 1.241 darrenr SLIST_INSERT_HEAD(&wd->sc_bslist, dbs, dbs_next);
862 1.243 darrenr wd->sc_bscount++;
863 1.430 jdolecek mutex_exit(&wd->sc_lock);
864 1.241 darrenr }
865 1.430 jdolecek out:
866 1.292 drochner #endif
867 1.181 bouyer bp->b_error = EIO;
868 1.181 bouyer break;
869 1.181 bouyer case NOERROR:
870 1.430 jdolecek noerror: if ((xfer->c_bio.flags & ATA_CORR) || xfer->c_retries > 0)
871 1.434 mlelstv aprint_error_dev(dksc->sc_dev,
872 1.430 jdolecek "soft error (corrected) slot %d\n", xfer->c_slot);
873 1.430 jdolecek #ifdef WD_CHAOS_MONKEY
874 1.430 jdolecek KASSERT((xfer->c_flags & C_CHAOS) == 0);
875 1.430 jdolecek #endif
876 1.197 enami break;
877 1.197 enami case ERR_NODEV:
878 1.197 enami bp->b_error = EIO;
879 1.197 enami break;
880 1.64 mycroft }
881 1.393 bouyer if (__predict_false(bp->b_error != 0) && bp->b_resid == 0) {
882 1.393 bouyer /*
883 1.393 bouyer * the disk or controller sometimes report a complete
884 1.393 bouyer * xfer, when there has been an error. This is wrong,
885 1.393 bouyer * assume nothing got transfered in this case
886 1.393 bouyer */
887 1.393 bouyer bp->b_resid = bp->b_bcount;
888 1.393 bouyer }
889 1.434 mlelstv
890 1.430 jdolecek ata_free_xfer(wd->drvp->chnl_softc, xfer);
891 1.434 mlelstv
892 1.434 mlelstv dk_done(dksc, bp);
893 1.434 mlelstv dk_start(dksc, NULL);
894 1.181 bouyer }
895 1.181 bouyer
896 1.430 jdolecek static void
897 1.430 jdolecek wdbiorestart(void *v)
898 1.181 bouyer {
899 1.434 mlelstv struct wd_softc *wd = v;
900 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
901 1.350 itohy
902 1.434 mlelstv ATADEBUG_PRINT(("wdrestart %s\n", dksc->sc_xname),
903 1.182 bouyer DEBUG_XFERS);
904 1.430 jdolecek
905 1.434 mlelstv dk_start(dksc, NULL);
906 1.141 mycroft }
907 1.141 mycroft
908 1.388 jakllsch static void
909 1.388 jakllsch wdminphys(struct buf *bp)
910 1.388 jakllsch {
911 1.424 jakllsch const struct wd_softc * const wd =
912 1.424 jakllsch device_lookup_private(&wd_cd, WDUNIT(bp->b_dev));
913 1.434 mlelstv int maxsectors;
914 1.430 jdolecek
915 1.430 jdolecek /*
916 1.430 jdolecek * The limit is actually 65536 for LBA48 and 256 for non-LBA48,
917 1.430 jdolecek * but that requires to set the count for the ATA command
918 1.430 jdolecek * to 0, which is somewhat error prone, so better stay safe.
919 1.430 jdolecek */
920 1.430 jdolecek if (wd->sc_flags & WDF_LBA48)
921 1.430 jdolecek maxsectors = 65535;
922 1.430 jdolecek else
923 1.430 jdolecek maxsectors = 128;
924 1.430 jdolecek
925 1.430 jdolecek if (bp->b_bcount > (wd->sc_blksize * maxsectors))
926 1.430 jdolecek bp->b_bcount = (wd->sc_blksize * maxsectors);
927 1.388 jakllsch
928 1.388 jakllsch minphys(bp);
929 1.388 jakllsch }
930 1.388 jakllsch
931 1.434 mlelstv static void
932 1.434 mlelstv wd_iosize(device_t dev, int *count)
933 1.434 mlelstv {
934 1.434 mlelstv struct buf B;
935 1.434 mlelstv int bmaj;
936 1.434 mlelstv
937 1.434 mlelstv bmaj = bdevsw_lookup_major(&wd_bdevsw);
938 1.434 mlelstv B.b_dev = MAKEWDDEV(bmaj,device_unit(dev),RAW_PART);
939 1.434 mlelstv B.b_bcount = *count;
940 1.434 mlelstv
941 1.434 mlelstv wdminphys(&B);
942 1.434 mlelstv
943 1.434 mlelstv *count = B.b_bcount;
944 1.434 mlelstv }
945 1.434 mlelstv
946 1.434 mlelstv static int
947 1.335 christos wdread(dev_t dev, struct uio *uio, int flags)
948 1.141 mycroft {
949 1.141 mycroft
950 1.289 thorpej ATADEBUG_PRINT(("wdread\n"), DEBUG_XFERS);
951 1.388 jakllsch return (physio(wdstrategy, NULL, dev, B_READ, wdminphys, uio));
952 1.141 mycroft }
953 1.141 mycroft
954 1.434 mlelstv static int
955 1.335 christos wdwrite(dev_t dev, struct uio *uio, int flags)
956 1.141 mycroft {
957 1.141 mycroft
958 1.289 thorpej ATADEBUG_PRINT(("wdwrite\n"), DEBUG_XFERS);
959 1.388 jakllsch return (physio(wdstrategy, NULL, dev, B_WRITE, wdminphys, uio));
960 1.64 mycroft }
961 1.64 mycroft
962 1.434 mlelstv static int
963 1.335 christos wdopen(dev_t dev, int flag, int fmt, struct lwp *l)
964 1.1 cgd {
965 1.135 mycroft struct wd_softc *wd;
966 1.434 mlelstv struct dk_softc *dksc;
967 1.434 mlelstv int unit, part, error;
968 1.163 bouyer
969 1.289 thorpej ATADEBUG_PRINT(("wdopen\n"), DEBUG_FUNCS);
970 1.434 mlelstv unit = WDUNIT(dev);
971 1.434 mlelstv wd = device_lookup_private(&wd_cd, unit);
972 1.158 pk if (wd == NULL)
973 1.208 thorpej return (ENXIO);
974 1.434 mlelstv dksc = &wd->sc_dksc;
975 1.187 thorpej
976 1.434 mlelstv if (! device_is_active(dksc->sc_dev))
977 1.283 bouyer return (ENODEV);
978 1.283 bouyer
979 1.434 mlelstv part = WDPART(dev);
980 1.434 mlelstv
981 1.400 bouyer if (wd->sc_capacity == 0)
982 1.400 bouyer return (ENODEV);
983 1.400 bouyer
984 1.294 thorpej /*
985 1.434 mlelstv * If any partition is open, but the disk has been invalidated,
986 1.434 mlelstv * disallow further opens.
987 1.294 thorpej */
988 1.434 mlelstv if ((wd->sc_flags & WDF_LOADED) == 0) {
989 1.434 mlelstv if (part != RAW_PART || fmt != S_IFCHR)
990 1.434 mlelstv return EIO;
991 1.294 thorpej }
992 1.294 thorpej
993 1.434 mlelstv error = dk_open(dksc, dev, flag, fmt, l);
994 1.434 mlelstv
995 1.434 mlelstv return error;
996 1.434 mlelstv }
997 1.3 deraadt
998 1.434 mlelstv /*
999 1.434 mlelstv * Serialized by caller
1000 1.434 mlelstv */
1001 1.434 mlelstv static int
1002 1.434 mlelstv wd_firstopen(device_t self, dev_t dev, int flag, int fmt)
1003 1.434 mlelstv {
1004 1.434 mlelstv struct wd_softc *wd = device_private(self);
1005 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
1006 1.434 mlelstv int error;
1007 1.108 mycroft
1008 1.434 mlelstv error = wd->atabus->ata_addref(wd->drvp);
1009 1.434 mlelstv if (error)
1010 1.434 mlelstv return error;
1011 1.108 mycroft
1012 1.434 mlelstv if ((wd->sc_flags & WDF_LOADED) == 0) {
1013 1.434 mlelstv int param_error;
1014 1.259 dsl
1015 1.434 mlelstv /* Load the physical device parameters. */
1016 1.434 mlelstv param_error = wd_get_params(wd, AT_WAIT, &wd->sc_params);
1017 1.434 mlelstv if (param_error != 0) {
1018 1.434 mlelstv aprint_error_dev(dksc->sc_dev, "IDENTIFY failed\n");
1019 1.434 mlelstv error = EIO;
1020 1.434 mlelstv goto bad;
1021 1.434 mlelstv }
1022 1.434 mlelstv wd_set_geometry(wd);
1023 1.434 mlelstv wd->sc_flags |= WDF_LOADED;
1024 1.3 deraadt }
1025 1.60 mycroft
1026 1.37 mycroft return 0;
1027 1.93 mycroft
1028 1.434 mlelstv bad:
1029 1.434 mlelstv wd->atabus->ata_delref(wd->drvp);
1030 1.93 mycroft return error;
1031 1.1 cgd }
1032 1.1 cgd
1033 1.425 jakllsch /*
1034 1.374 dyoung * Caller must hold wd->sc_dk.dk_openlock.
1035 1.374 dyoung */
1036 1.376 dyoung static int
1037 1.434 mlelstv wd_lastclose(device_t self)
1038 1.374 dyoung {
1039 1.376 dyoung struct wd_softc *wd = device_private(self);
1040 1.376 dyoung
1041 1.430 jdolecek wd_flushcache(wd, AT_WAIT, false);
1042 1.374 dyoung
1043 1.374 dyoung wd->atabus->ata_delref(wd->drvp);
1044 1.376 dyoung
1045 1.376 dyoung return 0;
1046 1.374 dyoung }
1047 1.374 dyoung
1048 1.434 mlelstv static int
1049 1.335 christos wdclose(dev_t dev, int flag, int fmt, struct lwp *l)
1050 1.135 mycroft {
1051 1.434 mlelstv struct wd_softc *wd;
1052 1.434 mlelstv struct dk_softc *dksc;
1053 1.434 mlelstv int unit;
1054 1.259 dsl
1055 1.434 mlelstv unit = WDUNIT(dev);
1056 1.434 mlelstv wd = device_lookup_private(&wd_cd, unit);
1057 1.434 mlelstv dksc = &wd->sc_dksc;
1058 1.294 thorpej
1059 1.434 mlelstv return dk_close(dksc, dev, flag, fmt, l);
1060 1.108 mycroft }
1061 1.108 mycroft
1062 1.217 bouyer void
1063 1.430 jdolecek wdperror(const struct wd_softc *wd, struct ata_xfer *xfer)
1064 1.217 bouyer {
1065 1.221 yamt static const char *const errstr0_3[] = {"address mark not found",
1066 1.217 bouyer "track 0 not found", "aborted command", "media change requested",
1067 1.217 bouyer "id not found", "media changed", "uncorrectable data error",
1068 1.217 bouyer "bad block detected"};
1069 1.221 yamt static const char *const errstr4_5[] = {
1070 1.221 yamt "obsolete (address mark not found)",
1071 1.217 bouyer "no media/write protected", "aborted command",
1072 1.217 bouyer "media change requested", "id not found", "media changed",
1073 1.217 bouyer "uncorrectable data error", "interface CRC error"};
1074 1.259 dsl const char *const *errstr;
1075 1.217 bouyer int i;
1076 1.301 christos const char *sep = "";
1077 1.217 bouyer
1078 1.434 mlelstv const struct dk_softc *dksc = &wd->sc_dksc;
1079 1.434 mlelstv const char *devname = dksc->sc_xname;
1080 1.221 yamt struct ata_drive_datas *drvp = wd->drvp;
1081 1.430 jdolecek int errno = xfer->c_bio.r_error;
1082 1.221 yamt
1083 1.217 bouyer if (drvp->ata_vers >= 4)
1084 1.217 bouyer errstr = errstr4_5;
1085 1.217 bouyer else
1086 1.217 bouyer errstr = errstr0_3;
1087 1.217 bouyer
1088 1.221 yamt printf("%s: (", devname);
1089 1.221 yamt
1090 1.217 bouyer if (errno == 0)
1091 1.221 yamt printf("error not notified");
1092 1.217 bouyer
1093 1.217 bouyer for (i = 0; i < 8; i++) {
1094 1.217 bouyer if (errno & (1 << i)) {
1095 1.221 yamt printf("%s%s", sep, errstr[i]);
1096 1.217 bouyer sep = ", ";
1097 1.217 bouyer }
1098 1.217 bouyer }
1099 1.221 yamt printf(")\n");
1100 1.217 bouyer }
1101 1.217 bouyer
1102 1.1 cgd int
1103 1.434 mlelstv wdioctl(dev_t dev, u_long cmd, void *addr, int flag, struct lwp *l)
1104 1.1 cgd {
1105 1.360 cube struct wd_softc *wd =
1106 1.363 tsutsui device_lookup_private(&wd_cd, WDUNIT(dev));
1107 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
1108 1.163 bouyer
1109 1.289 thorpej ATADEBUG_PRINT(("wdioctl\n"), DEBUG_FUNCS);
1110 1.163 bouyer
1111 1.181 bouyer if ((wd->sc_flags & WDF_LOADED) == 0)
1112 1.108 mycroft return EIO;
1113 1.108 mycroft
1114 1.434 mlelstv switch (cmd) {
1115 1.170 leo #ifdef HAS_BAD144_HANDLING
1116 1.1 cgd case DIOCSBAD:
1117 1.3 deraadt if ((flag & FWRITE) == 0)
1118 1.54 mycroft return EBADF;
1119 1.434 mlelstv dksc->sc_dkdev.dk_cpulabel->bad = *(struct dkbad *)addr;
1120 1.434 mlelstv dksc->sc_dkdev.dk_label->d_flags |= D_BADSECT;
1121 1.64 mycroft bad144intern(wd);
1122 1.54 mycroft return 0;
1123 1.170 leo #endif
1124 1.292 drochner #ifdef WD_SOFTBADSECT
1125 1.241 darrenr case DIOCBSLIST :
1126 1.241 darrenr {
1127 1.413 matt uint32_t count, missing, skip;
1128 1.243 darrenr struct disk_badsecinfo dbsi;
1129 1.241 darrenr struct disk_badsectors *dbs;
1130 1.241 darrenr size_t available;
1131 1.344 jnemeth uint8_t *laddr;
1132 1.241 darrenr
1133 1.243 darrenr dbsi = *(struct disk_badsecinfo *)addr;
1134 1.243 darrenr missing = wd->sc_bscount;
1135 1.241 darrenr count = 0;
1136 1.243 darrenr available = dbsi.dbsi_bufsize;
1137 1.243 darrenr skip = dbsi.dbsi_skip;
1138 1.344 jnemeth laddr = (uint8_t *)dbsi.dbsi_buffer;
1139 1.243 darrenr
1140 1.243 darrenr /*
1141 1.243 darrenr * We start this loop with the expectation that all of the
1142 1.243 darrenr * entries will be missed and decrement this counter each
1143 1.243 darrenr * time we either skip over one (already copied out) or
1144 1.243 darrenr * we actually copy it back to user space. The structs
1145 1.243 darrenr * holding the bad sector information are copied directly
1146 1.243 darrenr * back to user space whilst the summary is returned via
1147 1.243 darrenr * the struct passed in via the ioctl.
1148 1.243 darrenr */
1149 1.241 darrenr SLIST_FOREACH(dbs, &wd->sc_bslist, dbs_next) {
1150 1.243 darrenr if (skip > 0) {
1151 1.243 darrenr missing--;
1152 1.243 darrenr skip--;
1153 1.243 darrenr continue;
1154 1.243 darrenr }
1155 1.243 darrenr if (available < sizeof(*dbs))
1156 1.241 darrenr break;
1157 1.243 darrenr available -= sizeof(*dbs);
1158 1.241 darrenr copyout(dbs, laddr, sizeof(*dbs));
1159 1.241 darrenr laddr += sizeof(*dbs);
1160 1.243 darrenr missing--;
1161 1.241 darrenr count++;
1162 1.241 darrenr }
1163 1.243 darrenr dbsi.dbsi_left = missing;
1164 1.243 darrenr dbsi.dbsi_copied = count;
1165 1.243 darrenr *(struct disk_badsecinfo *)addr = dbsi;
1166 1.241 darrenr return 0;
1167 1.241 darrenr }
1168 1.241 darrenr
1169 1.241 darrenr case DIOCBSFLUSH :
1170 1.241 darrenr /* Clean out the bad sector list */
1171 1.241 darrenr while (!SLIST_EMPTY(&wd->sc_bslist)) {
1172 1.241 darrenr void *head = SLIST_FIRST(&wd->sc_bslist);
1173 1.241 darrenr SLIST_REMOVE_HEAD(&wd->sc_bslist, dbs_next);
1174 1.241 darrenr free(head, M_TEMP);
1175 1.241 darrenr }
1176 1.243 darrenr wd->sc_bscount = 0;
1177 1.241 darrenr return 0;
1178 1.292 drochner #endif
1179 1.259 dsl
1180 1.1 cgd #ifdef notyet
1181 1.1 cgd case DIOCWFORMAT:
1182 1.1 cgd if ((flag & FWRITE) == 0)
1183 1.54 mycroft return EBADF;
1184 1.181 bouyer {
1185 1.54 mycroft register struct format_op *fop;
1186 1.54 mycroft struct iovec aiov;
1187 1.54 mycroft struct uio auio;
1188 1.434 mlelstv int error1;
1189 1.259 dsl
1190 1.54 mycroft fop = (struct format_op *)addr;
1191 1.54 mycroft aiov.iov_base = fop->df_buf;
1192 1.54 mycroft aiov.iov_len = fop->df_count;
1193 1.54 mycroft auio.uio_iov = &aiov;
1194 1.54 mycroft auio.uio_iovcnt = 1;
1195 1.54 mycroft auio.uio_resid = fop->df_count;
1196 1.54 mycroft auio.uio_offset =
1197 1.181 bouyer fop->df_startblk * wd->sc_dk.dk_label->d_secsize;
1198 1.320 yamt auio.uio_vmspace = l->l_proc->p_vmspace;
1199 1.434 mlelstv error1 = physio(wdformat, NULL, dev, B_WRITE, wdminphys,
1200 1.64 mycroft &auio);
1201 1.54 mycroft fop->df_count -= auio.uio_resid;
1202 1.64 mycroft fop->df_reg[0] = wdc->sc_status;
1203 1.64 mycroft fop->df_reg[1] = wdc->sc_error;
1204 1.434 mlelstv return error1;
1205 1.181 bouyer }
1206 1.1 cgd #endif
1207 1.248 bouyer case DIOCGCACHE:
1208 1.248 bouyer return wd_getcache(wd, (int *)addr);
1209 1.248 bouyer
1210 1.248 bouyer case DIOCSCACHE:
1211 1.248 bouyer return wd_setcache(wd, *(int *)addr);
1212 1.185 kenh
1213 1.276 bouyer case DIOCCACHESYNC:
1214 1.430 jdolecek return wd_flushcache(wd, AT_WAIT, true);
1215 1.276 bouyer
1216 1.186 kenh case ATAIOCCOMMAND:
1217 1.185 kenh /*
1218 1.185 kenh * Make sure this command is (relatively) safe first
1219 1.185 kenh */
1220 1.186 kenh if ((((atareq_t *) addr)->flags & ATACMD_READ) == 0 &&
1221 1.185 kenh (flag & FWRITE) == 0)
1222 1.185 kenh return (EBADF);
1223 1.185 kenh {
1224 1.185 kenh struct wd_ioctl *wi;
1225 1.186 kenh atareq_t *atareq = (atareq_t *) addr;
1226 1.301 christos int error1;
1227 1.185 kenh
1228 1.430 jdolecek wi = wi_get(wd);
1229 1.186 kenh wi->wi_atareq = *atareq;
1230 1.185 kenh
1231 1.186 kenh if (atareq->datalen && atareq->flags &
1232 1.186 kenh (ATACMD_READ | ATACMD_WRITE)) {
1233 1.339 dsl void *tbuf;
1234 1.339 dsl if (atareq->datalen < DEV_BSIZE
1235 1.339 dsl && atareq->command == WDCC_IDENTIFY) {
1236 1.339 dsl tbuf = malloc(DEV_BSIZE, M_TEMP, M_WAITOK);
1237 1.339 dsl wi->wi_iov.iov_base = tbuf;
1238 1.339 dsl wi->wi_iov.iov_len = DEV_BSIZE;
1239 1.339 dsl UIO_SETUP_SYSSPACE(&wi->wi_uio);
1240 1.339 dsl } else {
1241 1.339 dsl tbuf = NULL;
1242 1.339 dsl wi->wi_iov.iov_base = atareq->databuf;
1243 1.339 dsl wi->wi_iov.iov_len = atareq->datalen;
1244 1.339 dsl wi->wi_uio.uio_vmspace = l->l_proc->p_vmspace;
1245 1.339 dsl }
1246 1.185 kenh wi->wi_uio.uio_iov = &wi->wi_iov;
1247 1.185 kenh wi->wi_uio.uio_iovcnt = 1;
1248 1.186 kenh wi->wi_uio.uio_resid = atareq->datalen;
1249 1.185 kenh wi->wi_uio.uio_offset = 0;
1250 1.185 kenh wi->wi_uio.uio_rw =
1251 1.186 kenh (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE;
1252 1.301 christos error1 = physio(wdioctlstrategy, &wi->wi_bp, dev,
1253 1.186 kenh (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE,
1254 1.388 jakllsch wdminphys, &wi->wi_uio);
1255 1.339 dsl if (tbuf != NULL && error1 == 0) {
1256 1.339 dsl error1 = copyout(tbuf, atareq->databuf,
1257 1.339 dsl atareq->datalen);
1258 1.339 dsl free(tbuf, M_TEMP);
1259 1.339 dsl }
1260 1.185 kenh } else {
1261 1.185 kenh /* No need to call physio if we don't have any
1262 1.185 kenh user data */
1263 1.185 kenh wi->wi_bp.b_flags = 0;
1264 1.185 kenh wi->wi_bp.b_data = 0;
1265 1.185 kenh wi->wi_bp.b_bcount = 0;
1266 1.430 jdolecek wi->wi_bp.b_dev = dev;
1267 1.314 christos wi->wi_bp.b_proc = l->l_proc;
1268 1.185 kenh wdioctlstrategy(&wi->wi_bp);
1269 1.301 christos error1 = wi->wi_bp.b_error;
1270 1.185 kenh }
1271 1.186 kenh *atareq = wi->wi_atareq;
1272 1.185 kenh wi_free(wi);
1273 1.301 christos return(error1);
1274 1.185 kenh }
1275 1.185 kenh
1276 1.1 cgd default:
1277 1.434 mlelstv return dk_ioctl(dksc, dev, cmd, addr, flag, l);
1278 1.1 cgd }
1279 1.54 mycroft
1280 1.54 mycroft #ifdef DIAGNOSTIC
1281 1.54 mycroft panic("wdioctl: impossible");
1282 1.54 mycroft #endif
1283 1.1 cgd }
1284 1.1 cgd
1285 1.410 dholland static int
1286 1.434 mlelstv wd_discard(device_t dev, off_t pos, off_t len)
1287 1.410 dholland {
1288 1.434 mlelstv struct wd_softc *wd = device_private(dev);
1289 1.410 dholland daddr_t bno;
1290 1.410 dholland long size, done;
1291 1.410 dholland long maxatonce, amount;
1292 1.410 dholland int result;
1293 1.410 dholland
1294 1.410 dholland if (!(wd->sc_params.atap_ata_major & WDC_VER_ATA7)
1295 1.410 dholland || !(wd->sc_params.support_dsm & ATA_SUPPORT_DSM_TRIM)) {
1296 1.410 dholland /* not supported; ignore request */
1297 1.410 dholland ATADEBUG_PRINT(("wddiscard (unsupported)\n"), DEBUG_FUNCS);
1298 1.410 dholland return 0;
1299 1.410 dholland }
1300 1.410 dholland maxatonce = 0xffff; /*wd->sc_params.max_dsm_blocks*/
1301 1.410 dholland
1302 1.410 dholland ATADEBUG_PRINT(("wddiscard\n"), DEBUG_FUNCS);
1303 1.410 dholland
1304 1.410 dholland if ((wd->sc_flags & WDF_LOADED) == 0)
1305 1.410 dholland return EIO;
1306 1.410 dholland
1307 1.410 dholland /* round the start up and the end down */
1308 1.424 jakllsch bno = (pos + wd->sc_blksize - 1) / wd->sc_blksize;
1309 1.424 jakllsch size = ((pos + len) / wd->sc_blksize) - bno;
1310 1.410 dholland
1311 1.410 dholland done = 0;
1312 1.410 dholland while (done < size) {
1313 1.410 dholland amount = size - done;
1314 1.410 dholland if (amount > maxatonce) {
1315 1.410 dholland amount = maxatonce;
1316 1.410 dholland }
1317 1.434 mlelstv result = wd_trim(wd, bno + done, amount);
1318 1.410 dholland if (result) {
1319 1.410 dholland return result;
1320 1.410 dholland }
1321 1.410 dholland done += amount;
1322 1.410 dholland }
1323 1.410 dholland return 0;
1324 1.410 dholland }
1325 1.410 dholland
1326 1.434 mlelstv static int
1327 1.434 mlelstv wddiscard(dev_t dev, off_t pos, off_t len)
1328 1.434 mlelstv {
1329 1.434 mlelstv struct wd_softc *wd;
1330 1.434 mlelstv struct dk_softc *dksc;
1331 1.434 mlelstv int unit;
1332 1.434 mlelstv
1333 1.434 mlelstv unit = WDUNIT(dev);
1334 1.434 mlelstv wd = device_lookup_private(&wd_cd, unit);
1335 1.434 mlelstv dksc = &wd->sc_dksc;
1336 1.434 mlelstv
1337 1.434 mlelstv return dk_discard(dksc, dev, pos, len);
1338 1.434 mlelstv }
1339 1.434 mlelstv
1340 1.44 mycroft #ifdef B_FORMAT
1341 1.1 cgd int
1342 1.1 cgd wdformat(struct buf *bp)
1343 1.1 cgd {
1344 1.44 mycroft
1345 1.1 cgd bp->b_flags |= B_FORMAT;
1346 1.37 mycroft return wdstrategy(bp);
1347 1.1 cgd }
1348 1.1 cgd #endif
1349 1.1 cgd
1350 1.1 cgd int
1351 1.259 dsl wdsize(dev_t dev)
1352 1.1 cgd {
1353 1.64 mycroft struct wd_softc *wd;
1354 1.434 mlelstv struct dk_softc *dksc;
1355 1.434 mlelstv int unit;
1356 1.163 bouyer
1357 1.289 thorpej ATADEBUG_PRINT(("wdsize\n"), DEBUG_FUNCS);
1358 1.163 bouyer
1359 1.434 mlelstv unit = WDUNIT(dev);
1360 1.434 mlelstv wd = device_lookup_private(&wd_cd, unit);
1361 1.158 pk if (wd == NULL)
1362 1.158 pk return (-1);
1363 1.434 mlelstv dksc = &wd->sc_dksc;
1364 1.158 pk
1365 1.434 mlelstv if (!device_is_active(dksc->sc_dev))
1366 1.434 mlelstv return (-1);
1367 1.158 pk
1368 1.434 mlelstv return dk_size(dksc, dev);
1369 1.1 cgd }
1370 1.1 cgd
1371 1.64 mycroft /*
1372 1.64 mycroft * Dump core after a system crash.
1373 1.64 mycroft */
1374 1.434 mlelstv static int
1375 1.337 christos wddump(dev_t dev, daddr_t blkno, void *va, size_t size)
1376 1.140 cgd {
1377 1.434 mlelstv struct wd_softc *wd;
1378 1.434 mlelstv struct dk_softc *dksc;
1379 1.434 mlelstv int unit;
1380 1.140 cgd
1381 1.140 cgd /* Check if recursive dump; if so, punt. */
1382 1.116 mycroft if (wddoingadump)
1383 1.116 mycroft return EFAULT;
1384 1.142 mycroft wddoingadump = 1;
1385 1.140 cgd
1386 1.434 mlelstv unit = WDUNIT(dev);
1387 1.434 mlelstv wd = device_lookup_private(&wd_cd, unit);
1388 1.208 thorpej if (wd == NULL)
1389 1.208 thorpej return (ENXIO);
1390 1.434 mlelstv dksc = &wd->sc_dksc;
1391 1.60 mycroft
1392 1.434 mlelstv return dk_dump(dksc, dev, blkno, va, size);
1393 1.434 mlelstv }
1394 1.140 cgd
1395 1.434 mlelstv static int
1396 1.434 mlelstv wd_dumpblocks(device_t dev, void *va, daddr_t blkno, int nblk)
1397 1.434 mlelstv {
1398 1.434 mlelstv struct wd_softc *wd = device_private(dev);
1399 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
1400 1.434 mlelstv struct disk_geom *dg = &dksc->sc_dkdev.dk_geom;
1401 1.434 mlelstv struct ata_xfer *xfer;
1402 1.434 mlelstv int err;
1403 1.60 mycroft
1404 1.140 cgd /* Recalibrate, if first dump transfer. */
1405 1.140 cgd if (wddumprecalibrated == 0) {
1406 1.140 cgd wddumprecalibrated = 1;
1407 1.290 thorpej (*wd->atabus->ata_reset_drive)(wd->drvp,
1408 1.400 bouyer AT_POLL | AT_RST_EMERG, NULL);
1409 1.205 bouyer wd->drvp->state = RESET;
1410 1.63 mycroft }
1411 1.259 dsl
1412 1.430 jdolecek xfer = ata_get_xfer_ext(wd->drvp->chnl_softc, 0, 0);
1413 1.430 jdolecek if (xfer == NULL) {
1414 1.430 jdolecek printf("%s: no xfer\n", __func__);
1415 1.430 jdolecek return EAGAIN;
1416 1.430 jdolecek }
1417 1.430 jdolecek
1418 1.430 jdolecek xfer->c_bio.blkno = blkno;
1419 1.430 jdolecek xfer->c_bio.flags = ATA_POLL;
1420 1.308 bouyer if (wd->sc_flags & WDF_LBA48 &&
1421 1.434 mlelstv (xfer->c_bio.blkno + nblk) > wd->sc_capacity28)
1422 1.430 jdolecek xfer->c_bio.flags |= ATA_LBA48;
1423 1.308 bouyer if (wd->sc_flags & WDF_LBA)
1424 1.430 jdolecek xfer->c_bio.flags |= ATA_LBA;
1425 1.434 mlelstv xfer->c_bio.bcount = nblk * dg->dg_secsize;
1426 1.430 jdolecek xfer->c_bio.databuf = va;
1427 1.181 bouyer #ifndef WD_DUMP_NOT_TRUSTED
1428 1.430 jdolecek switch (err = wd->atabus->ata_bio(wd->drvp, xfer)) {
1429 1.308 bouyer case ATACMD_TRY_AGAIN:
1430 1.308 bouyer panic("wddump: try again");
1431 1.308 bouyer break;
1432 1.308 bouyer case ATACMD_QUEUED:
1433 1.308 bouyer panic("wddump: polled command has been queued");
1434 1.308 bouyer break;
1435 1.308 bouyer case ATACMD_COMPLETE:
1436 1.308 bouyer break;
1437 1.365 christos default:
1438 1.365 christos panic("wddump: unknown atacmd code %d", err);
1439 1.308 bouyer }
1440 1.430 jdolecek switch(err = xfer->c_bio.error) {
1441 1.308 bouyer case TIMEOUT:
1442 1.308 bouyer printf("wddump: device timed out");
1443 1.308 bouyer err = EIO;
1444 1.308 bouyer break;
1445 1.308 bouyer case ERR_DF:
1446 1.308 bouyer printf("wddump: drive fault");
1447 1.308 bouyer err = EIO;
1448 1.308 bouyer break;
1449 1.308 bouyer case ERR_DMA:
1450 1.308 bouyer printf("wddump: DMA error");
1451 1.308 bouyer err = EIO;
1452 1.308 bouyer break;
1453 1.308 bouyer case ERROR:
1454 1.308 bouyer printf("wddump: ");
1455 1.430 jdolecek wdperror(wd, xfer);
1456 1.308 bouyer err = EIO;
1457 1.308 bouyer break;
1458 1.308 bouyer case NOERROR:
1459 1.308 bouyer err = 0;
1460 1.308 bouyer break;
1461 1.308 bouyer default:
1462 1.425 jakllsch panic("wddump: unknown error type %d", err);
1463 1.308 bouyer }
1464 1.430 jdolecek
1465 1.308 bouyer if (err != 0) {
1466 1.308 bouyer printf("\n");
1467 1.308 bouyer return err;
1468 1.308 bouyer }
1469 1.140 cgd #else /* WD_DUMP_NOT_TRUSTED */
1470 1.308 bouyer /* Let's just talk about this first... */
1471 1.308 bouyer printf("wd%d: dump addr 0x%x, cylin %d, head %d, sector %d\n",
1472 1.308 bouyer unit, va, cylin, head, sector);
1473 1.308 bouyer delay(500 * 1000); /* half a second */
1474 1.140 cgd #endif
1475 1.1 cgd
1476 1.140 cgd wddoingadump = 0;
1477 1.140 cgd return 0;
1478 1.140 cgd }
1479 1.3 deraadt
1480 1.170 leo #ifdef HAS_BAD144_HANDLING
1481 1.3 deraadt /*
1482 1.3 deraadt * Internalize the bad sector table.
1483 1.3 deraadt */
1484 1.3 deraadt void
1485 1.259 dsl bad144intern(struct wd_softc *wd)
1486 1.3 deraadt {
1487 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
1488 1.434 mlelstv struct dkbad *bt = &dksc->sc_dkdev.dk_cpulabel->bad;
1489 1.434 mlelstv struct disklabel *lp = dksc->sc_dkdev.dk_label;
1490 1.98 mycroft int i = 0;
1491 1.55 mycroft
1492 1.289 thorpej ATADEBUG_PRINT(("bad144intern\n"), DEBUG_XFERS);
1493 1.163 bouyer
1494 1.170 leo for (; i < NBT_BAD; i++) {
1495 1.98 mycroft if (bt->bt_bad[i].bt_cyl == 0xffff)
1496 1.55 mycroft break;
1497 1.430 jdolecek wd->drvp->badsect[i] =
1498 1.98 mycroft bt->bt_bad[i].bt_cyl * lp->d_secpercyl +
1499 1.98 mycroft (bt->bt_bad[i].bt_trksec >> 8) * lp->d_nsectors +
1500 1.98 mycroft (bt->bt_bad[i].bt_trksec & 0xff);
1501 1.3 deraadt }
1502 1.170 leo for (; i < NBT_BAD+1; i++)
1503 1.430 jdolecek wd->drvp->badsect[i] = -1;
1504 1.64 mycroft }
1505 1.170 leo #endif
1506 1.64 mycroft
1507 1.330 thorpej static void
1508 1.434 mlelstv wd_set_geometry(struct wd_softc *wd)
1509 1.330 thorpej {
1510 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
1511 1.434 mlelstv struct disk_geom *dg = &dksc->sc_dkdev.dk_geom;
1512 1.330 thorpej
1513 1.403 christos memset(dg, 0, sizeof(*dg));
1514 1.330 thorpej
1515 1.403 christos dg->dg_secperunit = wd->sc_capacity;
1516 1.424 jakllsch dg->dg_secsize = wd->sc_blksize;
1517 1.403 christos dg->dg_nsectors = wd->sc_params.atap_sectors;
1518 1.403 christos dg->dg_ntracks = wd->sc_params.atap_heads;
1519 1.403 christos if ((wd->sc_flags & WDF_LBA) == 0)
1520 1.403 christos dg->dg_ncylinders = wd->sc_params.atap_cylinders;
1521 1.403 christos
1522 1.434 mlelstv disk_set_info(dksc->sc_dev, &dksc->sc_dkdev, NULL);
1523 1.330 thorpej }
1524 1.330 thorpej
1525 1.181 bouyer int
1526 1.413 matt wd_get_params(struct wd_softc *wd, uint8_t flags, struct ataparams *params)
1527 1.63 mycroft {
1528 1.350 itohy
1529 1.217 bouyer switch (wd->atabus->ata_get_params(wd->drvp, flags, params)) {
1530 1.181 bouyer case CMD_AGAIN:
1531 1.181 bouyer return 1;
1532 1.181 bouyer case CMD_ERR:
1533 1.400 bouyer if (wd->drvp->drive_type != ATA_DRIVET_OLD)
1534 1.400 bouyer return 1;
1535 1.181 bouyer /*
1536 1.181 bouyer * We `know' there's a drive here; just assume it's old.
1537 1.181 bouyer * This geometry is only used to read the MBR and print a
1538 1.181 bouyer * (false) attach message.
1539 1.181 bouyer */
1540 1.181 bouyer strncpy(params->atap_model, "ST506",
1541 1.181 bouyer sizeof params->atap_model);
1542 1.181 bouyer params->atap_config = ATA_CFG_FIXED;
1543 1.181 bouyer params->atap_cylinders = 1024;
1544 1.181 bouyer params->atap_heads = 8;
1545 1.181 bouyer params->atap_sectors = 17;
1546 1.181 bouyer params->atap_multi = 1;
1547 1.181 bouyer params->atap_capabilities1 = params->atap_capabilities2 = 0;
1548 1.190 bouyer wd->drvp->ata_vers = -1; /* Mark it as pre-ATA */
1549 1.330 thorpej /* FALLTHROUGH */
1550 1.181 bouyer case CMD_OK:
1551 1.181 bouyer return 0;
1552 1.181 bouyer default:
1553 1.181 bouyer panic("wd_get_params: bad return code from ata_get_params");
1554 1.181 bouyer /* NOTREACHED */
1555 1.181 bouyer }
1556 1.248 bouyer }
1557 1.248 bouyer
1558 1.248 bouyer int
1559 1.259 dsl wd_getcache(struct wd_softc *wd, int *bitsp)
1560 1.248 bouyer {
1561 1.248 bouyer struct ataparams params;
1562 1.248 bouyer
1563 1.248 bouyer if (wd_get_params(wd, AT_WAIT, ¶ms) != 0)
1564 1.248 bouyer return EIO;
1565 1.248 bouyer if (params.atap_cmd_set1 == 0x0000 ||
1566 1.248 bouyer params.atap_cmd_set1 == 0xffff ||
1567 1.248 bouyer (params.atap_cmd_set1 & WDC_CMD1_CACHE) == 0) {
1568 1.248 bouyer *bitsp = 0;
1569 1.248 bouyer return 0;
1570 1.248 bouyer }
1571 1.248 bouyer *bitsp = DKCACHE_WCHANGE | DKCACHE_READ;
1572 1.248 bouyer if (params.atap_cmd1_en & WDC_CMD1_CACHE)
1573 1.248 bouyer *bitsp |= DKCACHE_WRITE;
1574 1.248 bouyer
1575 1.430 jdolecek if (WD_USE_NCQ(wd) || (wd->drvp->drive_flags & ATA_DRIVE_WFUA))
1576 1.430 jdolecek *bitsp |= DKCACHE_FUA;
1577 1.430 jdolecek
1578 1.248 bouyer return 0;
1579 1.248 bouyer }
1580 1.248 bouyer
1581 1.286 mycroft const char at_errbits[] = "\20\10ERROR\11TIMEOU\12DF";
1582 1.286 mycroft
1583 1.248 bouyer int
1584 1.259 dsl wd_setcache(struct wd_softc *wd, int bits)
1585 1.248 bouyer {
1586 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
1587 1.248 bouyer struct ataparams params;
1588 1.430 jdolecek struct ata_xfer *xfer;
1589 1.430 jdolecek int error;
1590 1.248 bouyer
1591 1.248 bouyer if (wd_get_params(wd, AT_WAIT, ¶ms) != 0)
1592 1.248 bouyer return EIO;
1593 1.248 bouyer
1594 1.248 bouyer if (params.atap_cmd_set1 == 0x0000 ||
1595 1.250 bouyer params.atap_cmd_set1 == 0xffff ||
1596 1.248 bouyer (params.atap_cmd_set1 & WDC_CMD1_CACHE) == 0)
1597 1.248 bouyer return EOPNOTSUPP;
1598 1.248 bouyer
1599 1.249 bouyer if ((bits & DKCACHE_READ) == 0 ||
1600 1.249 bouyer (bits & DKCACHE_SAVE) != 0)
1601 1.248 bouyer return EOPNOTSUPP;
1602 1.248 bouyer
1603 1.430 jdolecek xfer = ata_get_xfer(wd->drvp->chnl_softc);
1604 1.430 jdolecek if (xfer == NULL)
1605 1.430 jdolecek return EINTR;
1606 1.430 jdolecek
1607 1.430 jdolecek xfer->c_ata_c.r_command = SET_FEATURES;
1608 1.430 jdolecek xfer->c_ata_c.r_st_bmask = 0;
1609 1.430 jdolecek xfer->c_ata_c.r_st_pmask = 0;
1610 1.430 jdolecek xfer->c_ata_c.timeout = 30000; /* 30s timeout */
1611 1.430 jdolecek xfer->c_ata_c.flags = AT_WAIT;
1612 1.248 bouyer if (bits & DKCACHE_WRITE)
1613 1.430 jdolecek xfer->c_ata_c.r_features = WDSF_WRITE_CACHE_EN;
1614 1.248 bouyer else
1615 1.430 jdolecek xfer->c_ata_c.r_features = WDSF_WRITE_CACHE_DS;
1616 1.430 jdolecek if (wd->atabus->ata_exec_command(wd->drvp, xfer) != ATACMD_COMPLETE) {
1617 1.434 mlelstv aprint_error_dev(dksc->sc_dev,
1618 1.360 cube "wd_setcache command not complete\n");
1619 1.430 jdolecek error = EIO;
1620 1.430 jdolecek goto out;
1621 1.248 bouyer }
1622 1.430 jdolecek
1623 1.430 jdolecek if (xfer->c_ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
1624 1.286 mycroft char sbuf[sizeof(at_errbits) + 64];
1625 1.430 jdolecek snprintb(sbuf, sizeof(sbuf), at_errbits, xfer->c_ata_c.flags);
1626 1.434 mlelstv aprint_error_dev(dksc->sc_dev, "wd_setcache: status=%s\n", sbuf);
1627 1.430 jdolecek error = EIO;
1628 1.430 jdolecek goto out;
1629 1.286 mycroft }
1630 1.430 jdolecek
1631 1.430 jdolecek error = 0;
1632 1.430 jdolecek
1633 1.430 jdolecek out:
1634 1.430 jdolecek ata_free_xfer(wd->drvp->chnl_softc, xfer);
1635 1.430 jdolecek ata_channel_start(wd->drvp->chnl_softc, wd->drvp->drive);
1636 1.430 jdolecek return error;
1637 1.286 mycroft }
1638 1.286 mycroft
1639 1.351 jmcneill static int
1640 1.286 mycroft wd_standby(struct wd_softc *wd, int flags)
1641 1.286 mycroft {
1642 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
1643 1.430 jdolecek struct ata_xfer *xfer;
1644 1.430 jdolecek int error;
1645 1.286 mycroft
1646 1.430 jdolecek xfer = ata_get_xfer(wd->drvp->chnl_softc);
1647 1.430 jdolecek if (xfer == NULL)
1648 1.430 jdolecek return EINTR;
1649 1.430 jdolecek
1650 1.430 jdolecek xfer->c_ata_c.r_command = WDCC_STANDBY_IMMED;
1651 1.430 jdolecek xfer->c_ata_c.r_st_bmask = WDCS_DRDY;
1652 1.430 jdolecek xfer->c_ata_c.r_st_pmask = WDCS_DRDY;
1653 1.430 jdolecek xfer->c_ata_c.flags = flags;
1654 1.430 jdolecek xfer->c_ata_c.timeout = 30000; /* 30s timeout */
1655 1.430 jdolecek if (wd->atabus->ata_exec_command(wd->drvp, xfer) != ATACMD_COMPLETE) {
1656 1.434 mlelstv aprint_error_dev(dksc->sc_dev,
1657 1.351 jmcneill "standby immediate command didn't complete\n");
1658 1.430 jdolecek error = EIO;
1659 1.430 jdolecek goto out;
1660 1.286 mycroft }
1661 1.430 jdolecek if (xfer->c_ata_c.flags & AT_ERROR) {
1662 1.430 jdolecek if (xfer->c_ata_c.r_error == WDCE_ABRT) {
1663 1.430 jdolecek /* command not supported */
1664 1.430 jdolecek error = ENODEV;
1665 1.430 jdolecek goto out;
1666 1.430 jdolecek }
1667 1.286 mycroft }
1668 1.430 jdolecek if (xfer->c_ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
1669 1.286 mycroft char sbuf[sizeof(at_errbits) + 64];
1670 1.430 jdolecek snprintb(sbuf, sizeof(sbuf), at_errbits, xfer->c_ata_c.flags);
1671 1.434 mlelstv aprint_error_dev(dksc->sc_dev, "wd_standby: status=%s\n", sbuf);
1672 1.430 jdolecek error = EIO;
1673 1.430 jdolecek goto out;
1674 1.248 bouyer }
1675 1.430 jdolecek error = 0;
1676 1.430 jdolecek
1677 1.430 jdolecek out:
1678 1.430 jdolecek ata_free_xfer(wd->drvp->chnl_softc, xfer);
1679 1.430 jdolecek /* drive is supposed to go idle, do not call ata_channel_start() */
1680 1.430 jdolecek return error;
1681 1.190 bouyer }
1682 1.190 bouyer
1683 1.276 bouyer int
1684 1.430 jdolecek wd_flushcache(struct wd_softc *wd, int flags, bool start)
1685 1.190 bouyer {
1686 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
1687 1.430 jdolecek struct ata_xfer *xfer;
1688 1.430 jdolecek int error;
1689 1.190 bouyer
1690 1.297 bouyer /*
1691 1.297 bouyer * WDCC_FLUSHCACHE is here since ATA-4, but some drives report
1692 1.297 bouyer * only ATA-2 and still support it.
1693 1.297 bouyer */
1694 1.297 bouyer if (wd->drvp->ata_vers < 4 &&
1695 1.297 bouyer ((wd->sc_params.atap_cmd_set2 & WDC_CMD2_FC) == 0 ||
1696 1.297 bouyer wd->sc_params.atap_cmd_set2 == 0xffff))
1697 1.276 bouyer return ENODEV;
1698 1.430 jdolecek
1699 1.430 jdolecek mutex_enter(&wd->sc_lock);
1700 1.430 jdolecek SET(wd->sc_flags, WDF_FLUSH_PEND);
1701 1.430 jdolecek mutex_exit(&wd->sc_lock);
1702 1.430 jdolecek
1703 1.430 jdolecek xfer = ata_get_xfer(wd->drvp->chnl_softc);
1704 1.430 jdolecek
1705 1.430 jdolecek mutex_enter(&wd->sc_lock);
1706 1.430 jdolecek CLR(wd->sc_flags, WDF_FLUSH_PEND);
1707 1.430 jdolecek mutex_exit(&wd->sc_lock);
1708 1.430 jdolecek
1709 1.430 jdolecek if (xfer == NULL) {
1710 1.430 jdolecek error = EINTR;
1711 1.430 jdolecek goto out;
1712 1.430 jdolecek }
1713 1.430 jdolecek
1714 1.275 bouyer if ((wd->sc_params.atap_cmd2_en & ATA_CMD2_LBA48) != 0 &&
1715 1.397 jakllsch (wd->sc_params.atap_cmd2_en & ATA_CMD2_FCE) != 0) {
1716 1.430 jdolecek xfer->c_ata_c.r_command = WDCC_FLUSHCACHE_EXT;
1717 1.397 jakllsch flags |= AT_LBA48;
1718 1.397 jakllsch } else
1719 1.430 jdolecek xfer->c_ata_c.r_command = WDCC_FLUSHCACHE;
1720 1.430 jdolecek xfer->c_ata_c.r_st_bmask = WDCS_DRDY;
1721 1.430 jdolecek xfer->c_ata_c.r_st_pmask = WDCS_DRDY;
1722 1.430 jdolecek xfer->c_ata_c.flags = flags | AT_READREG;
1723 1.430 jdolecek xfer->c_ata_c.timeout = 300000; /* 5m timeout */
1724 1.430 jdolecek if (wd->atabus->ata_exec_command(wd->drvp, xfer) != ATACMD_COMPLETE) {
1725 1.434 mlelstv aprint_error_dev(dksc->sc_dev,
1726 1.360 cube "flush cache command didn't complete\n");
1727 1.430 jdolecek error = EIO;
1728 1.430 jdolecek goto out_xfer;
1729 1.190 bouyer }
1730 1.430 jdolecek if (xfer->c_ata_c.flags & AT_ERROR) {
1731 1.430 jdolecek if (xfer->c_ata_c.r_error == WDCE_ABRT) {
1732 1.430 jdolecek /* command not supported */
1733 1.430 jdolecek error = ENODEV;
1734 1.430 jdolecek goto out_xfer;
1735 1.430 jdolecek }
1736 1.190 bouyer }
1737 1.430 jdolecek if (xfer->c_ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
1738 1.286 mycroft char sbuf[sizeof(at_errbits) + 64];
1739 1.430 jdolecek snprintb(sbuf, sizeof(sbuf), at_errbits, xfer->c_ata_c.flags);
1740 1.434 mlelstv aprint_error_dev(dksc->sc_dev, "wd_flushcache: status=%s\n",
1741 1.286 mycroft sbuf);
1742 1.430 jdolecek error = EIO;
1743 1.430 jdolecek goto out_xfer;
1744 1.190 bouyer }
1745 1.430 jdolecek error = 0;
1746 1.430 jdolecek
1747 1.430 jdolecek out_xfer:
1748 1.430 jdolecek ata_free_xfer(wd->drvp->chnl_softc, xfer);
1749 1.430 jdolecek
1750 1.430 jdolecek out:
1751 1.430 jdolecek /* kick queue processing blocked while waiting for flush xfer */
1752 1.430 jdolecek if (start)
1753 1.430 jdolecek ata_channel_start(wd->drvp->chnl_softc, wd->drvp->drive);
1754 1.430 jdolecek
1755 1.430 jdolecek return error;
1756 1.190 bouyer }
1757 1.190 bouyer
1758 1.434 mlelstv static int
1759 1.434 mlelstv wd_trim(struct wd_softc *wd, daddr_t bno, long size)
1760 1.401 drochner {
1761 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
1762 1.430 jdolecek struct ata_xfer *xfer;
1763 1.430 jdolecek int error;
1764 1.401 drochner unsigned char *req;
1765 1.401 drochner
1766 1.430 jdolecek xfer = ata_get_xfer(wd->drvp->chnl_softc);
1767 1.430 jdolecek if (xfer == NULL)
1768 1.430 jdolecek return EINTR;
1769 1.430 jdolecek
1770 1.401 drochner req = kmem_zalloc(512, KM_SLEEP);
1771 1.401 drochner req[0] = bno & 0xff;
1772 1.401 drochner req[1] = (bno >> 8) & 0xff;
1773 1.401 drochner req[2] = (bno >> 16) & 0xff;
1774 1.401 drochner req[3] = (bno >> 24) & 0xff;
1775 1.401 drochner req[4] = (bno >> 32) & 0xff;
1776 1.401 drochner req[5] = (bno >> 40) & 0xff;
1777 1.410 dholland req[6] = size & 0xff;
1778 1.410 dholland req[7] = (size >> 8) & 0xff;
1779 1.401 drochner
1780 1.430 jdolecek xfer->c_ata_c.r_command = ATA_DATA_SET_MANAGEMENT;
1781 1.430 jdolecek xfer->c_ata_c.r_count = 1;
1782 1.430 jdolecek xfer->c_ata_c.r_features = ATA_SUPPORT_DSM_TRIM;
1783 1.430 jdolecek xfer->c_ata_c.r_st_bmask = WDCS_DRDY;
1784 1.430 jdolecek xfer->c_ata_c.r_st_pmask = WDCS_DRDY;
1785 1.430 jdolecek xfer->c_ata_c.timeout = 30000; /* 30s timeout */
1786 1.430 jdolecek xfer->c_ata_c.data = req;
1787 1.430 jdolecek xfer->c_ata_c.bcount = 512;
1788 1.430 jdolecek xfer->c_ata_c.flags |= AT_WRITE | AT_WAIT;
1789 1.430 jdolecek if (wd->atabus->ata_exec_command(wd->drvp, xfer) != ATACMD_COMPLETE) {
1790 1.434 mlelstv aprint_error_dev(dksc->sc_dev,
1791 1.401 drochner "trim command didn't complete\n");
1792 1.401 drochner kmem_free(req, 512);
1793 1.430 jdolecek error = EIO;
1794 1.430 jdolecek goto out;
1795 1.401 drochner }
1796 1.401 drochner kmem_free(req, 512);
1797 1.430 jdolecek if (xfer->c_ata_c.flags & AT_ERROR) {
1798 1.430 jdolecek if (xfer->c_ata_c.r_error == WDCE_ABRT) {
1799 1.430 jdolecek /* command not supported */
1800 1.430 jdolecek error = ENODEV;
1801 1.430 jdolecek goto out;
1802 1.430 jdolecek }
1803 1.401 drochner }
1804 1.430 jdolecek if (xfer->c_ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
1805 1.401 drochner char sbuf[sizeof(at_errbits) + 64];
1806 1.430 jdolecek snprintb(sbuf, sizeof(sbuf), at_errbits, xfer->c_ata_c.flags);
1807 1.434 mlelstv aprint_error_dev(dksc->sc_dev, "wd_trim: status=%s\n",
1808 1.401 drochner sbuf);
1809 1.430 jdolecek error = EIO;
1810 1.430 jdolecek goto out;
1811 1.401 drochner }
1812 1.430 jdolecek error = 0;
1813 1.430 jdolecek
1814 1.430 jdolecek out:
1815 1.430 jdolecek ata_free_xfer(wd->drvp->chnl_softc, xfer);
1816 1.430 jdolecek ata_channel_start(wd->drvp->chnl_softc, wd->drvp->drive);
1817 1.430 jdolecek return error;
1818 1.401 drochner }
1819 1.401 drochner
1820 1.357 drochner bool
1821 1.357 drochner wd_shutdown(device_t dev, int how)
1822 1.356 drochner {
1823 1.368 drochner struct wd_softc *wd = device_private(dev);
1824 1.368 drochner
1825 1.368 drochner /* the adapter needs to be enabled */
1826 1.368 drochner if (wd->atabus->ata_addref(wd->drvp))
1827 1.368 drochner return true; /* no need to complain */
1828 1.356 drochner
1829 1.430 jdolecek wd_flushcache(wd, AT_POLL, false);
1830 1.357 drochner if ((how & RB_POWERDOWN) == RB_POWERDOWN)
1831 1.356 drochner wd_standby(wd, AT_POLL);
1832 1.357 drochner return true;
1833 1.356 drochner }
1834 1.356 drochner
1835 1.185 kenh /*
1836 1.185 kenh * Allocate space for a ioctl queue structure. Mostly taken from
1837 1.185 kenh * scsipi_ioctl.c
1838 1.185 kenh */
1839 1.185 kenh struct wd_ioctl *
1840 1.430 jdolecek wi_get(struct wd_softc *wd)
1841 1.185 kenh {
1842 1.185 kenh struct wd_ioctl *wi;
1843 1.185 kenh
1844 1.219 tsutsui wi = malloc(sizeof(struct wd_ioctl), M_TEMP, M_WAITOK|M_ZERO);
1845 1.430 jdolecek wi->wi_softc = wd;
1846 1.355 ad buf_init(&wi->wi_bp);
1847 1.430 jdolecek
1848 1.185 kenh return (wi);
1849 1.185 kenh }
1850 1.185 kenh
1851 1.185 kenh /*
1852 1.185 kenh * Free an ioctl structure and remove it from our list
1853 1.185 kenh */
1854 1.185 kenh
1855 1.185 kenh void
1856 1.259 dsl wi_free(struct wd_ioctl *wi)
1857 1.185 kenh {
1858 1.355 ad buf_destroy(&wi->wi_bp);
1859 1.185 kenh free(wi, M_TEMP);
1860 1.185 kenh }
1861 1.185 kenh
1862 1.185 kenh /*
1863 1.185 kenh * Find a wd_ioctl structure based on the struct buf.
1864 1.185 kenh */
1865 1.185 kenh
1866 1.185 kenh struct wd_ioctl *
1867 1.259 dsl wi_find(struct buf *bp)
1868 1.185 kenh {
1869 1.430 jdolecek return container_of(bp, struct wd_ioctl, wi_bp);
1870 1.185 kenh }
1871 1.185 kenh
1872 1.424 jakllsch static uint
1873 1.424 jakllsch wi_sector_size(const struct wd_ioctl * const wi)
1874 1.424 jakllsch {
1875 1.424 jakllsch switch (wi->wi_atareq.command) {
1876 1.424 jakllsch case WDCC_READ:
1877 1.424 jakllsch case WDCC_WRITE:
1878 1.424 jakllsch case WDCC_READMULTI:
1879 1.424 jakllsch case WDCC_WRITEMULTI:
1880 1.424 jakllsch case WDCC_READDMA:
1881 1.424 jakllsch case WDCC_WRITEDMA:
1882 1.424 jakllsch case WDCC_READ_EXT:
1883 1.424 jakllsch case WDCC_WRITE_EXT:
1884 1.424 jakllsch case WDCC_READMULTI_EXT:
1885 1.424 jakllsch case WDCC_WRITEMULTI_EXT:
1886 1.424 jakllsch case WDCC_READDMA_EXT:
1887 1.424 jakllsch case WDCC_WRITEDMA_EXT:
1888 1.424 jakllsch case WDCC_READ_FPDMA_QUEUED:
1889 1.424 jakllsch case WDCC_WRITE_FPDMA_QUEUED:
1890 1.424 jakllsch return wi->wi_softc->sc_blksize;
1891 1.424 jakllsch default:
1892 1.424 jakllsch return 512;
1893 1.424 jakllsch }
1894 1.424 jakllsch }
1895 1.424 jakllsch
1896 1.185 kenh /*
1897 1.185 kenh * Ioctl pseudo strategy routine
1898 1.185 kenh *
1899 1.185 kenh * This is mostly stolen from scsipi_ioctl.c:scsistrategy(). What
1900 1.185 kenh * happens here is:
1901 1.185 kenh *
1902 1.185 kenh * - wdioctl() queues a wd_ioctl structure.
1903 1.185 kenh *
1904 1.185 kenh * - wdioctl() calls physio/wdioctlstrategy based on whether or not
1905 1.185 kenh * user space I/O is required. If physio() is called, physio() eventually
1906 1.185 kenh * calls wdioctlstrategy().
1907 1.185 kenh *
1908 1.217 bouyer * - In either case, wdioctlstrategy() calls wd->atabus->ata_exec_command()
1909 1.185 kenh * to perform the actual command
1910 1.185 kenh *
1911 1.185 kenh * The reason for the use of the pseudo strategy routine is because
1912 1.185 kenh * when doing I/O to/from user space, physio _really_ wants to be in
1913 1.185 kenh * the loop. We could put the entire buffer into the ioctl request
1914 1.185 kenh * structure, but that won't scale if we want to do things like download
1915 1.185 kenh * microcode.
1916 1.185 kenh */
1917 1.185 kenh
1918 1.185 kenh void
1919 1.259 dsl wdioctlstrategy(struct buf *bp)
1920 1.185 kenh {
1921 1.185 kenh struct wd_ioctl *wi;
1922 1.430 jdolecek struct ata_xfer *xfer;
1923 1.185 kenh int error = 0;
1924 1.185 kenh
1925 1.185 kenh wi = wi_find(bp);
1926 1.185 kenh if (wi == NULL) {
1927 1.313 martin printf("wdioctlstrategy: "
1928 1.313 martin "No matching ioctl request found in queue\n");
1929 1.185 kenh error = EINVAL;
1930 1.430 jdolecek goto out2;
1931 1.185 kenh }
1932 1.185 kenh
1933 1.430 jdolecek xfer = ata_get_xfer(wi->wi_softc->drvp->chnl_softc);
1934 1.430 jdolecek if (xfer == NULL) {
1935 1.430 jdolecek error = EINTR;
1936 1.430 jdolecek goto out2;
1937 1.430 jdolecek }
1938 1.185 kenh
1939 1.185 kenh /*
1940 1.185 kenh * Abort if physio broke up the transfer
1941 1.185 kenh */
1942 1.185 kenh
1943 1.186 kenh if (bp->b_bcount != wi->wi_atareq.datalen) {
1944 1.185 kenh printf("physio split wd ioctl request... cannot proceed\n");
1945 1.185 kenh error = EIO;
1946 1.430 jdolecek goto out;
1947 1.185 kenh }
1948 1.185 kenh
1949 1.185 kenh /*
1950 1.185 kenh * Abort if we didn't get a buffer size that was a multiple of
1951 1.424 jakllsch * our sector size (or overflows CHS/LBA28 sector count)
1952 1.185 kenh */
1953 1.185 kenh
1954 1.424 jakllsch if ((bp->b_bcount % wi_sector_size(wi)) != 0 ||
1955 1.424 jakllsch (bp->b_bcount / wi_sector_size(wi)) >=
1956 1.185 kenh (1 << NBBY)) {
1957 1.185 kenh error = EINVAL;
1958 1.430 jdolecek goto out;
1959 1.185 kenh }
1960 1.185 kenh
1961 1.185 kenh /*
1962 1.185 kenh * Make sure a timeout was supplied in the ioctl request
1963 1.185 kenh */
1964 1.185 kenh
1965 1.186 kenh if (wi->wi_atareq.timeout == 0) {
1966 1.185 kenh error = EINVAL;
1967 1.430 jdolecek goto out;
1968 1.185 kenh }
1969 1.185 kenh
1970 1.186 kenh if (wi->wi_atareq.flags & ATACMD_READ)
1971 1.430 jdolecek xfer->c_ata_c.flags |= AT_READ;
1972 1.186 kenh else if (wi->wi_atareq.flags & ATACMD_WRITE)
1973 1.430 jdolecek xfer->c_ata_c.flags |= AT_WRITE;
1974 1.185 kenh
1975 1.188 kenh if (wi->wi_atareq.flags & ATACMD_READREG)
1976 1.430 jdolecek xfer->c_ata_c.flags |= AT_READREG;
1977 1.188 kenh
1978 1.391 jakllsch if ((wi->wi_atareq.flags & ATACMD_LBA) != 0)
1979 1.430 jdolecek xfer->c_ata_c.flags |= AT_LBA;
1980 1.391 jakllsch
1981 1.430 jdolecek xfer->c_ata_c.flags |= AT_WAIT;
1982 1.185 kenh
1983 1.430 jdolecek xfer->c_ata_c.timeout = wi->wi_atareq.timeout;
1984 1.430 jdolecek xfer->c_ata_c.r_command = wi->wi_atareq.command;
1985 1.430 jdolecek xfer->c_ata_c.r_lba = ((wi->wi_atareq.head & 0x0f) << 24) |
1986 1.391 jakllsch (wi->wi_atareq.cylinder << 8) |
1987 1.391 jakllsch wi->wi_atareq.sec_num;
1988 1.430 jdolecek xfer->c_ata_c.r_count = wi->wi_atareq.sec_count;
1989 1.430 jdolecek xfer->c_ata_c.r_features = wi->wi_atareq.features;
1990 1.430 jdolecek xfer->c_ata_c.r_st_bmask = WDCS_DRDY;
1991 1.430 jdolecek xfer->c_ata_c.r_st_pmask = WDCS_DRDY;
1992 1.430 jdolecek xfer->c_ata_c.data = wi->wi_bp.b_data;
1993 1.430 jdolecek xfer->c_ata_c.bcount = wi->wi_bp.b_bcount;
1994 1.185 kenh
1995 1.430 jdolecek if (wi->wi_softc->atabus->ata_exec_command(wi->wi_softc->drvp, xfer)
1996 1.288 thorpej != ATACMD_COMPLETE) {
1997 1.186 kenh wi->wi_atareq.retsts = ATACMD_ERROR;
1998 1.430 jdolecek error = EIO;
1999 1.430 jdolecek goto out;
2000 1.185 kenh }
2001 1.185 kenh
2002 1.430 jdolecek if (xfer->c_ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
2003 1.430 jdolecek if (xfer->c_ata_c.flags & AT_ERROR) {
2004 1.186 kenh wi->wi_atareq.retsts = ATACMD_ERROR;
2005 1.430 jdolecek wi->wi_atareq.error = xfer->c_ata_c.r_error;
2006 1.430 jdolecek } else if (xfer->c_ata_c.flags & AT_DF)
2007 1.186 kenh wi->wi_atareq.retsts = ATACMD_DF;
2008 1.185 kenh else
2009 1.186 kenh wi->wi_atareq.retsts = ATACMD_TIMEOUT;
2010 1.188 kenh } else {
2011 1.186 kenh wi->wi_atareq.retsts = ATACMD_OK;
2012 1.188 kenh if (wi->wi_atareq.flags & ATACMD_READREG) {
2013 1.430 jdolecek wi->wi_atareq.command = xfer->c_ata_c.r_status;
2014 1.430 jdolecek wi->wi_atareq.features = xfer->c_ata_c.r_error;
2015 1.430 jdolecek wi->wi_atareq.sec_count = xfer->c_ata_c.r_count;
2016 1.430 jdolecek wi->wi_atareq.sec_num = xfer->c_ata_c.r_lba & 0xff;
2017 1.430 jdolecek wi->wi_atareq.head = (xfer->c_ata_c.r_device & 0xf0) |
2018 1.430 jdolecek ((xfer->c_ata_c.r_lba >> 24) & 0x0f);
2019 1.430 jdolecek wi->wi_atareq.cylinder =
2020 1.430 jdolecek (xfer->c_ata_c.r_lba >> 8) & 0xffff;
2021 1.430 jdolecek wi->wi_atareq.error = xfer->c_ata_c.r_error;
2022 1.188 kenh }
2023 1.188 kenh }
2024 1.185 kenh
2025 1.430 jdolecek out:
2026 1.430 jdolecek ata_free_xfer(wi->wi_softc->drvp->chnl_softc, xfer);
2027 1.430 jdolecek ata_channel_start(wi->wi_softc->drvp->chnl_softc,
2028 1.430 jdolecek wi->wi_softc->drvp->drive);
2029 1.430 jdolecek out2:
2030 1.185 kenh bp->b_error = error;
2031 1.430 jdolecek if (error)
2032 1.430 jdolecek bp->b_resid = bp->b_bcount;
2033 1.185 kenh biodone(bp);
2034 1.21 deraadt }
2035 1.430 jdolecek
2036 1.430 jdolecek static void
2037 1.430 jdolecek wd_sysctl_attach(struct wd_softc *wd)
2038 1.430 jdolecek {
2039 1.434 mlelstv struct dk_softc *dksc = &wd->sc_dksc;
2040 1.430 jdolecek const struct sysctlnode *node;
2041 1.430 jdolecek int error;
2042 1.430 jdolecek
2043 1.430 jdolecek /* sysctl set-up */
2044 1.430 jdolecek if (sysctl_createv(&wd->nodelog, 0, NULL, &node,
2045 1.434 mlelstv 0, CTLTYPE_NODE, dksc->sc_xname,
2046 1.430 jdolecek SYSCTL_DESCR("wd driver settings"),
2047 1.430 jdolecek NULL, 0, NULL, 0,
2048 1.430 jdolecek CTL_HW, CTL_CREATE, CTL_EOL) != 0) {
2049 1.434 mlelstv aprint_error_dev(dksc->sc_dev,
2050 1.430 jdolecek "could not create %s.%s sysctl node\n",
2051 1.434 mlelstv "hw", dksc->sc_xname);
2052 1.430 jdolecek return;
2053 1.430 jdolecek }
2054 1.430 jdolecek
2055 1.430 jdolecek wd->drv_max_tags = ATA_MAX_OPENINGS;
2056 1.430 jdolecek if ((error = sysctl_createv(&wd->nodelog, 0, NULL, NULL,
2057 1.430 jdolecek CTLFLAG_READWRITE, CTLTYPE_INT, "max_tags",
2058 1.430 jdolecek SYSCTL_DESCR("max number of NCQ tags to use"),
2059 1.430 jdolecek NULL, 0, &wd->drv_max_tags, 0,
2060 1.430 jdolecek CTL_HW, node->sysctl_num, CTL_CREATE, CTL_EOL))
2061 1.430 jdolecek != 0) {
2062 1.434 mlelstv aprint_error_dev(dksc->sc_dev,
2063 1.430 jdolecek "could not create %s.%s.max_tags sysctl - error %d\n",
2064 1.434 mlelstv "hw", dksc->sc_xname, error);
2065 1.430 jdolecek return;
2066 1.430 jdolecek }
2067 1.430 jdolecek
2068 1.430 jdolecek wd->drv_ncq = true;
2069 1.430 jdolecek if ((error = sysctl_createv(&wd->nodelog, 0, NULL, NULL,
2070 1.430 jdolecek CTLFLAG_READWRITE, CTLTYPE_BOOL, "use_ncq",
2071 1.430 jdolecek SYSCTL_DESCR("use NCQ if supported"),
2072 1.430 jdolecek NULL, 0, &wd->drv_ncq, 0,
2073 1.430 jdolecek CTL_HW, node->sysctl_num, CTL_CREATE, CTL_EOL))
2074 1.430 jdolecek != 0) {
2075 1.434 mlelstv aprint_error_dev(dksc->sc_dev,
2076 1.430 jdolecek "could not create %s.%s.use_ncq sysctl - error %d\n",
2077 1.434 mlelstv "hw", dksc->sc_xname, error);
2078 1.430 jdolecek return;
2079 1.430 jdolecek }
2080 1.430 jdolecek
2081 1.432 jdolecek wd->drv_ncq_prio = false;
2082 1.430 jdolecek if ((error = sysctl_createv(&wd->nodelog, 0, NULL, NULL,
2083 1.430 jdolecek CTLFLAG_READWRITE, CTLTYPE_BOOL, "use_ncq_prio",
2084 1.430 jdolecek SYSCTL_DESCR("use NCQ PRIORITY if supported"),
2085 1.430 jdolecek NULL, 0, &wd->drv_ncq_prio, 0,
2086 1.430 jdolecek CTL_HW, node->sysctl_num, CTL_CREATE, CTL_EOL))
2087 1.430 jdolecek != 0) {
2088 1.434 mlelstv aprint_error_dev(dksc->sc_dev,
2089 1.430 jdolecek "could not create %s.%s.use_ncq_prio sysctl - error %d\n",
2090 1.434 mlelstv "hw", dksc->sc_xname, error);
2091 1.430 jdolecek return;
2092 1.430 jdolecek }
2093 1.430 jdolecek
2094 1.430 jdolecek #ifdef WD_CHAOS_MONKEY
2095 1.430 jdolecek wd->drv_chaos_freq = 0;
2096 1.430 jdolecek if ((error = sysctl_createv(&wd->nodelog, 0, NULL, NULL,
2097 1.430 jdolecek CTLFLAG_READWRITE, CTLTYPE_INT, "chaos_freq",
2098 1.430 jdolecek SYSCTL_DESCR("simulated bio read error rate"),
2099 1.430 jdolecek NULL, 0, &wd->drv_chaos_freq, 0,
2100 1.430 jdolecek CTL_HW, node->sysctl_num, CTL_CREATE, CTL_EOL))
2101 1.430 jdolecek != 0) {
2102 1.434 mlelstv aprint_error_dev(dksc->sc_dev,
2103 1.430 jdolecek "could not create %s.%s.chaos_freq sysctl - error %d\n",
2104 1.434 mlelstv "hw", dksc->sc_xname, error);
2105 1.430 jdolecek return;
2106 1.430 jdolecek }
2107 1.430 jdolecek
2108 1.430 jdolecek wd->drv_chaos_cnt = 0;
2109 1.430 jdolecek if ((error = sysctl_createv(&wd->nodelog, 0, NULL, NULL,
2110 1.430 jdolecek CTLFLAG_READONLY, CTLTYPE_INT, "chaos_cnt",
2111 1.430 jdolecek SYSCTL_DESCR("number of processed bio reads"),
2112 1.430 jdolecek NULL, 0, &wd->drv_chaos_cnt, 0,
2113 1.430 jdolecek CTL_HW, node->sysctl_num, CTL_CREATE, CTL_EOL))
2114 1.430 jdolecek != 0) {
2115 1.434 mlelstv aprint_error_dev(dksc->sc_dev,
2116 1.430 jdolecek "could not create %s.%s.chaos_cnt sysctl - error %d\n",
2117 1.434 mlelstv "hw", dksc->sc_xname, error);
2118 1.430 jdolecek return;
2119 1.430 jdolecek }
2120 1.430 jdolecek #endif
2121 1.430 jdolecek
2122 1.430 jdolecek }
2123 1.430 jdolecek
2124 1.430 jdolecek static void
2125 1.430 jdolecek wd_sysctl_detach(struct wd_softc *wd)
2126 1.430 jdolecek {
2127 1.430 jdolecek sysctl_teardown(&wd->nodelog);
2128 1.430 jdolecek }
2129 1.430 jdolecek
2130