wd.c revision 1.240 1 1.240 fvdl /* $NetBSD: wd.c,v 1.240 2003/04/03 22:18:23 fvdl 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.204 bouyer * 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.178 mycroft * Copyright (c) 1998 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.240 fvdl __KERNEL_RCSID(0, "$NetBSD: wd.c,v 1.240 2003/04/03 22:18:23 fvdl Exp $");
70 1.1 cgd
71 1.192 hubertf #ifndef WDCDEBUG
72 1.181 bouyer #define WDCDEBUG
73 1.192 hubertf #endif /* WDCDEBUG */
74 1.181 bouyer
75 1.230 junyoung #include "opt_bufq.h"
76 1.166 explorer #include "rnd.h"
77 1.166 explorer
78 1.29 mycroft #include <sys/param.h>
79 1.29 mycroft #include <sys/systm.h>
80 1.43 mycroft #include <sys/kernel.h>
81 1.29 mycroft #include <sys/conf.h>
82 1.29 mycroft #include <sys/file.h>
83 1.29 mycroft #include <sys/stat.h>
84 1.29 mycroft #include <sys/ioctl.h>
85 1.29 mycroft #include <sys/buf.h>
86 1.29 mycroft #include <sys/uio.h>
87 1.29 mycroft #include <sys/malloc.h>
88 1.64 mycroft #include <sys/device.h>
89 1.94 mycroft #include <sys/disklabel.h>
90 1.94 mycroft #include <sys/disk.h>
91 1.29 mycroft #include <sys/syslog.h>
92 1.149 christos #include <sys/proc.h>
93 1.196 enami #include <sys/vnode.h>
94 1.166 explorer #if NRND > 0
95 1.165 explorer #include <sys/rnd.h>
96 1.166 explorer #endif
97 1.29 mycroft
98 1.150 mycroft #include <machine/intr.h>
99 1.168 cgd #include <machine/bus.h>
100 1.29 mycroft
101 1.237 thorpej #define __ATA_DISK_PRIVATE
102 1.237 thorpej
103 1.181 bouyer #include <dev/ata/atareg.h>
104 1.181 bouyer #include <dev/ata/atavar.h>
105 1.181 bouyer #include <dev/ata/wdvar.h>
106 1.181 bouyer #include <dev/ic/wdcreg.h>
107 1.186 kenh #include <sys/ataio.h>
108 1.163 bouyer #include "locators.h"
109 1.1 cgd
110 1.98 mycroft #define WAITTIME (4 * hz) /* time to wait for a completion */
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.181 bouyer #ifdef WDCDEBUG
128 1.181 bouyer extern int wdcdebug_wd_mask; /* init'ed in ata_wdc.c */
129 1.181 bouyer #define WDCDEBUG_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.181 bouyer #define WDCDEBUG_PRINT(args, level)
134 1.163 bouyer #endif
135 1.181 bouyer
136 1.168 cgd int wdprobe __P((struct device *, struct cfdata *, void *));
137 1.163 bouyer void wdattach __P((struct device *, struct device *, void *));
138 1.196 enami int wddetach __P((struct device *, int));
139 1.196 enami int wdactivate __P((struct device *, enum devact));
140 1.181 bouyer int wdprint __P((void *, char *));
141 1.221 yamt void wdperror __P((const struct wd_softc *));
142 1.102 mycroft
143 1.228 thorpej CFATTACH_DECL(wd, sizeof(struct wd_softc),
144 1.229 thorpej wdprobe, wdattach, wddetach, wdactivate);
145 1.147 thorpej
146 1.167 thorpej extern struct cfdriver wd_cd;
147 1.108 mycroft
148 1.225 gehenna dev_type_open(wdopen);
149 1.225 gehenna dev_type_close(wdclose);
150 1.225 gehenna dev_type_read(wdread);
151 1.225 gehenna dev_type_write(wdwrite);
152 1.225 gehenna dev_type_ioctl(wdioctl);
153 1.225 gehenna dev_type_strategy(wdstrategy);
154 1.225 gehenna dev_type_dump(wddump);
155 1.225 gehenna dev_type_size(wdsize);
156 1.225 gehenna
157 1.225 gehenna const struct bdevsw wd_bdevsw = {
158 1.225 gehenna wdopen, wdclose, wdstrategy, wdioctl, wddump, wdsize, D_DISK
159 1.225 gehenna };
160 1.225 gehenna
161 1.225 gehenna const struct cdevsw wd_cdevsw = {
162 1.225 gehenna wdopen, wdclose, wdread, wdwrite, wdioctl,
163 1.231 jdolecek nostop, notty, nopoll, nommap, nokqfilter, D_DISK
164 1.225 gehenna };
165 1.225 gehenna
166 1.185 kenh /*
167 1.185 kenh * Glue necessary to hook WDCIOCCOMMAND into physio
168 1.185 kenh */
169 1.185 kenh
170 1.185 kenh struct wd_ioctl {
171 1.185 kenh LIST_ENTRY(wd_ioctl) wi_list;
172 1.185 kenh struct buf wi_bp;
173 1.185 kenh struct uio wi_uio;
174 1.185 kenh struct iovec wi_iov;
175 1.186 kenh atareq_t wi_atareq;
176 1.185 kenh struct wd_softc *wi_softc;
177 1.185 kenh };
178 1.185 kenh
179 1.185 kenh LIST_HEAD(, wd_ioctl) wi_head;
180 1.185 kenh
181 1.185 kenh struct wd_ioctl *wi_find __P((struct buf *));
182 1.185 kenh void wi_free __P((struct wd_ioctl *));
183 1.185 kenh struct wd_ioctl *wi_get __P((void));
184 1.185 kenh void wdioctlstrategy __P((struct buf *));
185 1.185 kenh
186 1.181 bouyer void wdgetdefaultlabel __P((struct wd_softc *, struct disklabel *));
187 1.181 bouyer void wdgetdisklabel __P((struct wd_softc *));
188 1.181 bouyer void wdstart __P((void *));
189 1.181 bouyer void __wdstart __P((struct wd_softc*, struct buf *));
190 1.181 bouyer void wdrestart __P((void*));
191 1.181 bouyer int wd_get_params __P((struct wd_softc *, u_int8_t, struct ataparams *));
192 1.190 bouyer void wd_flushcache __P((struct wd_softc *, int));
193 1.190 bouyer void wd_shutdown __P((void*));
194 1.108 mycroft
195 1.102 mycroft struct dkdriver wddkdriver = { wdstrategy };
196 1.65 mycroft
197 1.170 leo #ifdef HAS_BAD144_HANDLING
198 1.64 mycroft static void bad144intern __P((struct wd_softc *));
199 1.170 leo #endif
200 1.181 bouyer int wdlock __P((struct wd_softc *));
201 1.181 bouyer void wdunlock __P((struct wd_softc *));
202 1.1 cgd
203 1.239 thorpej #define WD_QUIRK_SPLIT_MOD15_WRITE 0x0001 /* must split certain writes */
204 1.239 thorpej
205 1.239 thorpej /*
206 1.239 thorpej * Quirk table for IDE drives. Put more-specific matches first, since
207 1.239 thorpej * a simple globbing routine is used for matching.
208 1.239 thorpej */
209 1.239 thorpej static const struct wd_quirk {
210 1.239 thorpej const char *wdq_match; /* inquiry pattern to match */
211 1.239 thorpej int wdq_quirks; /* drive quirks */
212 1.239 thorpej } wd_quirk_table[] = {
213 1.239 thorpej /*
214 1.239 thorpej * Some Seagate S-ATA drives have a PHY which can get confused
215 1.239 thorpej * with the way data is packetized by some S-ATA controllers.
216 1.239 thorpej *
217 1.239 thorpej * The work-around is to split in two any write transfer who's
218 1.239 thorpej * sector count % 15 == 1 (assuming 512 byte sectors).
219 1.239 thorpej *
220 1.239 thorpej * XXX This is an incomplete list. There are at least a couple
221 1.239 thorpej * XXX more model numbers. If you have trouble with such transfers
222 1.239 thorpej * XXX (8K is the most common) on Seagate S-ATA drives, please
223 1.239 thorpej * XXX notify thorpej (at) netbsd.org.
224 1.239 thorpej */
225 1.239 thorpej { "ST3120023AS",
226 1.239 thorpej WD_QUIRK_SPLIT_MOD15_WRITE },
227 1.239 thorpej
228 1.239 thorpej { NULL,
229 1.239 thorpej 0 }
230 1.239 thorpej };
231 1.239 thorpej
232 1.239 thorpej static const struct wd_quirk *
233 1.239 thorpej wd_lookup_quirks(const char *name)
234 1.239 thorpej {
235 1.239 thorpej const struct wd_quirk *wdq;
236 1.239 thorpej const char *estr;
237 1.239 thorpej
238 1.239 thorpej for (wdq = wd_quirk_table; wdq->wdq_match != NULL; wdq++) {
239 1.239 thorpej /*
240 1.239 thorpej * We only want exact matches (which include matches
241 1.239 thorpej * against globbing characters).
242 1.239 thorpej */
243 1.239 thorpej if (pmatch(name, wdq->wdq_match, &estr) == 2)
244 1.239 thorpej return (wdq);
245 1.239 thorpej }
246 1.239 thorpej return (NULL);
247 1.239 thorpej }
248 1.239 thorpej
249 1.1 cgd int
250 1.163 bouyer wdprobe(parent, match, aux)
251 1.102 mycroft struct device *parent;
252 1.168 cgd struct cfdata *match;
253 1.168 cgd
254 1.168 cgd void *aux;
255 1.1 cgd {
256 1.216 bouyer struct ata_device *adev = aux;
257 1.167 thorpej
258 1.216 bouyer if (adev == NULL)
259 1.181 bouyer return 0;
260 1.216 bouyer if (adev->adev_bustype->bustype_type != SCSIPI_BUSTYPE_ATA)
261 1.64 mycroft return 0;
262 1.181 bouyer
263 1.181 bouyer if (match->cf_loc[ATACF_CHANNEL] != ATACF_CHANNEL_DEFAULT &&
264 1.216 bouyer match->cf_loc[ATACF_CHANNEL] != adev->adev_channel)
265 1.105 mycroft return 0;
266 1.105 mycroft
267 1.168 cgd if (match->cf_loc[ATACF_DRIVE] != ATACF_DRIVE_DEFAULT &&
268 1.216 bouyer match->cf_loc[ATACF_DRIVE] != adev->adev_drv_data->drive)
269 1.74 mycroft return 0;
270 1.74 mycroft return 1;
271 1.74 mycroft }
272 1.64 mycroft
273 1.74 mycroft void
274 1.74 mycroft wdattach(parent, self, aux)
275 1.74 mycroft struct device *parent, *self;
276 1.74 mycroft void *aux;
277 1.74 mycroft {
278 1.74 mycroft struct wd_softc *wd = (void *)self;
279 1.216 bouyer struct ata_device *adev= aux;
280 1.74 mycroft int i, blank;
281 1.201 enami char buf[41], pbuf[9], c, *p, *q;
282 1.239 thorpej const struct wd_quirk *wdq;
283 1.181 bouyer WDCDEBUG_PRINT(("wdattach\n"), DEBUG_FUNCS | DEBUG_PROBE);
284 1.56 mycroft
285 1.203 thorpej callout_init(&wd->sc_restart_ch);
286 1.230 junyoung #ifdef NEW_BUFQ_STRATEGY
287 1.230 junyoung bufq_alloc(&wd->sc_q, BUFQ_READ_PRIO|BUFQ_SORT_RAWBLOCK);
288 1.230 junyoung #else
289 1.224 hannken bufq_alloc(&wd->sc_q, BUFQ_DISKSORT|BUFQ_SORT_RAWBLOCK);
290 1.230 junyoung #endif
291 1.200 thorpej
292 1.217 bouyer wd->atabus = adev->adev_bustype;
293 1.216 bouyer wd->openings = adev->adev_openings;
294 1.235 simonb wd->drvp = adev->adev_drv_data;
295 1.181 bouyer wd->wdc_softc = parent;
296 1.181 bouyer /* give back our softc to our caller */
297 1.181 bouyer wd->drvp->drv_softc = &wd->sc_dev;
298 1.181 bouyer
299 1.181 bouyer /* read our drive info */
300 1.181 bouyer if (wd_get_params(wd, AT_POLL, &wd->sc_params) != 0) {
301 1.181 bouyer printf("%s: IDENTIFY failed\n", wd->sc_dev.dv_xname);
302 1.181 bouyer return;
303 1.181 bouyer }
304 1.163 bouyer
305 1.181 bouyer for (blank = 0, p = wd->sc_params.atap_model, q = buf, i = 0;
306 1.181 bouyer i < sizeof(wd->sc_params.atap_model); i++) {
307 1.135 mycroft c = *p++;
308 1.135 mycroft if (c == '\0')
309 1.135 mycroft break;
310 1.135 mycroft if (c != ' ') {
311 1.135 mycroft if (blank) {
312 1.135 mycroft *q++ = ' ';
313 1.135 mycroft blank = 0;
314 1.135 mycroft }
315 1.135 mycroft *q++ = c;
316 1.135 mycroft } else
317 1.135 mycroft blank = 1;
318 1.195 enami }
319 1.135 mycroft *q++ = '\0';
320 1.135 mycroft
321 1.172 mycroft printf(": <%s>\n", buf);
322 1.113 mycroft
323 1.239 thorpej wdq = wd_lookup_quirks(buf);
324 1.239 thorpej if (wdq != NULL)
325 1.239 thorpej wd->sc_quirks = wdq->wdq_quirks;
326 1.239 thorpej
327 1.181 bouyer if ((wd->sc_params.atap_multi & 0xff) > 1) {
328 1.181 bouyer wd->sc_multi = wd->sc_params.atap_multi & 0xff;
329 1.113 mycroft } else {
330 1.181 bouyer wd->sc_multi = 1;
331 1.113 mycroft }
332 1.113 mycroft
333 1.210 lukem printf("%s: drive supports %d-sector PIO transfers,",
334 1.184 bouyer wd->sc_dev.dv_xname, wd->sc_multi);
335 1.172 mycroft
336 1.220 christos /* 48-bit LBA addressing */
337 1.220 christos if ((wd->sc_params.atap_cmd2_en & WDC_CAP_LBA48) != 0)
338 1.220 christos wd->sc_flags |= WDF_LBA48;
339 1.220 christos
340 1.172 mycroft /* Prior to ATA-4, LBA was optional. */
341 1.181 bouyer if ((wd->sc_params.atap_capabilities1 & WDC_CAP_LBA) != 0)
342 1.181 bouyer wd->sc_flags |= WDF_LBA;
343 1.174 mycroft #if 0
344 1.172 mycroft /* ATA-4 requires LBA. */
345 1.181 bouyer if (wd->sc_params.atap_ataversion != 0xffff &&
346 1.181 bouyer wd->sc_params.atap_ataversion >= WDC_VER_ATA4)
347 1.181 bouyer wd->sc_flags |= WDF_LBA;
348 1.174 mycroft #endif
349 1.172 mycroft
350 1.220 christos if ((wd->sc_flags & WDF_LBA48) != 0) {
351 1.220 christos printf(" LBA48 addressing\n");
352 1.220 christos wd->sc_capacity =
353 1.220 christos ((u_int64_t) wd->sc_params.__reserved6[11] << 48) |
354 1.220 christos ((u_int64_t) wd->sc_params.__reserved6[10] << 32) |
355 1.220 christos ((u_int64_t) wd->sc_params.__reserved6[9] << 16) |
356 1.220 christos ((u_int64_t) wd->sc_params.__reserved6[8] << 0);
357 1.220 christos } else if ((wd->sc_flags & WDF_LBA) != 0) {
358 1.210 lukem printf(" LBA addressing\n");
359 1.181 bouyer wd->sc_capacity =
360 1.181 bouyer (wd->sc_params.atap_capacity[1] << 16) |
361 1.181 bouyer wd->sc_params.atap_capacity[0];
362 1.172 mycroft } else {
363 1.184 bouyer printf(" chs addressing\n");
364 1.181 bouyer wd->sc_capacity =
365 1.181 bouyer wd->sc_params.atap_cylinders *
366 1.181 bouyer wd->sc_params.atap_heads *
367 1.181 bouyer wd->sc_params.atap_sectors;
368 1.172 mycroft }
369 1.240 fvdl format_bytes(pbuf, sizeof(pbuf), wd->sc_capacity * DEV_BSIZE);
370 1.201 enami printf("%s: %s, %d cyl, %d head, %d sec, "
371 1.240 fvdl "%d bytes/sect x %llu sectors\n",
372 1.201 enami self->dv_xname, pbuf, wd->sc_params.atap_cylinders,
373 1.201 enami wd->sc_params.atap_heads, wd->sc_params.atap_sectors,
374 1.240 fvdl DEV_BSIZE, (unsigned long long)wd->sc_capacity);
375 1.201 enami
376 1.181 bouyer WDCDEBUG_PRINT(("%s: atap_dmatiming_mimi=%d, atap_dmatiming_recom=%d\n",
377 1.181 bouyer self->dv_xname, wd->sc_params.atap_dmatiming_mimi,
378 1.181 bouyer wd->sc_params.atap_dmatiming_recom), DEBUG_PROBE);
379 1.181 bouyer /*
380 1.181 bouyer * Initialize and attach the disk structure.
381 1.181 bouyer */
382 1.181 bouyer wd->sc_dk.dk_driver = &wddkdriver;
383 1.181 bouyer wd->sc_dk.dk_name = wd->sc_dev.dv_xname;
384 1.181 bouyer disk_attach(&wd->sc_dk);
385 1.181 bouyer wd->sc_wdc_bio.lp = wd->sc_dk.dk_label;
386 1.196 enami wd->sc_sdhook = shutdownhook_establish(wd_shutdown, wd);
387 1.196 enami if (wd->sc_sdhook == NULL)
388 1.190 bouyer printf("%s: WARNING: unable to establish shutdown hook\n",
389 1.190 bouyer wd->sc_dev.dv_xname);
390 1.166 explorer #if NRND > 0
391 1.193 explorer rnd_attach_source(&wd->rnd_source, wd->sc_dev.dv_xname,
392 1.193 explorer RND_TYPE_DISK, 0);
393 1.166 explorer #endif
394 1.196 enami }
395 1.196 enami
396 1.196 enami int
397 1.196 enami wdactivate(self, act)
398 1.196 enami struct device *self;
399 1.196 enami enum devact act;
400 1.196 enami {
401 1.196 enami int rv = 0;
402 1.196 enami
403 1.196 enami switch (act) {
404 1.196 enami case DVACT_ACTIVATE:
405 1.196 enami rv = EOPNOTSUPP;
406 1.196 enami break;
407 1.196 enami
408 1.196 enami case DVACT_DEACTIVATE:
409 1.196 enami /*
410 1.196 enami * Nothing to do; we key off the device's DVF_ACTIVATE.
411 1.196 enami */
412 1.196 enami break;
413 1.196 enami }
414 1.196 enami return (rv);
415 1.196 enami }
416 1.196 enami
417 1.196 enami int
418 1.196 enami wddetach(self, flags)
419 1.196 enami struct device *self;
420 1.196 enami int flags;
421 1.196 enami {
422 1.196 enami struct wd_softc *sc = (struct wd_softc *)self;
423 1.196 enami struct buf *bp;
424 1.213 drochner int s, bmaj, cmaj, i, mn;
425 1.196 enami
426 1.196 enami /* locate the major number */
427 1.225 gehenna bmaj = bdevsw_lookup_major(&wd_bdevsw);
428 1.225 gehenna cmaj = cdevsw_lookup_major(&wd_cdevsw);
429 1.196 enami
430 1.196 enami s = splbio();
431 1.196 enami
432 1.196 enami /* Kill off any queued buffers. */
433 1.223 hannken while ((bp = BUFQ_GET(&sc->sc_q)) != NULL) {
434 1.196 enami bp->b_error = EIO;
435 1.196 enami bp->b_flags |= B_ERROR;
436 1.196 enami bp->b_resid = bp->b_bcount;
437 1.196 enami biodone(bp);
438 1.196 enami }
439 1.224 hannken
440 1.224 hannken bufq_free(&sc->sc_q);
441 1.196 enami
442 1.196 enami splx(s);
443 1.196 enami
444 1.196 enami /* Nuke the vnodes for any open instances. */
445 1.213 drochner for (i = 0; i < MAXPARTITIONS; i++) {
446 1.213 drochner mn = WDMINOR(self->dv_unit, i);
447 1.213 drochner vdevgone(bmaj, mn, mn, VBLK);
448 1.213 drochner vdevgone(cmaj, mn, mn, VCHR);
449 1.213 drochner }
450 1.196 enami
451 1.196 enami /* Detach disk. */
452 1.196 enami disk_detach(&sc->sc_dk);
453 1.196 enami
454 1.196 enami /* Get rid of the shutdown hook. */
455 1.196 enami if (sc->sc_sdhook != NULL)
456 1.196 enami shutdownhook_disestablish(sc->sc_sdhook);
457 1.196 enami
458 1.196 enami #if NRND > 0
459 1.196 enami /* Unhook the entropy source. */
460 1.196 enami rnd_detach_source(&sc->rnd_source);
461 1.196 enami #endif
462 1.196 enami
463 1.196 enami return (0);
464 1.1 cgd }
465 1.1 cgd
466 1.64 mycroft /*
467 1.135 mycroft * Read/write routine for a buffer. Validates the arguments and schedules the
468 1.135 mycroft * transfer. Does not wait for the transfer to complete.
469 1.1 cgd */
470 1.64 mycroft void
471 1.55 mycroft wdstrategy(bp)
472 1.55 mycroft struct buf *bp;
473 1.1 cgd {
474 1.209 thorpej struct wd_softc *wd = device_lookup(&wd_cd, WDUNIT(bp->b_dev));
475 1.202 thorpej struct disklabel *lp = wd->sc_dk.dk_label;
476 1.202 thorpej daddr_t blkno;
477 1.37 mycroft int s;
478 1.202 thorpej
479 1.181 bouyer WDCDEBUG_PRINT(("wdstrategy (%s)\n", wd->sc_dev.dv_xname),
480 1.182 bouyer DEBUG_XFERS);
481 1.181 bouyer
482 1.135 mycroft /* Valid request? */
483 1.135 mycroft if (bp->b_blkno < 0 ||
484 1.202 thorpej (bp->b_bcount % lp->d_secsize) != 0 ||
485 1.202 thorpej (bp->b_bcount / lp->d_secsize) >= (1 << NBBY)) {
486 1.1 cgd bp->b_error = EINVAL;
487 1.93 mycroft goto bad;
488 1.1 cgd }
489 1.181 bouyer
490 1.135 mycroft /* If device invalidated (e.g. media change, door open), error. */
491 1.181 bouyer if ((wd->sc_flags & WDF_LOADED) == 0) {
492 1.135 mycroft bp->b_error = EIO;
493 1.135 mycroft goto bad;
494 1.135 mycroft }
495 1.135 mycroft
496 1.93 mycroft /* If it's a null transfer, return immediately. */
497 1.93 mycroft if (bp->b_bcount == 0)
498 1.93 mycroft goto done;
499 1.93 mycroft
500 1.128 mycroft /*
501 1.128 mycroft * Do bounds checking, adjust transfer. if error, process.
502 1.128 mycroft * If end of partition, just return.
503 1.128 mycroft */
504 1.240 fvdl if (WDPART(bp->b_dev) == RAW_PART) {
505 1.240 fvdl if (bounds_check_with_mediasize(bp, DEV_BSIZE,
506 1.240 fvdl wd->sc_capacity) <= 0)
507 1.240 fvdl goto done;
508 1.240 fvdl } else {
509 1.240 fvdl if (bounds_check_with_label(bp, wd->sc_dk.dk_label,
510 1.240 fvdl (wd->sc_flags & (WDF_WLABEL|WDF_LABELLING)) != 0) <= 0)
511 1.240 fvdl goto done;
512 1.240 fvdl }
513 1.202 thorpej
514 1.202 thorpej /*
515 1.202 thorpej * Now convert the block number to absolute and put it in
516 1.202 thorpej * terms of the device's logical block size.
517 1.202 thorpej */
518 1.202 thorpej if (lp->d_secsize >= DEV_BSIZE)
519 1.202 thorpej blkno = bp->b_blkno / (lp->d_secsize / DEV_BSIZE);
520 1.202 thorpej else
521 1.202 thorpej blkno = bp->b_blkno * (DEV_BSIZE / lp->d_secsize);
522 1.202 thorpej
523 1.202 thorpej if (WDPART(bp->b_dev) != RAW_PART)
524 1.202 thorpej blkno += lp->d_partitions[WDPART(bp->b_dev)].p_offset;
525 1.202 thorpej
526 1.202 thorpej bp->b_rawblkno = blkno;
527 1.202 thorpej
528 1.64 mycroft /* Queue transfer on drive, activate drive and controller if idle. */
529 1.1 cgd s = splbio();
530 1.223 hannken BUFQ_PUT(&wd->sc_q, bp);
531 1.163 bouyer wdstart(wd);
532 1.1 cgd splx(s);
533 1.64 mycroft return;
534 1.93 mycroft bad:
535 1.93 mycroft bp->b_flags |= B_ERROR;
536 1.1 cgd done:
537 1.64 mycroft /* Toss transfer; we're done early. */
538 1.135 mycroft bp->b_resid = bp->b_bcount;
539 1.1 cgd biodone(bp);
540 1.1 cgd }
541 1.1 cgd
542 1.1 cgd /*
543 1.135 mycroft * Queue a drive for I/O.
544 1.1 cgd */
545 1.108 mycroft void
546 1.163 bouyer wdstart(arg)
547 1.163 bouyer void *arg;
548 1.1 cgd {
549 1.163 bouyer struct wd_softc *wd = arg;
550 1.200 thorpej struct buf *bp = NULL;
551 1.163 bouyer
552 1.181 bouyer WDCDEBUG_PRINT(("wdstart %s\n", wd->sc_dev.dv_xname),
553 1.182 bouyer DEBUG_XFERS);
554 1.181 bouyer while (wd->openings > 0) {
555 1.163 bouyer
556 1.163 bouyer /* Is there a buf for us ? */
557 1.223 hannken if ((bp = BUFQ_GET(&wd->sc_q)) == NULL)
558 1.200 thorpej return;
559 1.181 bouyer
560 1.163 bouyer /*
561 1.163 bouyer * Make the command. First lock the device
562 1.163 bouyer */
563 1.181 bouyer wd->openings--;
564 1.181 bouyer
565 1.181 bouyer wd->retries = 0;
566 1.181 bouyer __wdstart(wd, bp);
567 1.181 bouyer }
568 1.181 bouyer }
569 1.181 bouyer
570 1.239 thorpej static void
571 1.239 thorpej wd_split_mod15_write(struct buf *bp)
572 1.239 thorpej {
573 1.239 thorpej struct buf *obp = bp->b_private;
574 1.239 thorpej struct wd_softc *sc = wd_cd.cd_devs[DISKUNIT(obp->b_dev)];
575 1.239 thorpej
576 1.239 thorpej if (__predict_false(bp->b_flags & B_ERROR) != 0) {
577 1.239 thorpej /*
578 1.239 thorpej * Propagate the error. If this was the first half of
579 1.239 thorpej * the original transfer, make sure to account for that
580 1.239 thorpej * in the residual.
581 1.239 thorpej */
582 1.239 thorpej if (bp->b_data == obp->b_data)
583 1.239 thorpej bp->b_resid += bp->b_bcount;
584 1.239 thorpej goto done;
585 1.239 thorpej }
586 1.239 thorpej
587 1.239 thorpej /*
588 1.239 thorpej * If this was the second half of the transfer, we're all done!
589 1.239 thorpej */
590 1.239 thorpej if (bp->b_data != obp->b_data)
591 1.239 thorpej goto done;
592 1.239 thorpej
593 1.239 thorpej /*
594 1.239 thorpej * Advance the pointer to the second half and issue that command
595 1.239 thorpej * using the same opening.
596 1.239 thorpej */
597 1.239 thorpej bp->b_flags = obp->b_flags | B_CALL;
598 1.239 thorpej bp->b_data += bp->b_bcount;
599 1.239 thorpej bp->b_blkno += (bp->b_bcount / 512);
600 1.239 thorpej bp->b_rawblkno += (bp->b_bcount / 512);
601 1.239 thorpej __wdstart(sc, bp);
602 1.239 thorpej return;
603 1.239 thorpej
604 1.239 thorpej done:
605 1.239 thorpej obp->b_flags |= (bp->b_flags & (B_EINTR|B_ERROR));
606 1.239 thorpej obp->b_error = bp->b_error;
607 1.239 thorpej obp->b_resid = bp->b_resid;
608 1.239 thorpej pool_put(&bufpool, bp);
609 1.239 thorpej biodone(obp);
610 1.239 thorpej sc->openings++;
611 1.239 thorpej /* wddone() will call wdstart() */
612 1.239 thorpej }
613 1.239 thorpej
614 1.181 bouyer void
615 1.181 bouyer __wdstart(wd, bp)
616 1.181 bouyer struct wd_softc *wd;
617 1.181 bouyer struct buf *bp;
618 1.181 bouyer {
619 1.202 thorpej
620 1.239 thorpej /*
621 1.239 thorpej * Deal with the "split mod15 write" quirk. We just divide the
622 1.239 thorpej * transfer in two, doing the first half and then then second half
623 1.239 thorpej * with the same command opening.
624 1.239 thorpej *
625 1.239 thorpej * Note we MUST do this here, because we can't let insertion
626 1.239 thorpej * into the bufq cause the transfers to be re-merged.
627 1.239 thorpej */
628 1.239 thorpej if (__predict_false((wd->sc_quirks & WD_QUIRK_SPLIT_MOD15_WRITE) != 0 &&
629 1.239 thorpej (bp->b_flags & B_READ) == 0 &&
630 1.239 thorpej bp->b_bcount > 512 &&
631 1.239 thorpej ((bp->b_bcount / 512) % 15) == 1)) {
632 1.239 thorpej struct buf *nbp;
633 1.239 thorpej
634 1.239 thorpej /* already at splbio */
635 1.239 thorpej nbp = pool_get(&bufpool, PR_NOWAIT);
636 1.239 thorpej if (__predict_false(nbp == NULL)) {
637 1.239 thorpej /* No memory -- fail the iop. */
638 1.239 thorpej bp->b_error = ENOMEM;
639 1.239 thorpej bp->b_flags |= B_ERROR;
640 1.239 thorpej bp->b_resid = bp->b_bcount;
641 1.239 thorpej biodone(bp);
642 1.239 thorpej wd->openings++;
643 1.239 thorpej return;
644 1.239 thorpej }
645 1.239 thorpej
646 1.239 thorpej BUF_INIT(nbp);
647 1.239 thorpej nbp->b_error = 0;
648 1.239 thorpej nbp->b_proc = bp->b_proc;
649 1.239 thorpej nbp->b_vp = NULLVP;
650 1.239 thorpej nbp->b_dev = bp->b_dev;
651 1.239 thorpej
652 1.239 thorpej nbp->b_bcount = bp->b_bcount / 2;
653 1.239 thorpej nbp->b_bufsize = bp->b_bcount / 2;
654 1.239 thorpej nbp->b_data = bp->b_data;
655 1.239 thorpej
656 1.239 thorpej nbp->b_blkno = bp->b_blkno;
657 1.239 thorpej nbp->b_rawblkno = bp->b_rawblkno;
658 1.239 thorpej
659 1.239 thorpej nbp->b_flags = bp->b_flags | B_CALL;
660 1.239 thorpej nbp->b_iodone = wd_split_mod15_write;
661 1.239 thorpej
662 1.239 thorpej /* Put ptr to orig buf in b_private and use new buf */
663 1.239 thorpej nbp->b_private = bp;
664 1.239 thorpej bp = nbp;
665 1.239 thorpej }
666 1.239 thorpej
667 1.202 thorpej wd->sc_wdc_bio.blkno = bp->b_rawblkno;
668 1.181 bouyer wd->sc_wdc_bio.blkdone =0;
669 1.181 bouyer wd->sc_bp = bp;
670 1.181 bouyer /*
671 1.181 bouyer * If we're retrying, retry in single-sector mode. This will give us
672 1.181 bouyer * the sector number of the problem, and will eventually allow the
673 1.184 bouyer * transfer to succeed.
674 1.181 bouyer */
675 1.189 bouyer if (wd->sc_multi == 1 || wd->retries >= WDIORETRIES_SINGLE)
676 1.181 bouyer wd->sc_wdc_bio.flags = ATA_SINGLE;
677 1.181 bouyer else
678 1.181 bouyer wd->sc_wdc_bio.flags = 0;
679 1.220 christos if (wd->sc_flags & WDF_LBA48)
680 1.220 christos wd->sc_wdc_bio.flags |= ATA_LBA48;
681 1.181 bouyer if (wd->sc_flags & WDF_LBA)
682 1.181 bouyer wd->sc_wdc_bio.flags |= ATA_LBA;
683 1.181 bouyer if (bp->b_flags & B_READ)
684 1.181 bouyer wd->sc_wdc_bio.flags |= ATA_READ;
685 1.181 bouyer wd->sc_wdc_bio.bcount = bp->b_bcount;
686 1.181 bouyer wd->sc_wdc_bio.databuf = bp->b_data;
687 1.181 bouyer /* Instrumentation. */
688 1.181 bouyer disk_busy(&wd->sc_dk);
689 1.217 bouyer switch (wd->atabus->ata_bio(wd->drvp, &wd->sc_wdc_bio)) {
690 1.181 bouyer case WDC_TRY_AGAIN:
691 1.203 thorpej callout_reset(&wd->sc_restart_ch, hz, wdrestart, wd);
692 1.181 bouyer break;
693 1.181 bouyer case WDC_QUEUED:
694 1.181 bouyer case WDC_COMPLETE:
695 1.181 bouyer break;
696 1.181 bouyer default:
697 1.217 bouyer panic("__wdstart: bad return code from ata_bio()");
698 1.181 bouyer }
699 1.181 bouyer }
700 1.181 bouyer
701 1.181 bouyer void
702 1.181 bouyer wddone(v)
703 1.181 bouyer void *v;
704 1.181 bouyer {
705 1.181 bouyer struct wd_softc *wd = v;
706 1.181 bouyer struct buf *bp = wd->sc_bp;
707 1.221 yamt const char *errmsg;
708 1.221 yamt int do_perror = 0;
709 1.181 bouyer WDCDEBUG_PRINT(("wddone %s\n", wd->sc_dev.dv_xname),
710 1.182 bouyer DEBUG_XFERS);
711 1.181 bouyer
712 1.214 bjh21 if (bp == NULL)
713 1.214 bjh21 return;
714 1.181 bouyer bp->b_resid = wd->sc_wdc_bio.bcount;
715 1.181 bouyer switch (wd->sc_wdc_bio.error) {
716 1.181 bouyer case ERR_DMA:
717 1.221 yamt errmsg = "DMA error";
718 1.181 bouyer goto retry;
719 1.181 bouyer case ERR_DF:
720 1.221 yamt errmsg = "device fault";
721 1.181 bouyer goto retry;
722 1.181 bouyer case TIMEOUT:
723 1.221 yamt errmsg = "device timeout";
724 1.181 bouyer goto retry;
725 1.181 bouyer case ERROR:
726 1.181 bouyer /* Don't care about media change bits */
727 1.181 bouyer if (wd->sc_wdc_bio.r_error != 0 &&
728 1.181 bouyer (wd->sc_wdc_bio.r_error & ~(WDCE_MC | WDCE_MCR)) == 0)
729 1.181 bouyer goto noerror;
730 1.221 yamt errmsg = "error";
731 1.221 yamt do_perror = 1;
732 1.181 bouyer retry: /* Just reset and retry. Can we do more ? */
733 1.217 bouyer wd->atabus->ata_reset_channel(wd->drvp);
734 1.221 yamt diskerr(bp, "wd", errmsg, LOG_PRINTF,
735 1.181 bouyer wd->sc_wdc_bio.blkdone, wd->sc_dk.dk_label);
736 1.221 yamt if (wd->retries < WDIORETRIES)
737 1.181 bouyer printf(", retrying\n");
738 1.221 yamt if (do_perror)
739 1.221 yamt wdperror(wd);
740 1.221 yamt if (wd->retries < WDIORETRIES) {
741 1.221 yamt wd->retries++;
742 1.203 thorpej callout_reset(&wd->sc_restart_ch, RECOVERYTIME,
743 1.203 thorpej wdrestart, wd);
744 1.181 bouyer return;
745 1.181 bouyer }
746 1.181 bouyer printf("\n");
747 1.181 bouyer bp->b_flags |= B_ERROR;
748 1.181 bouyer bp->b_error = EIO;
749 1.181 bouyer break;
750 1.181 bouyer case NOERROR:
751 1.181 bouyer noerror: if ((wd->sc_wdc_bio.flags & ATA_CORR) || wd->retries > 0)
752 1.181 bouyer printf("%s: soft error (corrected)\n",
753 1.181 bouyer wd->sc_dev.dv_xname);
754 1.197 enami break;
755 1.197 enami case ERR_NODEV:
756 1.197 enami bp->b_flags |= B_ERROR;
757 1.197 enami bp->b_error = EIO;
758 1.197 enami break;
759 1.64 mycroft }
760 1.232 mrg disk_unbusy(&wd->sc_dk, (bp->b_bcount - bp->b_resid),
761 1.232 mrg (bp->b_flags & B_READ));
762 1.181 bouyer #if NRND > 0
763 1.181 bouyer rnd_add_uint32(&wd->rnd_source, bp->b_blkno);
764 1.181 bouyer #endif
765 1.239 thorpej /* XXX Yuck, but we don't want to increment openings in this case */
766 1.239 thorpej if (__predict_false((bp->b_flags & B_CALL) != 0 &&
767 1.239 thorpej bp->b_iodone == wd_split_mod15_write))
768 1.239 thorpej biodone(bp);
769 1.239 thorpej else {
770 1.239 thorpej biodone(bp);
771 1.239 thorpej wd->openings++;
772 1.239 thorpej }
773 1.181 bouyer wdstart(wd);
774 1.181 bouyer }
775 1.181 bouyer
776 1.181 bouyer void
777 1.181 bouyer wdrestart(v)
778 1.181 bouyer 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.181 bouyer int s;
783 1.181 bouyer WDCDEBUG_PRINT(("wdrestart %s\n", wd->sc_dev.dv_xname),
784 1.182 bouyer DEBUG_XFERS);
785 1.181 bouyer
786 1.181 bouyer s = splbio();
787 1.181 bouyer __wdstart(v, bp);
788 1.181 bouyer splx(s);
789 1.141 mycroft }
790 1.141 mycroft
791 1.141 mycroft int
792 1.149 christos wdread(dev, uio, flags)
793 1.141 mycroft dev_t dev;
794 1.141 mycroft struct uio *uio;
795 1.149 christos int flags;
796 1.141 mycroft {
797 1.141 mycroft
798 1.182 bouyer WDCDEBUG_PRINT(("wdread\n"), DEBUG_XFERS);
799 1.141 mycroft return (physio(wdstrategy, NULL, dev, B_READ, minphys, uio));
800 1.141 mycroft }
801 1.141 mycroft
802 1.141 mycroft int
803 1.149 christos wdwrite(dev, uio, flags)
804 1.141 mycroft dev_t dev;
805 1.141 mycroft struct uio *uio;
806 1.149 christos int flags;
807 1.141 mycroft {
808 1.141 mycroft
809 1.182 bouyer WDCDEBUG_PRINT(("wdwrite\n"), DEBUG_XFERS);
810 1.141 mycroft return (physio(wdstrategy, NULL, dev, B_WRITE, minphys, uio));
811 1.64 mycroft }
812 1.64 mycroft
813 1.1 cgd /*
814 1.135 mycroft * Wait interruptibly for an exclusive lock.
815 1.135 mycroft *
816 1.135 mycroft * XXX
817 1.135 mycroft * Several drivers do this; it should be abstracted and made MP-safe.
818 1.135 mycroft */
819 1.132 mycroft int
820 1.181 bouyer wdlock(wd)
821 1.181 bouyer struct wd_softc *wd;
822 1.132 mycroft {
823 1.132 mycroft int error;
824 1.163 bouyer int s;
825 1.163 bouyer
826 1.181 bouyer WDCDEBUG_PRINT(("wdlock\n"), DEBUG_FUNCS);
827 1.132 mycroft
828 1.163 bouyer s = splbio();
829 1.163 bouyer
830 1.181 bouyer while ((wd->sc_flags & WDF_LOCKED) != 0) {
831 1.181 bouyer wd->sc_flags |= WDF_WANTED;
832 1.181 bouyer if ((error = tsleep(wd, PRIBIO | PCATCH,
833 1.163 bouyer "wdlck", 0)) != 0) {
834 1.163 bouyer splx(s);
835 1.132 mycroft return error;
836 1.163 bouyer }
837 1.132 mycroft }
838 1.181 bouyer wd->sc_flags |= WDF_LOCKED;
839 1.163 bouyer splx(s);
840 1.132 mycroft return 0;
841 1.132 mycroft }
842 1.132 mycroft
843 1.135 mycroft /*
844 1.135 mycroft * Unlock and wake up any waiters.
845 1.135 mycroft */
846 1.132 mycroft void
847 1.181 bouyer wdunlock(wd)
848 1.181 bouyer struct wd_softc *wd;
849 1.132 mycroft {
850 1.132 mycroft
851 1.181 bouyer WDCDEBUG_PRINT(("wdunlock\n"), DEBUG_FUNCS);
852 1.163 bouyer
853 1.181 bouyer wd->sc_flags &= ~WDF_LOCKED;
854 1.181 bouyer if ((wd->sc_flags & WDF_WANTED) != 0) {
855 1.181 bouyer wd->sc_flags &= ~WDF_WANTED;
856 1.181 bouyer wakeup(wd);
857 1.132 mycroft }
858 1.132 mycroft }
859 1.132 mycroft
860 1.1 cgd int
861 1.149 christos wdopen(dev, flag, fmt, p)
862 1.55 mycroft dev_t dev;
863 1.93 mycroft int flag, fmt;
864 1.149 christos struct proc *p;
865 1.1 cgd {
866 1.135 mycroft struct wd_softc *wd;
867 1.208 thorpej int part, error;
868 1.163 bouyer
869 1.181 bouyer WDCDEBUG_PRINT(("wdopen\n"), DEBUG_FUNCS);
870 1.208 thorpej wd = device_lookup(&wd_cd, WDUNIT(dev));
871 1.158 pk if (wd == NULL)
872 1.208 thorpej return (ENXIO);
873 1.187 thorpej
874 1.187 thorpej /*
875 1.187 thorpej * If this is the first open of this device, add a reference
876 1.187 thorpej * to the adapter.
877 1.187 thorpej */
878 1.187 thorpej if (wd->sc_dk.dk_openmask == 0 &&
879 1.217 bouyer (error = wd->atabus->ata_addref(wd->drvp)) != 0)
880 1.187 thorpej return (error);
881 1.187 thorpej
882 1.181 bouyer if ((error = wdlock(wd)) != 0)
883 1.187 thorpej goto bad4;
884 1.3 deraadt
885 1.109 mycroft if (wd->sc_dk.dk_openmask != 0) {
886 1.109 mycroft /*
887 1.109 mycroft * If any partition is open, but the disk has been invalidated,
888 1.109 mycroft * disallow further opens.
889 1.109 mycroft */
890 1.181 bouyer if ((wd->sc_flags & WDF_LOADED) == 0) {
891 1.136 mycroft error = EIO;
892 1.136 mycroft goto bad3;
893 1.136 mycroft }
894 1.109 mycroft } else {
895 1.181 bouyer if ((wd->sc_flags & WDF_LOADED) == 0) {
896 1.181 bouyer wd->sc_flags |= WDF_LOADED;
897 1.108 mycroft
898 1.108 mycroft /* Load the physical device parameters. */
899 1.183 bouyer wd_get_params(wd, AT_WAIT, &wd->sc_params);
900 1.108 mycroft
901 1.108 mycroft /* Load the partition info if not already loaded. */
902 1.108 mycroft wdgetdisklabel(wd);
903 1.108 mycroft }
904 1.135 mycroft }
905 1.108 mycroft
906 1.135 mycroft part = WDPART(dev);
907 1.108 mycroft
908 1.109 mycroft /* Check that the partition exists. */
909 1.93 mycroft if (part != RAW_PART &&
910 1.144 thorpej (part >= wd->sc_dk.dk_label->d_npartitions ||
911 1.144 thorpej wd->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) {
912 1.93 mycroft error = ENXIO;
913 1.93 mycroft goto bad;
914 1.93 mycroft }
915 1.181 bouyer
916 1.64 mycroft /* Insure only one open at a time. */
917 1.3 deraadt switch (fmt) {
918 1.3 deraadt case S_IFCHR:
919 1.94 mycroft wd->sc_dk.dk_copenmask |= (1 << part);
920 1.3 deraadt break;
921 1.3 deraadt case S_IFBLK:
922 1.94 mycroft wd->sc_dk.dk_bopenmask |= (1 << part);
923 1.3 deraadt break;
924 1.3 deraadt }
925 1.181 bouyer wd->sc_dk.dk_openmask =
926 1.181 bouyer wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
927 1.60 mycroft
928 1.181 bouyer wdunlock(wd);
929 1.37 mycroft return 0;
930 1.93 mycroft
931 1.93 mycroft bad:
932 1.118 mycroft if (wd->sc_dk.dk_openmask == 0) {
933 1.108 mycroft }
934 1.108 mycroft
935 1.136 mycroft bad3:
936 1.181 bouyer wdunlock(wd);
937 1.187 thorpej bad4:
938 1.187 thorpej if (wd->sc_dk.dk_openmask == 0)
939 1.217 bouyer wd->atabus->ata_delref(wd->drvp);
940 1.93 mycroft return error;
941 1.1 cgd }
942 1.1 cgd
943 1.135 mycroft int
944 1.149 christos wdclose(dev, flag, fmt, p)
945 1.135 mycroft dev_t dev;
946 1.135 mycroft int flag, fmt;
947 1.149 christos struct proc *p;
948 1.135 mycroft {
949 1.209 thorpej struct wd_softc *wd = device_lookup(&wd_cd, WDUNIT(dev));
950 1.135 mycroft int part = WDPART(dev);
951 1.135 mycroft int error;
952 1.181 bouyer
953 1.181 bouyer WDCDEBUG_PRINT(("wdclose\n"), DEBUG_FUNCS);
954 1.181 bouyer if ((error = wdlock(wd)) != 0)
955 1.135 mycroft return error;
956 1.135 mycroft
957 1.135 mycroft switch (fmt) {
958 1.135 mycroft case S_IFCHR:
959 1.135 mycroft wd->sc_dk.dk_copenmask &= ~(1 << part);
960 1.135 mycroft break;
961 1.135 mycroft case S_IFBLK:
962 1.135 mycroft wd->sc_dk.dk_bopenmask &= ~(1 << part);
963 1.135 mycroft break;
964 1.135 mycroft }
965 1.181 bouyer wd->sc_dk.dk_openmask =
966 1.181 bouyer wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
967 1.135 mycroft
968 1.135 mycroft if (wd->sc_dk.dk_openmask == 0) {
969 1.194 bouyer wd_flushcache(wd, AT_WAIT);
970 1.135 mycroft /* XXXX Must wait for I/O to complete! */
971 1.187 thorpej
972 1.199 leo if (! (wd->sc_flags & WDF_KLABEL))
973 1.199 leo wd->sc_flags &= ~WDF_LOADED;
974 1.199 leo
975 1.217 bouyer wd->atabus->ata_delref(wd->drvp);
976 1.135 mycroft }
977 1.135 mycroft
978 1.181 bouyer wdunlock(wd);
979 1.135 mycroft return 0;
980 1.135 mycroft }
981 1.135 mycroft
982 1.108 mycroft void
983 1.164 thorpej wdgetdefaultlabel(wd, lp)
984 1.108 mycroft struct wd_softc *wd;
985 1.164 thorpej struct disklabel *lp;
986 1.108 mycroft {
987 1.163 bouyer
988 1.181 bouyer WDCDEBUG_PRINT(("wdgetdefaultlabel\n"), DEBUG_FUNCS);
989 1.181 bouyer memset(lp, 0, sizeof(struct disklabel));
990 1.108 mycroft
991 1.142 mycroft lp->d_secsize = DEV_BSIZE;
992 1.181 bouyer lp->d_ntracks = wd->sc_params.atap_heads;
993 1.181 bouyer lp->d_nsectors = wd->sc_params.atap_sectors;
994 1.181 bouyer lp->d_ncylinders = wd->sc_params.atap_cylinders;
995 1.142 mycroft lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
996 1.108 mycroft
997 1.198 leo if (strcmp(wd->sc_params.atap_model, "ST506") == 0)
998 1.181 bouyer lp->d_type = DTYPE_ST506;
999 1.198 leo else
1000 1.181 bouyer lp->d_type = DTYPE_ESDI;
1001 1.198 leo
1002 1.181 bouyer strncpy(lp->d_typename, wd->sc_params.atap_model, 16);
1003 1.180 drochner strncpy(lp->d_packname, "fictitious", 16);
1004 1.240 fvdl if (wd->sc_capacity > UINT32_MAX)
1005 1.240 fvdl lp->d_secperunit = UINT32_MAX;
1006 1.240 fvdl else
1007 1.240 fvdl lp->d_secperunit = wd->sc_capacity;
1008 1.142 mycroft lp->d_rpm = 3600;
1009 1.142 mycroft lp->d_interleave = 1;
1010 1.142 mycroft lp->d_flags = 0;
1011 1.142 mycroft
1012 1.142 mycroft lp->d_partitions[RAW_PART].p_offset = 0;
1013 1.142 mycroft lp->d_partitions[RAW_PART].p_size =
1014 1.181 bouyer lp->d_secperunit * (lp->d_secsize / DEV_BSIZE);
1015 1.142 mycroft lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED;
1016 1.142 mycroft lp->d_npartitions = RAW_PART + 1;
1017 1.142 mycroft
1018 1.142 mycroft lp->d_magic = DISKMAGIC;
1019 1.142 mycroft lp->d_magic2 = DISKMAGIC;
1020 1.142 mycroft lp->d_checksum = dkcksum(lp);
1021 1.164 thorpej }
1022 1.164 thorpej
1023 1.164 thorpej /*
1024 1.164 thorpej * Fabricate a default disk label, and try to read the correct one.
1025 1.164 thorpej */
1026 1.164 thorpej void
1027 1.164 thorpej wdgetdisklabel(wd)
1028 1.164 thorpej struct wd_softc *wd;
1029 1.164 thorpej {
1030 1.164 thorpej struct disklabel *lp = wd->sc_dk.dk_label;
1031 1.164 thorpej char *errstring;
1032 1.164 thorpej
1033 1.181 bouyer WDCDEBUG_PRINT(("wdgetdisklabel\n"), DEBUG_FUNCS);
1034 1.164 thorpej
1035 1.181 bouyer memset(wd->sc_dk.dk_cpulabel, 0, sizeof(struct cpu_disklabel));
1036 1.164 thorpej
1037 1.164 thorpej wdgetdefaultlabel(wd, lp);
1038 1.108 mycroft
1039 1.181 bouyer wd->sc_badsect[0] = -1;
1040 1.113 mycroft
1041 1.181 bouyer if (wd->drvp->state > RECAL)
1042 1.183 bouyer wd->drvp->drive_flags |= DRIVE_RESET;
1043 1.108 mycroft errstring = readdisklabel(MAKEWDDEV(0, wd->sc_dev.dv_unit, RAW_PART),
1044 1.144 thorpej wdstrategy, lp, wd->sc_dk.dk_cpulabel);
1045 1.108 mycroft if (errstring) {
1046 1.108 mycroft /*
1047 1.108 mycroft * This probably happened because the drive's default
1048 1.108 mycroft * geometry doesn't match the DOS geometry. We
1049 1.108 mycroft * assume the DOS geometry is now in the label and try
1050 1.108 mycroft * again. XXX This is a kluge.
1051 1.108 mycroft */
1052 1.181 bouyer if (wd->drvp->state > RECAL)
1053 1.183 bouyer wd->drvp->drive_flags |= DRIVE_RESET;
1054 1.181 bouyer errstring = readdisklabel(MAKEWDDEV(0, wd->sc_dev.dv_unit,
1055 1.181 bouyer RAW_PART), wdstrategy, lp, wd->sc_dk.dk_cpulabel);
1056 1.108 mycroft }
1057 1.108 mycroft if (errstring) {
1058 1.153 christos printf("%s: %s\n", wd->sc_dev.dv_xname, errstring);
1059 1.108 mycroft return;
1060 1.108 mycroft }
1061 1.108 mycroft
1062 1.181 bouyer if (wd->drvp->state > RECAL)
1063 1.183 bouyer wd->drvp->drive_flags |= DRIVE_RESET;
1064 1.170 leo #ifdef HAS_BAD144_HANDLING
1065 1.142 mycroft if ((lp->d_flags & D_BADSECT) != 0)
1066 1.108 mycroft bad144intern(wd);
1067 1.170 leo #endif
1068 1.108 mycroft }
1069 1.108 mycroft
1070 1.217 bouyer void
1071 1.221 yamt wdperror(wd)
1072 1.221 yamt const struct wd_softc *wd;
1073 1.217 bouyer {
1074 1.221 yamt static const char *const errstr0_3[] = {"address mark not found",
1075 1.217 bouyer "track 0 not found", "aborted command", "media change requested",
1076 1.217 bouyer "id not found", "media changed", "uncorrectable data error",
1077 1.217 bouyer "bad block detected"};
1078 1.221 yamt static const char *const errstr4_5[] = {
1079 1.221 yamt "obsolete (address mark not found)",
1080 1.217 bouyer "no media/write protected", "aborted command",
1081 1.217 bouyer "media change requested", "id not found", "media changed",
1082 1.217 bouyer "uncorrectable data error", "interface CRC error"};
1083 1.221 yamt const char *const *errstr;
1084 1.217 bouyer int i;
1085 1.217 bouyer char *sep = "";
1086 1.217 bouyer
1087 1.221 yamt const char *devname = wd->sc_dev.dv_xname;
1088 1.221 yamt struct ata_drive_datas *drvp = wd->drvp;
1089 1.221 yamt int errno = wd->sc_wdc_bio.r_error;
1090 1.221 yamt
1091 1.217 bouyer if (drvp->ata_vers >= 4)
1092 1.217 bouyer errstr = errstr4_5;
1093 1.217 bouyer else
1094 1.217 bouyer errstr = errstr0_3;
1095 1.217 bouyer
1096 1.221 yamt printf("%s: (", devname);
1097 1.221 yamt
1098 1.217 bouyer if (errno == 0)
1099 1.221 yamt printf("error not notified");
1100 1.217 bouyer
1101 1.217 bouyer for (i = 0; i < 8; i++) {
1102 1.217 bouyer if (errno & (1 << i)) {
1103 1.221 yamt printf("%s%s", sep, errstr[i]);
1104 1.217 bouyer sep = ", ";
1105 1.217 bouyer }
1106 1.217 bouyer }
1107 1.221 yamt printf(")\n");
1108 1.217 bouyer }
1109 1.217 bouyer
1110 1.1 cgd int
1111 1.163 bouyer wdioctl(dev, xfer, addr, flag, p)
1112 1.55 mycroft dev_t dev;
1113 1.163 bouyer u_long xfer;
1114 1.55 mycroft caddr_t addr;
1115 1.55 mycroft int flag;
1116 1.55 mycroft struct proc *p;
1117 1.1 cgd {
1118 1.209 thorpej struct wd_softc *wd = device_lookup(&wd_cd, WDUNIT(dev));
1119 1.233 fvdl int error = 0;
1120 1.211 fvdl #ifdef __HAVE_OLD_DISKLABEL
1121 1.233 fvdl struct disklabel *newlabel = NULL;
1122 1.211 fvdl #endif
1123 1.163 bouyer
1124 1.181 bouyer WDCDEBUG_PRINT(("wdioctl\n"), DEBUG_FUNCS);
1125 1.163 bouyer
1126 1.181 bouyer if ((wd->sc_flags & WDF_LOADED) == 0)
1127 1.108 mycroft return EIO;
1128 1.108 mycroft
1129 1.163 bouyer switch (xfer) {
1130 1.170 leo #ifdef HAS_BAD144_HANDLING
1131 1.1 cgd case DIOCSBAD:
1132 1.3 deraadt if ((flag & FWRITE) == 0)
1133 1.54 mycroft return EBADF;
1134 1.144 thorpej wd->sc_dk.dk_cpulabel->bad = *(struct dkbad *)addr;
1135 1.144 thorpej wd->sc_dk.dk_label->d_flags |= D_BADSECT;
1136 1.64 mycroft bad144intern(wd);
1137 1.54 mycroft return 0;
1138 1.170 leo #endif
1139 1.1 cgd
1140 1.1 cgd case DIOCGDINFO:
1141 1.144 thorpej *(struct disklabel *)addr = *(wd->sc_dk.dk_label);
1142 1.54 mycroft return 0;
1143 1.211 fvdl #ifdef __HAVE_OLD_DISKLABEL
1144 1.211 fvdl case ODIOCGDINFO:
1145 1.233 fvdl newlabel = malloc(sizeof *newlabel, M_TEMP, M_WAITOK);
1146 1.233 fvdl if (newlabel == NULL)
1147 1.233 fvdl return EIO;
1148 1.234 fvdl *newlabel = *(wd->sc_dk.dk_label);
1149 1.233 fvdl if (newlabel->d_npartitions <= OLDMAXPARTITIONS)
1150 1.234 fvdl memcpy(addr, newlabel, sizeof (struct olddisklabel));
1151 1.233 fvdl else
1152 1.233 fvdl error = ENOTTY;
1153 1.233 fvdl free(newlabel, M_TEMP);
1154 1.233 fvdl return error;
1155 1.211 fvdl #endif
1156 1.211 fvdl
1157 1.3 deraadt case DIOCGPART:
1158 1.144 thorpej ((struct partinfo *)addr)->disklab = wd->sc_dk.dk_label;
1159 1.3 deraadt ((struct partinfo *)addr)->part =
1160 1.144 thorpej &wd->sc_dk.dk_label->d_partitions[WDPART(dev)];
1161 1.54 mycroft return 0;
1162 1.3 deraadt
1163 1.132 mycroft case DIOCWDINFO:
1164 1.3 deraadt case DIOCSDINFO:
1165 1.211 fvdl #ifdef __HAVE_OLD_DISKLABEL
1166 1.211 fvdl case ODIOCWDINFO:
1167 1.211 fvdl case ODIOCSDINFO:
1168 1.211 fvdl #endif
1169 1.211 fvdl {
1170 1.211 fvdl struct disklabel *lp;
1171 1.211 fvdl
1172 1.233 fvdl if ((flag & FWRITE) == 0)
1173 1.233 fvdl return EBADF;
1174 1.233 fvdl
1175 1.211 fvdl #ifdef __HAVE_OLD_DISKLABEL
1176 1.211 fvdl if (xfer == ODIOCSDINFO || xfer == ODIOCWDINFO) {
1177 1.233 fvdl newlabel = malloc(sizeof *newlabel, M_TEMP, M_WAITOK);
1178 1.233 fvdl if (newlabel == NULL)
1179 1.233 fvdl return EIO;
1180 1.233 fvdl memset(newlabel, 0, sizeof newlabel);
1181 1.233 fvdl memcpy(newlabel, addr, sizeof (struct olddisklabel));
1182 1.233 fvdl lp = newlabel;
1183 1.211 fvdl } else
1184 1.211 fvdl #endif
1185 1.211 fvdl lp = (struct disklabel *)addr;
1186 1.211 fvdl
1187 1.181 bouyer if ((error = wdlock(wd)) != 0)
1188 1.233 fvdl goto bad;
1189 1.181 bouyer wd->sc_flags |= WDF_LABELLING;
1190 1.132 mycroft
1191 1.144 thorpej error = setdisklabel(wd->sc_dk.dk_label,
1192 1.211 fvdl lp, /*wd->sc_dk.dk_openmask : */0,
1193 1.144 thorpej wd->sc_dk.dk_cpulabel);
1194 1.3 deraadt if (error == 0) {
1195 1.181 bouyer if (wd->drvp->state > RECAL)
1196 1.183 bouyer wd->drvp->drive_flags |= DRIVE_RESET;
1197 1.211 fvdl if (xfer == DIOCWDINFO
1198 1.211 fvdl #ifdef __HAVE_OLD_DISKLABEL
1199 1.211 fvdl || xfer == ODIOCWDINFO
1200 1.211 fvdl #endif
1201 1.211 fvdl )
1202 1.132 mycroft error = writedisklabel(WDLABELDEV(dev),
1203 1.144 thorpej wdstrategy, wd->sc_dk.dk_label,
1204 1.144 thorpej wd->sc_dk.dk_cpulabel);
1205 1.1 cgd }
1206 1.132 mycroft
1207 1.181 bouyer wd->sc_flags &= ~WDF_LABELLING;
1208 1.181 bouyer wdunlock(wd);
1209 1.233 fvdl bad:
1210 1.233 fvdl #ifdef __HAVE_OLD_DISKLABEL
1211 1.233 fvdl if (newlabel != NULL)
1212 1.233 fvdl free(newlabel, M_TEMP);
1213 1.233 fvdl #endif
1214 1.54 mycroft return error;
1215 1.211 fvdl }
1216 1.199 leo
1217 1.199 leo case DIOCKLABEL:
1218 1.199 leo if (*(int *)addr)
1219 1.199 leo wd->sc_flags |= WDF_KLABEL;
1220 1.199 leo else
1221 1.199 leo wd->sc_flags &= ~WDF_KLABEL;
1222 1.199 leo return 0;
1223 1.3 deraadt
1224 1.44 mycroft case DIOCWLABEL:
1225 1.3 deraadt if ((flag & FWRITE) == 0)
1226 1.54 mycroft return EBADF;
1227 1.93 mycroft if (*(int *)addr)
1228 1.181 bouyer wd->sc_flags |= WDF_WLABEL;
1229 1.93 mycroft else
1230 1.181 bouyer wd->sc_flags &= ~WDF_WLABEL;
1231 1.54 mycroft return 0;
1232 1.164 thorpej
1233 1.164 thorpej case DIOCGDEFLABEL:
1234 1.164 thorpej wdgetdefaultlabel(wd, (struct disklabel *)addr);
1235 1.164 thorpej return 0;
1236 1.211 fvdl #ifdef __HAVE_OLD_DISKLABEL
1237 1.211 fvdl case ODIOCGDEFLABEL:
1238 1.233 fvdl newlabel = malloc(sizeof *newlabel, M_TEMP, M_WAITOK);
1239 1.233 fvdl if (newlabel == NULL)
1240 1.233 fvdl return EIO;
1241 1.233 fvdl wdgetdefaultlabel(wd, newlabel);
1242 1.233 fvdl if (newlabel->d_npartitions <= OLDMAXPARTITIONS)
1243 1.233 fvdl memcpy(addr, &newlabel, sizeof (struct olddisklabel));
1244 1.233 fvdl else
1245 1.233 fvdl error = ENOTTY;
1246 1.233 fvdl free(newlabel, M_TEMP);
1247 1.233 fvdl return error;
1248 1.211 fvdl #endif
1249 1.164 thorpej
1250 1.1 cgd #ifdef notyet
1251 1.1 cgd case DIOCWFORMAT:
1252 1.1 cgd if ((flag & FWRITE) == 0)
1253 1.54 mycroft return EBADF;
1254 1.181 bouyer {
1255 1.54 mycroft register struct format_op *fop;
1256 1.54 mycroft struct iovec aiov;
1257 1.54 mycroft struct uio auio;
1258 1.181 bouyer
1259 1.54 mycroft fop = (struct format_op *)addr;
1260 1.54 mycroft aiov.iov_base = fop->df_buf;
1261 1.54 mycroft aiov.iov_len = fop->df_count;
1262 1.54 mycroft auio.uio_iov = &aiov;
1263 1.54 mycroft auio.uio_iovcnt = 1;
1264 1.54 mycroft auio.uio_resid = fop->df_count;
1265 1.54 mycroft auio.uio_segflg = 0;
1266 1.54 mycroft auio.uio_offset =
1267 1.181 bouyer fop->df_startblk * wd->sc_dk.dk_label->d_secsize;
1268 1.83 pk auio.uio_procp = p;
1269 1.64 mycroft error = physio(wdformat, NULL, dev, B_WRITE, minphys,
1270 1.64 mycroft &auio);
1271 1.54 mycroft fop->df_count -= auio.uio_resid;
1272 1.64 mycroft fop->df_reg[0] = wdc->sc_status;
1273 1.64 mycroft fop->df_reg[1] = wdc->sc_error;
1274 1.54 mycroft return error;
1275 1.181 bouyer }
1276 1.1 cgd #endif
1277 1.185 kenh
1278 1.186 kenh case ATAIOCCOMMAND:
1279 1.185 kenh /*
1280 1.185 kenh * Make sure this command is (relatively) safe first
1281 1.185 kenh */
1282 1.186 kenh if ((((atareq_t *) addr)->flags & ATACMD_READ) == 0 &&
1283 1.185 kenh (flag & FWRITE) == 0)
1284 1.185 kenh return (EBADF);
1285 1.185 kenh {
1286 1.185 kenh struct wd_ioctl *wi;
1287 1.186 kenh atareq_t *atareq = (atareq_t *) addr;
1288 1.185 kenh int error;
1289 1.185 kenh
1290 1.185 kenh wi = wi_get();
1291 1.185 kenh wi->wi_softc = wd;
1292 1.186 kenh wi->wi_atareq = *atareq;
1293 1.185 kenh
1294 1.186 kenh if (atareq->datalen && atareq->flags &
1295 1.186 kenh (ATACMD_READ | ATACMD_WRITE)) {
1296 1.186 kenh wi->wi_iov.iov_base = atareq->databuf;
1297 1.186 kenh wi->wi_iov.iov_len = atareq->datalen;
1298 1.185 kenh wi->wi_uio.uio_iov = &wi->wi_iov;
1299 1.185 kenh wi->wi_uio.uio_iovcnt = 1;
1300 1.186 kenh wi->wi_uio.uio_resid = atareq->datalen;
1301 1.185 kenh wi->wi_uio.uio_offset = 0;
1302 1.185 kenh wi->wi_uio.uio_segflg = UIO_USERSPACE;
1303 1.185 kenh wi->wi_uio.uio_rw =
1304 1.186 kenh (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE;
1305 1.185 kenh wi->wi_uio.uio_procp = p;
1306 1.185 kenh error = physio(wdioctlstrategy, &wi->wi_bp, dev,
1307 1.186 kenh (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE,
1308 1.185 kenh minphys, &wi->wi_uio);
1309 1.185 kenh } else {
1310 1.185 kenh /* No need to call physio if we don't have any
1311 1.185 kenh user data */
1312 1.185 kenh wi->wi_bp.b_flags = 0;
1313 1.185 kenh wi->wi_bp.b_data = 0;
1314 1.185 kenh wi->wi_bp.b_bcount = 0;
1315 1.185 kenh wi->wi_bp.b_dev = 0;
1316 1.185 kenh wi->wi_bp.b_proc = p;
1317 1.185 kenh wdioctlstrategy(&wi->wi_bp);
1318 1.185 kenh error = wi->wi_bp.b_error;
1319 1.185 kenh }
1320 1.186 kenh *atareq = wi->wi_atareq;
1321 1.185 kenh wi_free(wi);
1322 1.185 kenh return(error);
1323 1.185 kenh }
1324 1.185 kenh
1325 1.1 cgd default:
1326 1.54 mycroft return ENOTTY;
1327 1.1 cgd }
1328 1.54 mycroft
1329 1.54 mycroft #ifdef DIAGNOSTIC
1330 1.54 mycroft panic("wdioctl: impossible");
1331 1.54 mycroft #endif
1332 1.1 cgd }
1333 1.1 cgd
1334 1.44 mycroft #ifdef B_FORMAT
1335 1.1 cgd int
1336 1.1 cgd wdformat(struct buf *bp)
1337 1.1 cgd {
1338 1.44 mycroft
1339 1.1 cgd bp->b_flags |= B_FORMAT;
1340 1.37 mycroft return wdstrategy(bp);
1341 1.1 cgd }
1342 1.1 cgd #endif
1343 1.1 cgd
1344 1.1 cgd int
1345 1.55 mycroft wdsize(dev)
1346 1.55 mycroft dev_t dev;
1347 1.1 cgd {
1348 1.64 mycroft struct wd_softc *wd;
1349 1.208 thorpej int part, omask;
1350 1.108 mycroft int size;
1351 1.163 bouyer
1352 1.181 bouyer WDCDEBUG_PRINT(("wdsize\n"), DEBUG_FUNCS);
1353 1.163 bouyer
1354 1.208 thorpej wd = device_lookup(&wd_cd, WDUNIT(dev));
1355 1.158 pk if (wd == NULL)
1356 1.158 pk return (-1);
1357 1.158 pk
1358 1.158 pk part = WDPART(dev);
1359 1.158 pk omask = wd->sc_dk.dk_openmask & (1 << part);
1360 1.158 pk
1361 1.158 pk if (omask == 0 && wdopen(dev, 0, S_IFBLK, NULL) != 0)
1362 1.158 pk return (-1);
1363 1.144 thorpej if (wd->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP)
1364 1.108 mycroft size = -1;
1365 1.108 mycroft else
1366 1.160 thorpej size = wd->sc_dk.dk_label->d_partitions[part].p_size *
1367 1.181 bouyer (wd->sc_dk.dk_label->d_secsize / DEV_BSIZE);
1368 1.158 pk if (omask == 0 && wdclose(dev, 0, S_IFBLK, NULL) != 0)
1369 1.158 pk return (-1);
1370 1.158 pk return (size);
1371 1.1 cgd }
1372 1.1 cgd
1373 1.140 cgd /* #define WD_DUMP_NOT_TRUSTED if you just want to watch */
1374 1.181 bouyer static int wddoingadump = 0;
1375 1.181 bouyer static int wddumprecalibrated = 0;
1376 1.181 bouyer static int wddumpmulti = 1;
1377 1.140 cgd
1378 1.64 mycroft /*
1379 1.64 mycroft * Dump core after a system crash.
1380 1.64 mycroft */
1381 1.1 cgd int
1382 1.140 cgd wddump(dev, blkno, va, size)
1383 1.181 bouyer dev_t dev;
1384 1.181 bouyer daddr_t blkno;
1385 1.181 bouyer caddr_t va;
1386 1.181 bouyer size_t size;
1387 1.140 cgd {
1388 1.140 cgd struct wd_softc *wd; /* disk unit to do the I/O */
1389 1.181 bouyer struct disklabel *lp; /* disk's disklabel */
1390 1.208 thorpej int part, err;
1391 1.181 bouyer int nblks; /* total number of sectors left to write */
1392 1.140 cgd
1393 1.140 cgd /* Check if recursive dump; if so, punt. */
1394 1.116 mycroft if (wddoingadump)
1395 1.116 mycroft return EFAULT;
1396 1.142 mycroft wddoingadump = 1;
1397 1.140 cgd
1398 1.208 thorpej wd = device_lookup(&wd_cd, WDUNIT(dev));
1399 1.208 thorpej if (wd == NULL)
1400 1.208 thorpej return (ENXIO);
1401 1.60 mycroft
1402 1.140 cgd part = WDPART(dev);
1403 1.140 cgd
1404 1.181 bouyer /* Convert to disk sectors. Request must be a multiple of size. */
1405 1.144 thorpej lp = wd->sc_dk.dk_label;
1406 1.142 mycroft if ((size % lp->d_secsize) != 0)
1407 1.140 cgd return EFAULT;
1408 1.142 mycroft nblks = size / lp->d_secsize;
1409 1.142 mycroft blkno = blkno / (lp->d_secsize / DEV_BSIZE);
1410 1.116 mycroft
1411 1.64 mycroft /* Check transfer bounds against partition size. */
1412 1.142 mycroft if ((blkno < 0) || ((blkno + nblks) > lp->d_partitions[part].p_size))
1413 1.140 cgd return EINVAL;
1414 1.140 cgd
1415 1.140 cgd /* Offset block number to start of partition. */
1416 1.142 mycroft blkno += lp->d_partitions[part].p_offset;
1417 1.60 mycroft
1418 1.140 cgd /* Recalibrate, if first dump transfer. */
1419 1.140 cgd if (wddumprecalibrated == 0) {
1420 1.181 bouyer wddumpmulti = wd->sc_multi;
1421 1.140 cgd wddumprecalibrated = 1;
1422 1.205 bouyer wd->drvp->state = RESET;
1423 1.63 mycroft }
1424 1.181 bouyer
1425 1.142 mycroft while (nblks > 0) {
1426 1.181 bouyer again:
1427 1.214 bjh21 wd->sc_bp = NULL;
1428 1.181 bouyer wd->sc_wdc_bio.blkno = blkno;
1429 1.181 bouyer wd->sc_wdc_bio.flags = ATA_POLL;
1430 1.181 bouyer if (wddumpmulti == 1)
1431 1.181 bouyer wd->sc_wdc_bio.flags |= ATA_SINGLE;
1432 1.220 christos if (wd->sc_flags & WDF_LBA48)
1433 1.220 christos wd->sc_wdc_bio.flags |= ATA_LBA48;
1434 1.181 bouyer if (wd->sc_flags & WDF_LBA)
1435 1.181 bouyer wd->sc_wdc_bio.flags |= ATA_LBA;
1436 1.181 bouyer wd->sc_wdc_bio.bcount =
1437 1.181 bouyer min(nblks, wddumpmulti) * lp->d_secsize;
1438 1.181 bouyer wd->sc_wdc_bio.databuf = va;
1439 1.181 bouyer #ifndef WD_DUMP_NOT_TRUSTED
1440 1.217 bouyer switch (wd->atabus->ata_bio(wd->drvp, &wd->sc_wdc_bio)) {
1441 1.181 bouyer case WDC_TRY_AGAIN:
1442 1.181 bouyer panic("wddump: try again");
1443 1.181 bouyer break;
1444 1.181 bouyer case WDC_QUEUED:
1445 1.181 bouyer panic("wddump: polled command has been queued");
1446 1.181 bouyer break;
1447 1.181 bouyer case WDC_COMPLETE:
1448 1.181 bouyer break;
1449 1.116 mycroft }
1450 1.181 bouyer switch(wd->sc_wdc_bio.error) {
1451 1.181 bouyer case TIMEOUT:
1452 1.181 bouyer printf("wddump: device timed out");
1453 1.181 bouyer err = EIO;
1454 1.181 bouyer break;
1455 1.181 bouyer case ERR_DF:
1456 1.181 bouyer printf("wddump: drive fault");
1457 1.181 bouyer err = EIO;
1458 1.181 bouyer break;
1459 1.181 bouyer case ERR_DMA:
1460 1.181 bouyer printf("wddump: DMA error");
1461 1.181 bouyer err = EIO;
1462 1.181 bouyer break;
1463 1.181 bouyer case ERROR:
1464 1.221 yamt printf("wddump: ");
1465 1.222 yamt wdperror(wd);
1466 1.181 bouyer err = EIO;
1467 1.181 bouyer break;
1468 1.181 bouyer case NOERROR:
1469 1.181 bouyer err = 0;
1470 1.181 bouyer break;
1471 1.181 bouyer default:
1472 1.181 bouyer panic("wddump: unknown error type");
1473 1.3 deraadt }
1474 1.181 bouyer if (err != 0) {
1475 1.181 bouyer if (wddumpmulti != 1) {
1476 1.181 bouyer wddumpmulti = 1; /* retry in single-sector */
1477 1.181 bouyer printf(", retrying\n");
1478 1.181 bouyer goto again;
1479 1.181 bouyer }
1480 1.181 bouyer printf("\n");
1481 1.181 bouyer return err;
1482 1.63 mycroft }
1483 1.140 cgd #else /* WD_DUMP_NOT_TRUSTED */
1484 1.140 cgd /* Let's just talk about this first... */
1485 1.153 christos printf("wd%d: dump addr 0x%x, cylin %d, head %d, sector %d\n",
1486 1.140 cgd unit, va, cylin, head, sector);
1487 1.140 cgd delay(500 * 1000); /* half a second */
1488 1.140 cgd #endif
1489 1.1 cgd
1490 1.140 cgd /* update block count */
1491 1.181 bouyer nblks -= min(nblks, wddumpmulti);
1492 1.181 bouyer blkno += min(nblks, wddumpmulti);
1493 1.181 bouyer va += min(nblks, wddumpmulti) * lp->d_secsize;
1494 1.1 cgd }
1495 1.142 mycroft
1496 1.140 cgd wddoingadump = 0;
1497 1.140 cgd return 0;
1498 1.140 cgd }
1499 1.3 deraadt
1500 1.170 leo #ifdef HAS_BAD144_HANDLING
1501 1.3 deraadt /*
1502 1.3 deraadt * Internalize the bad sector table.
1503 1.3 deraadt */
1504 1.3 deraadt void
1505 1.64 mycroft bad144intern(wd)
1506 1.64 mycroft struct wd_softc *wd;
1507 1.3 deraadt {
1508 1.144 thorpej struct dkbad *bt = &wd->sc_dk.dk_cpulabel->bad;
1509 1.144 thorpej struct disklabel *lp = wd->sc_dk.dk_label;
1510 1.98 mycroft int i = 0;
1511 1.55 mycroft
1512 1.182 bouyer WDCDEBUG_PRINT(("bad144intern\n"), DEBUG_XFERS);
1513 1.163 bouyer
1514 1.170 leo for (; i < NBT_BAD; i++) {
1515 1.98 mycroft if (bt->bt_bad[i].bt_cyl == 0xffff)
1516 1.55 mycroft break;
1517 1.181 bouyer wd->sc_badsect[i] =
1518 1.98 mycroft bt->bt_bad[i].bt_cyl * lp->d_secpercyl +
1519 1.98 mycroft (bt->bt_bad[i].bt_trksec >> 8) * lp->d_nsectors +
1520 1.98 mycroft (bt->bt_bad[i].bt_trksec & 0xff);
1521 1.3 deraadt }
1522 1.170 leo for (; i < NBT_BAD+1; i++)
1523 1.181 bouyer wd->sc_badsect[i] = -1;
1524 1.64 mycroft }
1525 1.170 leo #endif
1526 1.64 mycroft
1527 1.181 bouyer int
1528 1.181 bouyer wd_get_params(wd, flags, params)
1529 1.181 bouyer struct wd_softc *wd;
1530 1.181 bouyer u_int8_t flags;
1531 1.181 bouyer struct ataparams *params;
1532 1.63 mycroft {
1533 1.217 bouyer switch (wd->atabus->ata_get_params(wd->drvp, flags, params)) {
1534 1.181 bouyer case CMD_AGAIN:
1535 1.181 bouyer return 1;
1536 1.181 bouyer case CMD_ERR:
1537 1.181 bouyer /*
1538 1.181 bouyer * We `know' there's a drive here; just assume it's old.
1539 1.181 bouyer * This geometry is only used to read the MBR and print a
1540 1.181 bouyer * (false) attach message.
1541 1.181 bouyer */
1542 1.181 bouyer strncpy(params->atap_model, "ST506",
1543 1.181 bouyer sizeof params->atap_model);
1544 1.181 bouyer params->atap_config = ATA_CFG_FIXED;
1545 1.181 bouyer params->atap_cylinders = 1024;
1546 1.181 bouyer params->atap_heads = 8;
1547 1.181 bouyer params->atap_sectors = 17;
1548 1.181 bouyer params->atap_multi = 1;
1549 1.181 bouyer params->atap_capabilities1 = params->atap_capabilities2 = 0;
1550 1.190 bouyer wd->drvp->ata_vers = -1; /* Mark it as pre-ATA */
1551 1.181 bouyer return 0;
1552 1.181 bouyer case CMD_OK:
1553 1.181 bouyer return 0;
1554 1.181 bouyer default:
1555 1.181 bouyer panic("wd_get_params: bad return code from ata_get_params");
1556 1.181 bouyer /* NOTREACHED */
1557 1.181 bouyer }
1558 1.190 bouyer }
1559 1.190 bouyer
1560 1.190 bouyer void
1561 1.190 bouyer wd_flushcache(wd, flags)
1562 1.190 bouyer struct wd_softc *wd;
1563 1.190 bouyer int flags;
1564 1.190 bouyer {
1565 1.190 bouyer struct wdc_command wdc_c;
1566 1.190 bouyer
1567 1.190 bouyer if (wd->drvp->ata_vers < 4) /* WDCC_FLUSHCACHE is here since ATA-4 */
1568 1.190 bouyer return;
1569 1.190 bouyer memset(&wdc_c, 0, sizeof(struct wdc_command));
1570 1.190 bouyer wdc_c.r_command = WDCC_FLUSHCACHE;
1571 1.190 bouyer wdc_c.r_st_bmask = WDCS_DRDY;
1572 1.190 bouyer wdc_c.r_st_pmask = WDCS_DRDY;
1573 1.194 bouyer wdc_c.flags = flags;
1574 1.190 bouyer wdc_c.timeout = 30000; /* 30s timeout */
1575 1.217 bouyer if (wd->atabus->ata_exec_command(wd->drvp, &wdc_c) != WDC_COMPLETE) {
1576 1.190 bouyer printf("%s: flush cache command didn't complete\n",
1577 1.190 bouyer wd->sc_dev.dv_xname);
1578 1.190 bouyer }
1579 1.190 bouyer if (wdc_c.flags & AT_TIMEOU) {
1580 1.190 bouyer printf("%s: flush cache command timeout\n",
1581 1.190 bouyer wd->sc_dev.dv_xname);
1582 1.190 bouyer }
1583 1.190 bouyer if (wdc_c.flags & AT_DF) {
1584 1.190 bouyer printf("%s: flush cache command: drive fault\n",
1585 1.190 bouyer wd->sc_dev.dv_xname);
1586 1.190 bouyer }
1587 1.190 bouyer /*
1588 1.190 bouyer * Ignore error register, it shouldn't report anything else
1589 1.190 bouyer * than COMMAND ABORTED, which means the device doesn't support
1590 1.190 bouyer * flush cache
1591 1.190 bouyer */
1592 1.190 bouyer }
1593 1.190 bouyer
1594 1.190 bouyer void
1595 1.190 bouyer wd_shutdown(arg)
1596 1.190 bouyer void *arg;
1597 1.190 bouyer {
1598 1.190 bouyer struct wd_softc *wd = arg;
1599 1.194 bouyer wd_flushcache(wd, AT_POLL);
1600 1.185 kenh }
1601 1.185 kenh
1602 1.185 kenh /*
1603 1.185 kenh * Allocate space for a ioctl queue structure. Mostly taken from
1604 1.185 kenh * scsipi_ioctl.c
1605 1.185 kenh */
1606 1.185 kenh struct wd_ioctl *
1607 1.185 kenh wi_get()
1608 1.185 kenh {
1609 1.185 kenh struct wd_ioctl *wi;
1610 1.185 kenh int s;
1611 1.185 kenh
1612 1.219 tsutsui wi = malloc(sizeof(struct wd_ioctl), M_TEMP, M_WAITOK|M_ZERO);
1613 1.238 yamt simple_lock_init(&wi->wi_bp.b_interlock);
1614 1.185 kenh s = splbio();
1615 1.185 kenh LIST_INSERT_HEAD(&wi_head, wi, wi_list);
1616 1.185 kenh splx(s);
1617 1.185 kenh return (wi);
1618 1.185 kenh }
1619 1.185 kenh
1620 1.185 kenh /*
1621 1.185 kenh * Free an ioctl structure and remove it from our list
1622 1.185 kenh */
1623 1.185 kenh
1624 1.185 kenh void
1625 1.185 kenh wi_free(wi)
1626 1.185 kenh struct wd_ioctl *wi;
1627 1.185 kenh {
1628 1.185 kenh int s;
1629 1.185 kenh
1630 1.185 kenh s = splbio();
1631 1.185 kenh LIST_REMOVE(wi, wi_list);
1632 1.185 kenh splx(s);
1633 1.185 kenh free(wi, M_TEMP);
1634 1.185 kenh }
1635 1.185 kenh
1636 1.185 kenh /*
1637 1.185 kenh * Find a wd_ioctl structure based on the struct buf.
1638 1.185 kenh */
1639 1.185 kenh
1640 1.185 kenh struct wd_ioctl *
1641 1.185 kenh wi_find(bp)
1642 1.185 kenh struct buf *bp;
1643 1.185 kenh {
1644 1.185 kenh struct wd_ioctl *wi;
1645 1.185 kenh int s;
1646 1.185 kenh
1647 1.185 kenh s = splbio();
1648 1.185 kenh for (wi = wi_head.lh_first; wi != 0; wi = wi->wi_list.le_next)
1649 1.185 kenh if (bp == &wi->wi_bp)
1650 1.185 kenh break;
1651 1.185 kenh splx(s);
1652 1.185 kenh return (wi);
1653 1.185 kenh }
1654 1.185 kenh
1655 1.185 kenh /*
1656 1.185 kenh * Ioctl pseudo strategy routine
1657 1.185 kenh *
1658 1.185 kenh * This is mostly stolen from scsipi_ioctl.c:scsistrategy(). What
1659 1.185 kenh * happens here is:
1660 1.185 kenh *
1661 1.185 kenh * - wdioctl() queues a wd_ioctl structure.
1662 1.185 kenh *
1663 1.185 kenh * - wdioctl() calls physio/wdioctlstrategy based on whether or not
1664 1.185 kenh * user space I/O is required. If physio() is called, physio() eventually
1665 1.185 kenh * calls wdioctlstrategy().
1666 1.185 kenh *
1667 1.217 bouyer * - In either case, wdioctlstrategy() calls wd->atabus->ata_exec_command()
1668 1.185 kenh * to perform the actual command
1669 1.185 kenh *
1670 1.185 kenh * The reason for the use of the pseudo strategy routine is because
1671 1.185 kenh * when doing I/O to/from user space, physio _really_ wants to be in
1672 1.185 kenh * the loop. We could put the entire buffer into the ioctl request
1673 1.185 kenh * structure, but that won't scale if we want to do things like download
1674 1.185 kenh * microcode.
1675 1.185 kenh */
1676 1.185 kenh
1677 1.185 kenh void
1678 1.185 kenh wdioctlstrategy(bp)
1679 1.185 kenh struct buf *bp;
1680 1.185 kenh {
1681 1.185 kenh struct wd_ioctl *wi;
1682 1.185 kenh struct wdc_command wdc_c;
1683 1.185 kenh int error = 0;
1684 1.185 kenh
1685 1.185 kenh wi = wi_find(bp);
1686 1.185 kenh if (wi == NULL) {
1687 1.185 kenh printf("user_strat: No ioctl\n");
1688 1.185 kenh error = EINVAL;
1689 1.185 kenh goto bad;
1690 1.185 kenh }
1691 1.185 kenh
1692 1.185 kenh memset(&wdc_c, 0, sizeof(wdc_c));
1693 1.185 kenh
1694 1.185 kenh /*
1695 1.185 kenh * Abort if physio broke up the transfer
1696 1.185 kenh */
1697 1.185 kenh
1698 1.186 kenh if (bp->b_bcount != wi->wi_atareq.datalen) {
1699 1.185 kenh printf("physio split wd ioctl request... cannot proceed\n");
1700 1.185 kenh error = EIO;
1701 1.185 kenh goto bad;
1702 1.185 kenh }
1703 1.185 kenh
1704 1.185 kenh /*
1705 1.185 kenh * Abort if we didn't get a buffer size that was a multiple of
1706 1.185 kenh * our sector size (or was larger than NBBY)
1707 1.185 kenh */
1708 1.185 kenh
1709 1.185 kenh if ((bp->b_bcount % wi->wi_softc->sc_dk.dk_label->d_secsize) != 0 ||
1710 1.185 kenh (bp->b_bcount / wi->wi_softc->sc_dk.dk_label->d_secsize) >=
1711 1.185 kenh (1 << NBBY)) {
1712 1.185 kenh error = EINVAL;
1713 1.185 kenh goto bad;
1714 1.185 kenh }
1715 1.185 kenh
1716 1.185 kenh /*
1717 1.185 kenh * Make sure a timeout was supplied in the ioctl request
1718 1.185 kenh */
1719 1.185 kenh
1720 1.186 kenh if (wi->wi_atareq.timeout == 0) {
1721 1.185 kenh error = EINVAL;
1722 1.185 kenh goto bad;
1723 1.185 kenh }
1724 1.185 kenh
1725 1.186 kenh if (wi->wi_atareq.flags & ATACMD_READ)
1726 1.185 kenh wdc_c.flags |= AT_READ;
1727 1.186 kenh else if (wi->wi_atareq.flags & ATACMD_WRITE)
1728 1.185 kenh wdc_c.flags |= AT_WRITE;
1729 1.185 kenh
1730 1.188 kenh if (wi->wi_atareq.flags & ATACMD_READREG)
1731 1.188 kenh wdc_c.flags |= AT_READREG;
1732 1.188 kenh
1733 1.185 kenh wdc_c.flags |= AT_WAIT;
1734 1.185 kenh
1735 1.186 kenh wdc_c.timeout = wi->wi_atareq.timeout;
1736 1.186 kenh wdc_c.r_command = wi->wi_atareq.command;
1737 1.186 kenh wdc_c.r_head = wi->wi_atareq.head & 0x0f;
1738 1.186 kenh wdc_c.r_cyl = wi->wi_atareq.cylinder;
1739 1.186 kenh wdc_c.r_sector = wi->wi_atareq.sec_num;
1740 1.186 kenh wdc_c.r_count = wi->wi_atareq.sec_count;
1741 1.186 kenh wdc_c.r_precomp = wi->wi_atareq.features;
1742 1.185 kenh wdc_c.r_st_bmask = WDCS_DRDY;
1743 1.185 kenh wdc_c.r_st_pmask = WDCS_DRDY;
1744 1.185 kenh wdc_c.data = wi->wi_bp.b_data;
1745 1.185 kenh wdc_c.bcount = wi->wi_bp.b_bcount;
1746 1.185 kenh
1747 1.217 bouyer if (wi->wi_softc->atabus->ata_exec_command(wi->wi_softc->drvp, &wdc_c)
1748 1.217 bouyer != WDC_COMPLETE) {
1749 1.186 kenh wi->wi_atareq.retsts = ATACMD_ERROR;
1750 1.185 kenh goto bad;
1751 1.185 kenh }
1752 1.185 kenh
1753 1.185 kenh if (wdc_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
1754 1.185 kenh if (wdc_c.flags & AT_ERROR) {
1755 1.186 kenh wi->wi_atareq.retsts = ATACMD_ERROR;
1756 1.186 kenh wi->wi_atareq.error = wdc_c.r_error;
1757 1.185 kenh } else if (wdc_c.flags & AT_DF)
1758 1.186 kenh wi->wi_atareq.retsts = ATACMD_DF;
1759 1.185 kenh else
1760 1.186 kenh wi->wi_atareq.retsts = ATACMD_TIMEOUT;
1761 1.188 kenh } else {
1762 1.186 kenh wi->wi_atareq.retsts = ATACMD_OK;
1763 1.188 kenh if (wi->wi_atareq.flags & ATACMD_READREG) {
1764 1.188 kenh wi->wi_atareq.head = wdc_c.r_head ;
1765 1.188 kenh wi->wi_atareq.cylinder = wdc_c.r_cyl;
1766 1.188 kenh wi->wi_atareq.sec_num = wdc_c.r_sector;
1767 1.188 kenh wi->wi_atareq.sec_count = wdc_c.r_count;
1768 1.188 kenh wi->wi_atareq.features = wdc_c.r_precomp;
1769 1.188 kenh wi->wi_atareq.error = wdc_c.r_error;
1770 1.188 kenh }
1771 1.188 kenh }
1772 1.185 kenh
1773 1.185 kenh bp->b_error = 0;
1774 1.185 kenh biodone(bp);
1775 1.185 kenh return;
1776 1.185 kenh bad:
1777 1.185 kenh bp->b_flags |= B_ERROR;
1778 1.185 kenh bp->b_error = error;
1779 1.185 kenh biodone(bp);
1780 1.21 deraadt }
1781