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