wd.c revision 1.191 1 1.191 bouyer /* $NetBSD: wd.c,v 1.191 1999/02/18 14:44:34 bouyer Exp $ */
2 1.181 bouyer
3 1.181 bouyer /*
4 1.181 bouyer * Copyright (c) 1998 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.181 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.1 cgd
68 1.181 bouyer #define WDCDEBUG
69 1.181 bouyer
70 1.166 explorer #include "rnd.h"
71 1.166 explorer
72 1.29 mycroft #include <sys/param.h>
73 1.29 mycroft #include <sys/systm.h>
74 1.43 mycroft #include <sys/kernel.h>
75 1.29 mycroft #include <sys/conf.h>
76 1.29 mycroft #include <sys/file.h>
77 1.29 mycroft #include <sys/stat.h>
78 1.29 mycroft #include <sys/ioctl.h>
79 1.29 mycroft #include <sys/buf.h>
80 1.29 mycroft #include <sys/uio.h>
81 1.29 mycroft #include <sys/malloc.h>
82 1.64 mycroft #include <sys/device.h>
83 1.94 mycroft #include <sys/disklabel.h>
84 1.94 mycroft #include <sys/disk.h>
85 1.29 mycroft #include <sys/syslog.h>
86 1.149 christos #include <sys/proc.h>
87 1.166 explorer #if NRND > 0
88 1.165 explorer #include <sys/rnd.h>
89 1.166 explorer #endif
90 1.29 mycroft
91 1.29 mycroft #include <vm/vm.h>
92 1.29 mycroft
93 1.150 mycroft #include <machine/intr.h>
94 1.168 cgd #include <machine/bus.h>
95 1.29 mycroft
96 1.181 bouyer #include <dev/ata/atareg.h>
97 1.181 bouyer #include <dev/ata/atavar.h>
98 1.181 bouyer #include <dev/ata/wdvar.h>
99 1.181 bouyer #include <dev/ic/wdcreg.h>
100 1.186 kenh #include <sys/ataio.h>
101 1.163 bouyer #include "locators.h"
102 1.1 cgd
103 1.98 mycroft #define WAITTIME (4 * hz) /* time to wait for a completion */
104 1.189 bouyer #define WDIORETRIES_SINGLE 4 /* number of retries before single-sector */
105 1.181 bouyer #define WDIORETRIES 5 /* number of retries before giving up */
106 1.181 bouyer #define RECOVERYTIME hz/2 /* time to wait before retrying a cmd */
107 1.23 deraadt
108 1.181 bouyer #define WDUNIT(dev) DISKUNIT(dev)
109 1.181 bouyer #define WDPART(dev) DISKPART(dev)
110 1.92 cgd #define MAKEWDDEV(maj, unit, part) MAKEDISKDEV(maj, unit, part)
111 1.92 cgd
112 1.92 cgd #define WDLABELDEV(dev) (MAKEWDDEV(major(dev), WDUNIT(dev), RAW_PART))
113 1.1 cgd
114 1.181 bouyer #define DEBUG_INTR 0x01
115 1.181 bouyer #define DEBUG_XFERS 0x02
116 1.181 bouyer #define DEBUG_STATUS 0x04
117 1.181 bouyer #define DEBUG_FUNCS 0x08
118 1.181 bouyer #define DEBUG_PROBE 0x10
119 1.181 bouyer #ifdef WDCDEBUG
120 1.181 bouyer extern int wdcdebug_wd_mask; /* init'ed in ata_wdc.c */
121 1.181 bouyer #define WDCDEBUG_PRINT(args, level) \
122 1.181 bouyer if (wdcdebug_wd_mask & (level)) \
123 1.181 bouyer printf args
124 1.163 bouyer #else
125 1.181 bouyer #define WDCDEBUG_PRINT(args, level)
126 1.163 bouyer #endif
127 1.163 bouyer
128 1.64 mycroft struct wd_softc {
129 1.181 bouyer /* General disk infos */
130 1.64 mycroft struct device sc_dev;
131 1.144 thorpej struct disk sc_dk;
132 1.64 mycroft struct buf sc_q;
133 1.181 bouyer /* IDE disk soft states */
134 1.184 bouyer struct ata_bio sc_wdc_bio; /* current transfer */
135 1.181 bouyer struct buf *sc_bp; /* buf being transfered */
136 1.181 bouyer void *wdc_softc; /* pointer to our parent */
137 1.181 bouyer struct ata_drive_datas *drvp; /* Our controller's infos */
138 1.181 bouyer int openings;
139 1.181 bouyer struct ataparams sc_params;/* drive characteistics found */
140 1.181 bouyer int sc_flags;
141 1.181 bouyer #define WDF_LOCKED 0x01
142 1.181 bouyer #define WDF_WANTED 0x02
143 1.181 bouyer #define WDF_WLABEL 0x04 /* label is writable */
144 1.181 bouyer #define WDF_LABELLING 0x08 /* writing label */
145 1.181 bouyer /*
146 1.181 bouyer * XXX Nothing resets this yet, but disk change sensing will when ATA-4 is
147 1.181 bouyer * more fully implemented.
148 1.181 bouyer */
149 1.181 bouyer #define WDF_LOADED 0x10 /* parameters loaded */
150 1.181 bouyer #define WDF_WAIT 0x20 /* waiting for resources */
151 1.181 bouyer #define WDF_LBA 0x40 /* using LBA mode */
152 1.181 bouyer int sc_capacity;
153 1.181 bouyer int cyl; /* actual drive parameters */
154 1.181 bouyer int heads;
155 1.181 bouyer int sectors;
156 1.181 bouyer int retries; /* number of xfer retry */
157 1.166 explorer #if NRND > 0
158 1.165 explorer rndsource_element_t rnd_source;
159 1.166 explorer #endif
160 1.74 mycroft };
161 1.64 mycroft
162 1.181 bouyer #define sc_drive sc_wdc_bio.drive
163 1.181 bouyer #define sc_mode sc_wdc_bio.mode
164 1.181 bouyer #define sc_multi sc_wdc_bio.multi
165 1.181 bouyer #define sc_badsect sc_wdc_bio.badsect
166 1.181 bouyer
167 1.168 cgd int wdprobe __P((struct device *, struct cfdata *, void *));
168 1.163 bouyer void wdattach __P((struct device *, struct device *, void *));
169 1.181 bouyer int wdprint __P((void *, char *));
170 1.102 mycroft
171 1.147 thorpej struct cfattach wd_ca = {
172 1.147 thorpej sizeof(struct wd_softc), wdprobe, wdattach
173 1.147 thorpej };
174 1.147 thorpej
175 1.167 thorpej extern struct cfdriver wd_cd;
176 1.108 mycroft
177 1.185 kenh /*
178 1.185 kenh * Glue necessary to hook WDCIOCCOMMAND into physio
179 1.185 kenh */
180 1.185 kenh
181 1.185 kenh struct wd_ioctl {
182 1.185 kenh LIST_ENTRY(wd_ioctl) wi_list;
183 1.185 kenh struct buf wi_bp;
184 1.185 kenh struct uio wi_uio;
185 1.185 kenh struct iovec wi_iov;
186 1.186 kenh atareq_t wi_atareq;
187 1.185 kenh struct wd_softc *wi_softc;
188 1.185 kenh };
189 1.185 kenh
190 1.185 kenh LIST_HEAD(, wd_ioctl) wi_head;
191 1.185 kenh
192 1.185 kenh struct wd_ioctl *wi_find __P((struct buf *));
193 1.185 kenh void wi_free __P((struct wd_ioctl *));
194 1.185 kenh struct wd_ioctl *wi_get __P((void));
195 1.185 kenh void wdioctlstrategy __P((struct buf *));
196 1.185 kenh
197 1.181 bouyer void wdgetdefaultlabel __P((struct wd_softc *, struct disklabel *));
198 1.181 bouyer void wdgetdisklabel __P((struct wd_softc *));
199 1.181 bouyer void wdstrategy __P((struct buf *));
200 1.181 bouyer void wdstart __P((void *));
201 1.181 bouyer void __wdstart __P((struct wd_softc*, struct buf *));
202 1.181 bouyer void wdrestart __P((void*));
203 1.181 bouyer int wd_get_params __P((struct wd_softc *, u_int8_t, struct ataparams *));
204 1.190 bouyer void wd_flushcache __P((struct wd_softc *, int));
205 1.190 bouyer void wd_shutdown __P((void*));
206 1.108 mycroft
207 1.102 mycroft struct dkdriver wddkdriver = { wdstrategy };
208 1.65 mycroft
209 1.149 christos /* XXX: these should go elsewhere */
210 1.149 christos cdev_decl(wd);
211 1.149 christos bdev_decl(wd);
212 1.149 christos
213 1.170 leo #ifdef HAS_BAD144_HANDLING
214 1.64 mycroft static void bad144intern __P((struct wd_softc *));
215 1.170 leo #endif
216 1.181 bouyer int wdlock __P((struct wd_softc *));
217 1.181 bouyer void wdunlock __P((struct wd_softc *));
218 1.1 cgd
219 1.1 cgd int
220 1.163 bouyer wdprobe(parent, match, aux)
221 1.102 mycroft struct device *parent;
222 1.168 cgd struct cfdata *match;
223 1.168 cgd
224 1.168 cgd void *aux;
225 1.1 cgd {
226 1.181 bouyer struct ata_atapi_attach *aa_link = aux;
227 1.167 thorpej
228 1.181 bouyer if (aa_link == NULL)
229 1.181 bouyer return 0;
230 1.181 bouyer if (aa_link->aa_type != T_ATA)
231 1.64 mycroft return 0;
232 1.181 bouyer
233 1.181 bouyer if (match->cf_loc[ATACF_CHANNEL] != ATACF_CHANNEL_DEFAULT &&
234 1.181 bouyer match->cf_loc[ATACF_CHANNEL] != aa_link->aa_channel)
235 1.105 mycroft return 0;
236 1.105 mycroft
237 1.168 cgd if (match->cf_loc[ATACF_DRIVE] != ATACF_DRIVE_DEFAULT &&
238 1.181 bouyer match->cf_loc[ATACF_DRIVE] != aa_link->aa_drv_data->drive)
239 1.74 mycroft return 0;
240 1.74 mycroft return 1;
241 1.74 mycroft }
242 1.64 mycroft
243 1.74 mycroft void
244 1.74 mycroft wdattach(parent, self, aux)
245 1.74 mycroft struct device *parent, *self;
246 1.74 mycroft void *aux;
247 1.74 mycroft {
248 1.74 mycroft struct wd_softc *wd = (void *)self;
249 1.181 bouyer struct ata_atapi_attach *aa_link= aux;
250 1.74 mycroft int i, blank;
251 1.135 mycroft char buf[41], c, *p, *q;
252 1.181 bouyer WDCDEBUG_PRINT(("wdattach\n"), DEBUG_FUNCS | DEBUG_PROBE);
253 1.56 mycroft
254 1.181 bouyer wd->openings = aa_link->aa_openings;
255 1.181 bouyer wd->drvp = aa_link->aa_drv_data;;
256 1.181 bouyer wd->wdc_softc = parent;
257 1.181 bouyer /* give back our softc to our caller */
258 1.181 bouyer wd->drvp->drv_softc = &wd->sc_dev;
259 1.181 bouyer
260 1.181 bouyer /* read our drive info */
261 1.181 bouyer if (wd_get_params(wd, AT_POLL, &wd->sc_params) != 0) {
262 1.181 bouyer printf("%s: IDENTIFY failed\n", wd->sc_dev.dv_xname);
263 1.181 bouyer return;
264 1.181 bouyer }
265 1.163 bouyer
266 1.181 bouyer for (blank = 0, p = wd->sc_params.atap_model, q = buf, i = 0;
267 1.181 bouyer i < sizeof(wd->sc_params.atap_model); i++) {
268 1.135 mycroft c = *p++;
269 1.135 mycroft if (c == '\0')
270 1.135 mycroft break;
271 1.135 mycroft if (c != ' ') {
272 1.135 mycroft if (blank) {
273 1.135 mycroft *q++ = ' ';
274 1.135 mycroft blank = 0;
275 1.135 mycroft }
276 1.135 mycroft *q++ = c;
277 1.135 mycroft } else
278 1.135 mycroft blank = 1;
279 1.181 bouyer }
280 1.135 mycroft *q++ = '\0';
281 1.135 mycroft
282 1.172 mycroft printf(": <%s>\n", buf);
283 1.113 mycroft
284 1.181 bouyer if ((wd->sc_params.atap_multi & 0xff) > 1) {
285 1.181 bouyer wd->sc_multi = wd->sc_params.atap_multi & 0xff;
286 1.113 mycroft } else {
287 1.181 bouyer wd->sc_multi = 1;
288 1.113 mycroft }
289 1.113 mycroft
290 1.184 bouyer printf("%s: drive supports %d-sector pio transfers,",
291 1.184 bouyer wd->sc_dev.dv_xname, wd->sc_multi);
292 1.172 mycroft
293 1.172 mycroft /* Prior to ATA-4, LBA was optional. */
294 1.181 bouyer if ((wd->sc_params.atap_capabilities1 & WDC_CAP_LBA) != 0)
295 1.181 bouyer wd->sc_flags |= WDF_LBA;
296 1.174 mycroft #if 0
297 1.172 mycroft /* ATA-4 requires LBA. */
298 1.181 bouyer if (wd->sc_params.atap_ataversion != 0xffff &&
299 1.181 bouyer wd->sc_params.atap_ataversion >= WDC_VER_ATA4)
300 1.181 bouyer wd->sc_flags |= WDF_LBA;
301 1.174 mycroft #endif
302 1.172 mycroft
303 1.181 bouyer if ((wd->sc_flags & WDF_LBA) != 0) {
304 1.184 bouyer printf(" lba addressing\n");
305 1.181 bouyer wd->sc_capacity =
306 1.181 bouyer (wd->sc_params.atap_capacity[1] << 16) |
307 1.181 bouyer wd->sc_params.atap_capacity[0];
308 1.181 bouyer printf("%s: %dMB, %d cyl, %d head, %d sec, "
309 1.181 bouyer "%d bytes/sect x %d sectors\n",
310 1.172 mycroft self->dv_xname,
311 1.181 bouyer wd->sc_capacity / (1048576 / DEV_BSIZE),
312 1.181 bouyer wd->sc_params.atap_cylinders,
313 1.181 bouyer wd->sc_params.atap_heads,
314 1.181 bouyer wd->sc_params.atap_sectors,
315 1.179 rvb DEV_BSIZE,
316 1.181 bouyer wd->sc_capacity);
317 1.172 mycroft } else {
318 1.184 bouyer printf(" chs addressing\n");
319 1.181 bouyer wd->sc_capacity =
320 1.181 bouyer wd->sc_params.atap_cylinders *
321 1.181 bouyer wd->sc_params.atap_heads *
322 1.181 bouyer wd->sc_params.atap_sectors;
323 1.191 bouyer printf("%s: %dMB, %d cyl, %d head, %d sec, %d bytes/sect x %d "
324 1.181 bouyer "sectors\n", self->dv_xname,
325 1.181 bouyer wd->sc_capacity / (1048576 / DEV_BSIZE),
326 1.181 bouyer wd->sc_params.atap_cylinders,
327 1.181 bouyer wd->sc_params.atap_heads,
328 1.181 bouyer wd->sc_params.atap_sectors,
329 1.179 rvb DEV_BSIZE,
330 1.181 bouyer wd->sc_capacity);
331 1.172 mycroft }
332 1.181 bouyer WDCDEBUG_PRINT(("%s: atap_dmatiming_mimi=%d, atap_dmatiming_recom=%d\n",
333 1.181 bouyer self->dv_xname, wd->sc_params.atap_dmatiming_mimi,
334 1.181 bouyer wd->sc_params.atap_dmatiming_recom), DEBUG_PROBE);
335 1.181 bouyer /*
336 1.181 bouyer * Initialize and attach the disk structure.
337 1.181 bouyer */
338 1.181 bouyer wd->sc_dk.dk_driver = &wddkdriver;
339 1.181 bouyer wd->sc_dk.dk_name = wd->sc_dev.dv_xname;
340 1.181 bouyer disk_attach(&wd->sc_dk);
341 1.181 bouyer wd->sc_wdc_bio.lp = wd->sc_dk.dk_label;
342 1.190 bouyer if (shutdownhook_establish(wd_shutdown, wd) == NULL)
343 1.190 bouyer printf("%s: WARNING: unable to establish shutdown hook\n",
344 1.190 bouyer wd->sc_dev.dv_xname);
345 1.166 explorer #if NRND > 0
346 1.165 explorer rnd_attach_source(&wd->rnd_source, wd->sc_dev.dv_xname, RND_TYPE_DISK);
347 1.166 explorer #endif
348 1.1 cgd }
349 1.1 cgd
350 1.64 mycroft /*
351 1.135 mycroft * Read/write routine for a buffer. Validates the arguments and schedules the
352 1.135 mycroft * transfer. Does not wait for the transfer to complete.
353 1.1 cgd */
354 1.64 mycroft void
355 1.55 mycroft wdstrategy(bp)
356 1.55 mycroft struct buf *bp;
357 1.1 cgd {
358 1.147 thorpej struct wd_softc *wd = wd_cd.cd_devs[WDUNIT(bp->b_dev)];
359 1.37 mycroft int s;
360 1.181 bouyer WDCDEBUG_PRINT(("wdstrategy (%s)\n", wd->sc_dev.dv_xname),
361 1.182 bouyer DEBUG_XFERS);
362 1.181 bouyer
363 1.135 mycroft /* Valid request? */
364 1.135 mycroft if (bp->b_blkno < 0 ||
365 1.144 thorpej (bp->b_bcount % wd->sc_dk.dk_label->d_secsize) != 0 ||
366 1.144 thorpej (bp->b_bcount / wd->sc_dk.dk_label->d_secsize) >= (1 << NBBY)) {
367 1.1 cgd bp->b_error = EINVAL;
368 1.93 mycroft goto bad;
369 1.1 cgd }
370 1.181 bouyer
371 1.135 mycroft /* If device invalidated (e.g. media change, door open), error. */
372 1.181 bouyer if ((wd->sc_flags & WDF_LOADED) == 0) {
373 1.135 mycroft bp->b_error = EIO;
374 1.135 mycroft goto bad;
375 1.135 mycroft }
376 1.135 mycroft
377 1.93 mycroft /* If it's a null transfer, return immediately. */
378 1.93 mycroft if (bp->b_bcount == 0)
379 1.93 mycroft goto done;
380 1.93 mycroft
381 1.128 mycroft /*
382 1.128 mycroft * Do bounds checking, adjust transfer. if error, process.
383 1.128 mycroft * If end of partition, just return.
384 1.128 mycroft */
385 1.138 mycroft if (WDPART(bp->b_dev) != RAW_PART &&
386 1.144 thorpej bounds_check_with_label(bp, wd->sc_dk.dk_label,
387 1.181 bouyer (wd->sc_flags & (WDF_WLABEL|WDF_LABELLING)) != 0) <= 0)
388 1.128 mycroft goto done;
389 1.64 mycroft /* Queue transfer on drive, activate drive and controller if idle. */
390 1.1 cgd s = splbio();
391 1.113 mycroft disksort(&wd->sc_q, bp);
392 1.163 bouyer wdstart(wd);
393 1.1 cgd splx(s);
394 1.64 mycroft return;
395 1.93 mycroft bad:
396 1.93 mycroft bp->b_flags |= B_ERROR;
397 1.1 cgd done:
398 1.64 mycroft /* Toss transfer; we're done early. */
399 1.135 mycroft bp->b_resid = bp->b_bcount;
400 1.1 cgd biodone(bp);
401 1.1 cgd }
402 1.1 cgd
403 1.1 cgd /*
404 1.135 mycroft * Queue a drive for I/O.
405 1.1 cgd */
406 1.108 mycroft void
407 1.163 bouyer wdstart(arg)
408 1.163 bouyer void *arg;
409 1.1 cgd {
410 1.163 bouyer struct wd_softc *wd = arg;
411 1.163 bouyer struct buf *dp, *bp=0;
412 1.163 bouyer
413 1.181 bouyer WDCDEBUG_PRINT(("wdstart %s\n", wd->sc_dev.dv_xname),
414 1.182 bouyer DEBUG_XFERS);
415 1.181 bouyer while (wd->openings > 0) {
416 1.163 bouyer
417 1.163 bouyer /* Is there a buf for us ? */
418 1.163 bouyer dp = &wd->sc_q;
419 1.163 bouyer if ((bp = dp->b_actf) == NULL) /* yes, an assign */
420 1.181 bouyer return;
421 1.163 bouyer dp->b_actf = bp->b_actf;
422 1.181 bouyer
423 1.163 bouyer /*
424 1.163 bouyer * Make the command. First lock the device
425 1.163 bouyer */
426 1.181 bouyer wd->openings--;
427 1.181 bouyer
428 1.181 bouyer wd->retries = 0;
429 1.181 bouyer __wdstart(wd, bp);
430 1.181 bouyer }
431 1.181 bouyer }
432 1.181 bouyer
433 1.181 bouyer void
434 1.181 bouyer __wdstart(wd, bp)
435 1.181 bouyer struct wd_softc *wd;
436 1.181 bouyer struct buf *bp;
437 1.181 bouyer {
438 1.181 bouyer daddr_t p_offset;
439 1.181 bouyer if (WDPART(bp->b_dev) != RAW_PART)
440 1.181 bouyer p_offset =
441 1.181 bouyer wd->sc_dk.dk_label->d_partitions[WDPART(bp->b_dev)].p_offset;
442 1.181 bouyer else
443 1.181 bouyer p_offset = 0;
444 1.181 bouyer wd->sc_wdc_bio.blkno = bp->b_blkno + p_offset;
445 1.181 bouyer wd->sc_wdc_bio.blkno /= (wd->sc_dk.dk_label->d_secsize / DEV_BSIZE);
446 1.181 bouyer wd->sc_wdc_bio.blkdone =0;
447 1.181 bouyer wd->sc_bp = bp;
448 1.181 bouyer /*
449 1.181 bouyer * If we're retrying, retry in single-sector mode. This will give us
450 1.181 bouyer * the sector number of the problem, and will eventually allow the
451 1.184 bouyer * transfer to succeed.
452 1.181 bouyer */
453 1.189 bouyer if (wd->sc_multi == 1 || wd->retries >= WDIORETRIES_SINGLE)
454 1.181 bouyer wd->sc_wdc_bio.flags = ATA_SINGLE;
455 1.181 bouyer else
456 1.181 bouyer wd->sc_wdc_bio.flags = 0;
457 1.181 bouyer if (wd->sc_flags & WDF_LBA)
458 1.181 bouyer wd->sc_wdc_bio.flags |= ATA_LBA;
459 1.181 bouyer if (bp->b_flags & B_READ)
460 1.181 bouyer wd->sc_wdc_bio.flags |= ATA_READ;
461 1.181 bouyer wd->sc_wdc_bio.bcount = bp->b_bcount;
462 1.181 bouyer wd->sc_wdc_bio.databuf = bp->b_data;
463 1.181 bouyer /* Instrumentation. */
464 1.181 bouyer disk_busy(&wd->sc_dk);
465 1.181 bouyer switch (wdc_ata_bio(wd->drvp, &wd->sc_wdc_bio)) {
466 1.181 bouyer case WDC_TRY_AGAIN:
467 1.181 bouyer timeout(wdrestart, wd, hz);
468 1.181 bouyer break;
469 1.181 bouyer case WDC_QUEUED:
470 1.181 bouyer break;
471 1.181 bouyer case WDC_COMPLETE:
472 1.181 bouyer wddone(wd);
473 1.181 bouyer break;
474 1.181 bouyer default:
475 1.181 bouyer panic("__wdstart: bad return code from wdc_ata_bio()");
476 1.181 bouyer }
477 1.181 bouyer }
478 1.181 bouyer
479 1.181 bouyer void
480 1.181 bouyer wddone(v)
481 1.181 bouyer void *v;
482 1.181 bouyer {
483 1.181 bouyer struct wd_softc *wd = v;
484 1.181 bouyer struct buf *bp = wd->sc_bp;
485 1.181 bouyer char buf[256], *errbuf = buf;
486 1.181 bouyer WDCDEBUG_PRINT(("wddone %s\n", wd->sc_dev.dv_xname),
487 1.182 bouyer DEBUG_XFERS);
488 1.181 bouyer
489 1.181 bouyer bp->b_resid = wd->sc_wdc_bio.bcount;
490 1.181 bouyer errbuf[0] = '\0';
491 1.181 bouyer switch (wd->sc_wdc_bio.error) {
492 1.181 bouyer case ERR_DMA:
493 1.181 bouyer errbuf = "DMA error";
494 1.181 bouyer goto retry;
495 1.181 bouyer case ERR_DF:
496 1.181 bouyer errbuf = "device fault";
497 1.181 bouyer goto retry;
498 1.181 bouyer case TIMEOUT:
499 1.181 bouyer errbuf = "device timeout";
500 1.181 bouyer goto retry;
501 1.181 bouyer case ERROR:
502 1.181 bouyer /* Don't care about media change bits */
503 1.181 bouyer if (wd->sc_wdc_bio.r_error != 0 &&
504 1.181 bouyer (wd->sc_wdc_bio.r_error & ~(WDCE_MC | WDCE_MCR)) == 0)
505 1.181 bouyer goto noerror;
506 1.190 bouyer ata_perror(wd->drvp, wd->sc_wdc_bio.r_error, errbuf);
507 1.181 bouyer retry: /* Just reset and retry. Can we do more ? */
508 1.181 bouyer wdc_reset_channel(wd->drvp);
509 1.181 bouyer diskerr(bp, "wd", errbuf, LOG_PRINTF,
510 1.181 bouyer wd->sc_wdc_bio.blkdone, wd->sc_dk.dk_label);
511 1.181 bouyer if (wd->retries++ < WDIORETRIES) {
512 1.181 bouyer printf(", retrying\n");
513 1.181 bouyer timeout(wdrestart, wd, RECOVERYTIME);
514 1.181 bouyer return;
515 1.181 bouyer }
516 1.181 bouyer printf("\n");
517 1.181 bouyer bp->b_flags |= B_ERROR;
518 1.181 bouyer bp->b_error = EIO;
519 1.181 bouyer break;
520 1.181 bouyer case NOERROR:
521 1.181 bouyer noerror: if ((wd->sc_wdc_bio.flags & ATA_CORR) || wd->retries > 0)
522 1.181 bouyer printf("%s: soft error (corrected)\n",
523 1.181 bouyer wd->sc_dev.dv_xname);
524 1.64 mycroft }
525 1.181 bouyer disk_unbusy(&wd->sc_dk, (bp->b_bcount - bp->b_resid));
526 1.181 bouyer #if NRND > 0
527 1.181 bouyer rnd_add_uint32(&wd->rnd_source, bp->b_blkno);
528 1.181 bouyer #endif
529 1.181 bouyer biodone(bp);
530 1.181 bouyer wd->openings++;
531 1.181 bouyer wdstart(wd);
532 1.181 bouyer }
533 1.181 bouyer
534 1.181 bouyer void
535 1.181 bouyer wdrestart(v)
536 1.181 bouyer void *v;
537 1.181 bouyer {
538 1.181 bouyer struct wd_softc *wd = v;
539 1.181 bouyer struct buf *bp = wd->sc_bp;
540 1.181 bouyer int s;
541 1.181 bouyer WDCDEBUG_PRINT(("wdrestart %s\n", wd->sc_dev.dv_xname),
542 1.182 bouyer DEBUG_XFERS);
543 1.181 bouyer
544 1.181 bouyer s = splbio();
545 1.181 bouyer __wdstart(v, bp);
546 1.181 bouyer splx(s);
547 1.141 mycroft }
548 1.141 mycroft
549 1.141 mycroft int
550 1.149 christos wdread(dev, uio, flags)
551 1.141 mycroft dev_t dev;
552 1.141 mycroft struct uio *uio;
553 1.149 christos int flags;
554 1.141 mycroft {
555 1.141 mycroft
556 1.182 bouyer WDCDEBUG_PRINT(("wdread\n"), DEBUG_XFERS);
557 1.141 mycroft return (physio(wdstrategy, NULL, dev, B_READ, minphys, uio));
558 1.141 mycroft }
559 1.141 mycroft
560 1.141 mycroft int
561 1.149 christos wdwrite(dev, uio, flags)
562 1.141 mycroft dev_t dev;
563 1.141 mycroft struct uio *uio;
564 1.149 christos int flags;
565 1.141 mycroft {
566 1.141 mycroft
567 1.182 bouyer WDCDEBUG_PRINT(("wdwrite\n"), DEBUG_XFERS);
568 1.141 mycroft return (physio(wdstrategy, NULL, dev, B_WRITE, minphys, uio));
569 1.64 mycroft }
570 1.64 mycroft
571 1.1 cgd /*
572 1.135 mycroft * Wait interruptibly for an exclusive lock.
573 1.135 mycroft *
574 1.135 mycroft * XXX
575 1.135 mycroft * Several drivers do this; it should be abstracted and made MP-safe.
576 1.135 mycroft */
577 1.132 mycroft int
578 1.181 bouyer wdlock(wd)
579 1.181 bouyer struct wd_softc *wd;
580 1.132 mycroft {
581 1.132 mycroft int error;
582 1.163 bouyer int s;
583 1.163 bouyer
584 1.181 bouyer WDCDEBUG_PRINT(("wdlock\n"), DEBUG_FUNCS);
585 1.132 mycroft
586 1.163 bouyer s = splbio();
587 1.163 bouyer
588 1.181 bouyer while ((wd->sc_flags & WDF_LOCKED) != 0) {
589 1.181 bouyer wd->sc_flags |= WDF_WANTED;
590 1.181 bouyer if ((error = tsleep(wd, PRIBIO | PCATCH,
591 1.163 bouyer "wdlck", 0)) != 0) {
592 1.163 bouyer splx(s);
593 1.132 mycroft return error;
594 1.163 bouyer }
595 1.132 mycroft }
596 1.181 bouyer wd->sc_flags |= WDF_LOCKED;
597 1.163 bouyer splx(s);
598 1.132 mycroft return 0;
599 1.132 mycroft }
600 1.132 mycroft
601 1.135 mycroft /*
602 1.135 mycroft * Unlock and wake up any waiters.
603 1.135 mycroft */
604 1.132 mycroft void
605 1.181 bouyer wdunlock(wd)
606 1.181 bouyer struct wd_softc *wd;
607 1.132 mycroft {
608 1.132 mycroft
609 1.181 bouyer WDCDEBUG_PRINT(("wdunlock\n"), DEBUG_FUNCS);
610 1.163 bouyer
611 1.181 bouyer wd->sc_flags &= ~WDF_LOCKED;
612 1.181 bouyer if ((wd->sc_flags & WDF_WANTED) != 0) {
613 1.181 bouyer wd->sc_flags &= ~WDF_WANTED;
614 1.181 bouyer wakeup(wd);
615 1.132 mycroft }
616 1.132 mycroft }
617 1.132 mycroft
618 1.1 cgd int
619 1.149 christos wdopen(dev, flag, fmt, p)
620 1.55 mycroft dev_t dev;
621 1.93 mycroft int flag, fmt;
622 1.149 christos struct proc *p;
623 1.1 cgd {
624 1.135 mycroft struct wd_softc *wd;
625 1.135 mycroft int unit, part;
626 1.109 mycroft int error;
627 1.163 bouyer
628 1.181 bouyer WDCDEBUG_PRINT(("wdopen\n"), DEBUG_FUNCS);
629 1.108 mycroft unit = WDUNIT(dev);
630 1.147 thorpej if (unit >= wd_cd.cd_ndevs)
631 1.37 mycroft return ENXIO;
632 1.147 thorpej wd = wd_cd.cd_devs[unit];
633 1.158 pk if (wd == NULL)
634 1.37 mycroft return ENXIO;
635 1.187 thorpej
636 1.187 thorpej /*
637 1.187 thorpej * If this is the first open of this device, add a reference
638 1.187 thorpej * to the adapter.
639 1.187 thorpej */
640 1.187 thorpej if (wd->sc_dk.dk_openmask == 0 &&
641 1.187 thorpej (error = wdc_ata_addref(wd->drvp)) != 0)
642 1.187 thorpej return (error);
643 1.187 thorpej
644 1.181 bouyer if ((error = wdlock(wd)) != 0)
645 1.187 thorpej goto bad4;
646 1.3 deraadt
647 1.109 mycroft if (wd->sc_dk.dk_openmask != 0) {
648 1.109 mycroft /*
649 1.109 mycroft * If any partition is open, but the disk has been invalidated,
650 1.109 mycroft * disallow further opens.
651 1.109 mycroft */
652 1.181 bouyer if ((wd->sc_flags & WDF_LOADED) == 0) {
653 1.136 mycroft error = EIO;
654 1.136 mycroft goto bad3;
655 1.136 mycroft }
656 1.109 mycroft } else {
657 1.181 bouyer if ((wd->sc_flags & WDF_LOADED) == 0) {
658 1.181 bouyer wd->sc_flags |= WDF_LOADED;
659 1.108 mycroft
660 1.108 mycroft /* Load the physical device parameters. */
661 1.183 bouyer wd_get_params(wd, AT_WAIT, &wd->sc_params);
662 1.108 mycroft
663 1.108 mycroft /* Load the partition info if not already loaded. */
664 1.108 mycroft wdgetdisklabel(wd);
665 1.108 mycroft }
666 1.135 mycroft }
667 1.108 mycroft
668 1.135 mycroft part = WDPART(dev);
669 1.108 mycroft
670 1.109 mycroft /* Check that the partition exists. */
671 1.93 mycroft if (part != RAW_PART &&
672 1.144 thorpej (part >= wd->sc_dk.dk_label->d_npartitions ||
673 1.144 thorpej wd->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) {
674 1.93 mycroft error = ENXIO;
675 1.93 mycroft goto bad;
676 1.93 mycroft }
677 1.181 bouyer
678 1.64 mycroft /* Insure only one open at a time. */
679 1.3 deraadt switch (fmt) {
680 1.3 deraadt case S_IFCHR:
681 1.94 mycroft wd->sc_dk.dk_copenmask |= (1 << part);
682 1.3 deraadt break;
683 1.3 deraadt case S_IFBLK:
684 1.94 mycroft wd->sc_dk.dk_bopenmask |= (1 << part);
685 1.3 deraadt break;
686 1.3 deraadt }
687 1.181 bouyer wd->sc_dk.dk_openmask =
688 1.181 bouyer wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
689 1.60 mycroft
690 1.181 bouyer wdunlock(wd);
691 1.37 mycroft return 0;
692 1.93 mycroft
693 1.93 mycroft bad:
694 1.118 mycroft if (wd->sc_dk.dk_openmask == 0) {
695 1.108 mycroft }
696 1.108 mycroft
697 1.136 mycroft bad3:
698 1.181 bouyer wdunlock(wd);
699 1.187 thorpej bad4:
700 1.187 thorpej if (wd->sc_dk.dk_openmask == 0)
701 1.187 thorpej wdc_ata_delref(wd->drvp);
702 1.93 mycroft return error;
703 1.1 cgd }
704 1.1 cgd
705 1.135 mycroft int
706 1.149 christos wdclose(dev, flag, fmt, p)
707 1.135 mycroft dev_t dev;
708 1.135 mycroft int flag, fmt;
709 1.149 christos struct proc *p;
710 1.135 mycroft {
711 1.147 thorpej struct wd_softc *wd = wd_cd.cd_devs[WDUNIT(dev)];
712 1.135 mycroft int part = WDPART(dev);
713 1.135 mycroft int error;
714 1.181 bouyer
715 1.181 bouyer WDCDEBUG_PRINT(("wdclose\n"), DEBUG_FUNCS);
716 1.181 bouyer if ((error = wdlock(wd)) != 0)
717 1.135 mycroft return error;
718 1.135 mycroft
719 1.135 mycroft switch (fmt) {
720 1.135 mycroft case S_IFCHR:
721 1.135 mycroft wd->sc_dk.dk_copenmask &= ~(1 << part);
722 1.135 mycroft break;
723 1.135 mycroft case S_IFBLK:
724 1.135 mycroft wd->sc_dk.dk_bopenmask &= ~(1 << part);
725 1.135 mycroft break;
726 1.135 mycroft }
727 1.181 bouyer wd->sc_dk.dk_openmask =
728 1.181 bouyer wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
729 1.135 mycroft
730 1.135 mycroft if (wd->sc_dk.dk_openmask == 0) {
731 1.190 bouyer wd_flushcache(wd,0);
732 1.135 mycroft /* XXXX Must wait for I/O to complete! */
733 1.187 thorpej
734 1.187 thorpej wdc_ata_delref(wd->drvp);
735 1.135 mycroft }
736 1.135 mycroft
737 1.181 bouyer wdunlock(wd);
738 1.135 mycroft return 0;
739 1.135 mycroft }
740 1.135 mycroft
741 1.108 mycroft void
742 1.164 thorpej wdgetdefaultlabel(wd, lp)
743 1.108 mycroft struct wd_softc *wd;
744 1.164 thorpej struct disklabel *lp;
745 1.108 mycroft {
746 1.163 bouyer
747 1.181 bouyer WDCDEBUG_PRINT(("wdgetdefaultlabel\n"), DEBUG_FUNCS);
748 1.181 bouyer memset(lp, 0, sizeof(struct disklabel));
749 1.108 mycroft
750 1.142 mycroft lp->d_secsize = DEV_BSIZE;
751 1.181 bouyer lp->d_ntracks = wd->sc_params.atap_heads;
752 1.181 bouyer lp->d_nsectors = wd->sc_params.atap_sectors;
753 1.181 bouyer lp->d_ncylinders = wd->sc_params.atap_cylinders;
754 1.142 mycroft lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
755 1.108 mycroft
756 1.108 mycroft #if 0
757 1.181 bouyer if (strcmp(wd->sc_params.atap_model, "ST506") == 0) {
758 1.181 bouyer lp->d_type = DTYPE_ST506;
759 1.181 bouyer strncpy(lp->d_typename, "ST506 disk", 16);
760 1.181 bouyer } else {
761 1.181 bouyer lp->d_type = DTYPE_ESDI;
762 1.181 bouyer strncpy(lp->d_typename, "ESDI/IDE",
763 1.181 bouyer sizeof lp->d_typename);
764 1.181 bouyer }
765 1.108 mycroft #endif
766 1.181 bouyer strncpy(lp->d_typename, wd->sc_params.atap_model, 16);
767 1.180 drochner strncpy(lp->d_packname, "fictitious", 16);
768 1.181 bouyer lp->d_secperunit = wd->sc_capacity;
769 1.142 mycroft lp->d_rpm = 3600;
770 1.142 mycroft lp->d_interleave = 1;
771 1.142 mycroft lp->d_flags = 0;
772 1.142 mycroft
773 1.142 mycroft lp->d_partitions[RAW_PART].p_offset = 0;
774 1.142 mycroft lp->d_partitions[RAW_PART].p_size =
775 1.181 bouyer lp->d_secperunit * (lp->d_secsize / DEV_BSIZE);
776 1.142 mycroft lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED;
777 1.142 mycroft lp->d_npartitions = RAW_PART + 1;
778 1.142 mycroft
779 1.142 mycroft lp->d_magic = DISKMAGIC;
780 1.142 mycroft lp->d_magic2 = DISKMAGIC;
781 1.142 mycroft lp->d_checksum = dkcksum(lp);
782 1.164 thorpej }
783 1.164 thorpej
784 1.164 thorpej /*
785 1.164 thorpej * Fabricate a default disk label, and try to read the correct one.
786 1.164 thorpej */
787 1.164 thorpej void
788 1.164 thorpej wdgetdisklabel(wd)
789 1.164 thorpej struct wd_softc *wd;
790 1.164 thorpej {
791 1.164 thorpej struct disklabel *lp = wd->sc_dk.dk_label;
792 1.164 thorpej char *errstring;
793 1.164 thorpej
794 1.181 bouyer WDCDEBUG_PRINT(("wdgetdisklabel\n"), DEBUG_FUNCS);
795 1.164 thorpej
796 1.181 bouyer memset(wd->sc_dk.dk_cpulabel, 0, sizeof(struct cpu_disklabel));
797 1.164 thorpej
798 1.164 thorpej wdgetdefaultlabel(wd, lp);
799 1.108 mycroft
800 1.181 bouyer wd->sc_badsect[0] = -1;
801 1.113 mycroft
802 1.181 bouyer if (wd->drvp->state > RECAL)
803 1.183 bouyer wd->drvp->drive_flags |= DRIVE_RESET;
804 1.108 mycroft errstring = readdisklabel(MAKEWDDEV(0, wd->sc_dev.dv_unit, RAW_PART),
805 1.144 thorpej wdstrategy, lp, wd->sc_dk.dk_cpulabel);
806 1.108 mycroft if (errstring) {
807 1.108 mycroft /*
808 1.108 mycroft * This probably happened because the drive's default
809 1.108 mycroft * geometry doesn't match the DOS geometry. We
810 1.108 mycroft * assume the DOS geometry is now in the label and try
811 1.108 mycroft * again. XXX This is a kluge.
812 1.108 mycroft */
813 1.181 bouyer if (wd->drvp->state > RECAL)
814 1.183 bouyer wd->drvp->drive_flags |= DRIVE_RESET;
815 1.181 bouyer errstring = readdisklabel(MAKEWDDEV(0, wd->sc_dev.dv_unit,
816 1.181 bouyer RAW_PART), wdstrategy, lp, wd->sc_dk.dk_cpulabel);
817 1.108 mycroft }
818 1.108 mycroft if (errstring) {
819 1.153 christos printf("%s: %s\n", wd->sc_dev.dv_xname, errstring);
820 1.108 mycroft return;
821 1.108 mycroft }
822 1.108 mycroft
823 1.181 bouyer if (wd->drvp->state > RECAL)
824 1.183 bouyer wd->drvp->drive_flags |= DRIVE_RESET;
825 1.170 leo #ifdef HAS_BAD144_HANDLING
826 1.142 mycroft if ((lp->d_flags & D_BADSECT) != 0)
827 1.108 mycroft bad144intern(wd);
828 1.170 leo #endif
829 1.108 mycroft }
830 1.108 mycroft
831 1.1 cgd int
832 1.163 bouyer wdioctl(dev, xfer, addr, flag, p)
833 1.55 mycroft dev_t dev;
834 1.163 bouyer u_long xfer;
835 1.55 mycroft caddr_t addr;
836 1.55 mycroft int flag;
837 1.55 mycroft struct proc *p;
838 1.1 cgd {
839 1.147 thorpej struct wd_softc *wd = wd_cd.cd_devs[WDUNIT(dev)];
840 1.54 mycroft int error;
841 1.163 bouyer
842 1.181 bouyer WDCDEBUG_PRINT(("wdioctl\n"), DEBUG_FUNCS);
843 1.163 bouyer
844 1.181 bouyer if ((wd->sc_flags & WDF_LOADED) == 0)
845 1.108 mycroft return EIO;
846 1.108 mycroft
847 1.163 bouyer switch (xfer) {
848 1.170 leo #ifdef HAS_BAD144_HANDLING
849 1.1 cgd case DIOCSBAD:
850 1.3 deraadt if ((flag & FWRITE) == 0)
851 1.54 mycroft return EBADF;
852 1.144 thorpej wd->sc_dk.dk_cpulabel->bad = *(struct dkbad *)addr;
853 1.144 thorpej wd->sc_dk.dk_label->d_flags |= D_BADSECT;
854 1.64 mycroft bad144intern(wd);
855 1.54 mycroft return 0;
856 1.170 leo #endif
857 1.1 cgd
858 1.1 cgd case DIOCGDINFO:
859 1.144 thorpej *(struct disklabel *)addr = *(wd->sc_dk.dk_label);
860 1.54 mycroft return 0;
861 1.3 deraadt
862 1.3 deraadt case DIOCGPART:
863 1.144 thorpej ((struct partinfo *)addr)->disklab = wd->sc_dk.dk_label;
864 1.3 deraadt ((struct partinfo *)addr)->part =
865 1.144 thorpej &wd->sc_dk.dk_label->d_partitions[WDPART(dev)];
866 1.54 mycroft return 0;
867 1.3 deraadt
868 1.132 mycroft case DIOCWDINFO:
869 1.3 deraadt case DIOCSDINFO:
870 1.3 deraadt if ((flag & FWRITE) == 0)
871 1.54 mycroft return EBADF;
872 1.132 mycroft
873 1.181 bouyer if ((error = wdlock(wd)) != 0)
874 1.132 mycroft return error;
875 1.181 bouyer wd->sc_flags |= WDF_LABELLING;
876 1.132 mycroft
877 1.144 thorpej error = setdisklabel(wd->sc_dk.dk_label,
878 1.128 mycroft (struct disklabel *)addr, /*wd->sc_dk.dk_openmask : */0,
879 1.144 thorpej wd->sc_dk.dk_cpulabel);
880 1.3 deraadt if (error == 0) {
881 1.181 bouyer if (wd->drvp->state > RECAL)
882 1.183 bouyer wd->drvp->drive_flags |= DRIVE_RESET;
883 1.163 bouyer if (xfer == DIOCWDINFO)
884 1.132 mycroft error = writedisklabel(WDLABELDEV(dev),
885 1.144 thorpej wdstrategy, wd->sc_dk.dk_label,
886 1.144 thorpej wd->sc_dk.dk_cpulabel);
887 1.1 cgd }
888 1.132 mycroft
889 1.181 bouyer wd->sc_flags &= ~WDF_LABELLING;
890 1.181 bouyer wdunlock(wd);
891 1.54 mycroft return error;
892 1.3 deraadt
893 1.44 mycroft case DIOCWLABEL:
894 1.3 deraadt if ((flag & FWRITE) == 0)
895 1.54 mycroft return EBADF;
896 1.93 mycroft if (*(int *)addr)
897 1.181 bouyer wd->sc_flags |= WDF_WLABEL;
898 1.93 mycroft else
899 1.181 bouyer wd->sc_flags &= ~WDF_WLABEL;
900 1.54 mycroft return 0;
901 1.164 thorpej
902 1.164 thorpej case DIOCGDEFLABEL:
903 1.164 thorpej wdgetdefaultlabel(wd, (struct disklabel *)addr);
904 1.164 thorpej return 0;
905 1.164 thorpej
906 1.1 cgd #ifdef notyet
907 1.1 cgd case DIOCWFORMAT:
908 1.1 cgd if ((flag & FWRITE) == 0)
909 1.54 mycroft return EBADF;
910 1.181 bouyer {
911 1.54 mycroft register struct format_op *fop;
912 1.54 mycroft struct iovec aiov;
913 1.54 mycroft struct uio auio;
914 1.181 bouyer
915 1.54 mycroft fop = (struct format_op *)addr;
916 1.54 mycroft aiov.iov_base = fop->df_buf;
917 1.54 mycroft aiov.iov_len = fop->df_count;
918 1.54 mycroft auio.uio_iov = &aiov;
919 1.54 mycroft auio.uio_iovcnt = 1;
920 1.54 mycroft auio.uio_resid = fop->df_count;
921 1.54 mycroft auio.uio_segflg = 0;
922 1.54 mycroft auio.uio_offset =
923 1.181 bouyer fop->df_startblk * wd->sc_dk.dk_label->d_secsize;
924 1.83 pk auio.uio_procp = p;
925 1.64 mycroft error = physio(wdformat, NULL, dev, B_WRITE, minphys,
926 1.64 mycroft &auio);
927 1.54 mycroft fop->df_count -= auio.uio_resid;
928 1.64 mycroft fop->df_reg[0] = wdc->sc_status;
929 1.64 mycroft fop->df_reg[1] = wdc->sc_error;
930 1.54 mycroft return error;
931 1.181 bouyer }
932 1.1 cgd #endif
933 1.185 kenh
934 1.186 kenh case ATAIOCCOMMAND:
935 1.185 kenh /*
936 1.185 kenh * Make sure this command is (relatively) safe first
937 1.185 kenh */
938 1.186 kenh if ((((atareq_t *) addr)->flags & ATACMD_READ) == 0 &&
939 1.185 kenh (flag & FWRITE) == 0)
940 1.185 kenh return (EBADF);
941 1.185 kenh {
942 1.185 kenh struct wd_ioctl *wi;
943 1.186 kenh atareq_t *atareq = (atareq_t *) addr;
944 1.185 kenh int error;
945 1.185 kenh
946 1.185 kenh wi = wi_get();
947 1.185 kenh wi->wi_softc = wd;
948 1.186 kenh wi->wi_atareq = *atareq;
949 1.185 kenh
950 1.186 kenh if (atareq->datalen && atareq->flags &
951 1.186 kenh (ATACMD_READ | ATACMD_WRITE)) {
952 1.186 kenh wi->wi_iov.iov_base = atareq->databuf;
953 1.186 kenh wi->wi_iov.iov_len = atareq->datalen;
954 1.185 kenh wi->wi_uio.uio_iov = &wi->wi_iov;
955 1.185 kenh wi->wi_uio.uio_iovcnt = 1;
956 1.186 kenh wi->wi_uio.uio_resid = atareq->datalen;
957 1.185 kenh wi->wi_uio.uio_offset = 0;
958 1.185 kenh wi->wi_uio.uio_segflg = UIO_USERSPACE;
959 1.185 kenh wi->wi_uio.uio_rw =
960 1.186 kenh (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE;
961 1.185 kenh wi->wi_uio.uio_procp = p;
962 1.185 kenh error = physio(wdioctlstrategy, &wi->wi_bp, dev,
963 1.186 kenh (atareq->flags & ATACMD_READ) ? B_READ : B_WRITE,
964 1.185 kenh minphys, &wi->wi_uio);
965 1.185 kenh } else {
966 1.185 kenh /* No need to call physio if we don't have any
967 1.185 kenh user data */
968 1.185 kenh wi->wi_bp.b_flags = 0;
969 1.185 kenh wi->wi_bp.b_data = 0;
970 1.185 kenh wi->wi_bp.b_bcount = 0;
971 1.185 kenh wi->wi_bp.b_dev = 0;
972 1.185 kenh wi->wi_bp.b_proc = p;
973 1.185 kenh wdioctlstrategy(&wi->wi_bp);
974 1.185 kenh error = wi->wi_bp.b_error;
975 1.185 kenh }
976 1.186 kenh *atareq = wi->wi_atareq;
977 1.185 kenh wi_free(wi);
978 1.185 kenh return(error);
979 1.185 kenh }
980 1.185 kenh
981 1.1 cgd default:
982 1.54 mycroft return ENOTTY;
983 1.1 cgd }
984 1.54 mycroft
985 1.54 mycroft #ifdef DIAGNOSTIC
986 1.54 mycroft panic("wdioctl: impossible");
987 1.54 mycroft #endif
988 1.1 cgd }
989 1.1 cgd
990 1.44 mycroft #ifdef B_FORMAT
991 1.1 cgd int
992 1.1 cgd wdformat(struct buf *bp)
993 1.1 cgd {
994 1.44 mycroft
995 1.1 cgd bp->b_flags |= B_FORMAT;
996 1.37 mycroft return wdstrategy(bp);
997 1.1 cgd }
998 1.1 cgd #endif
999 1.1 cgd
1000 1.1 cgd int
1001 1.55 mycroft wdsize(dev)
1002 1.55 mycroft dev_t dev;
1003 1.1 cgd {
1004 1.64 mycroft struct wd_softc *wd;
1005 1.158 pk int part, unit, omask;
1006 1.108 mycroft int size;
1007 1.163 bouyer
1008 1.181 bouyer WDCDEBUG_PRINT(("wdsize\n"), DEBUG_FUNCS);
1009 1.163 bouyer
1010 1.158 pk unit = WDUNIT(dev);
1011 1.158 pk if (unit >= wd_cd.cd_ndevs)
1012 1.158 pk return (-1);
1013 1.158 pk wd = wd_cd.cd_devs[unit];
1014 1.158 pk if (wd == NULL)
1015 1.158 pk return (-1);
1016 1.158 pk
1017 1.158 pk part = WDPART(dev);
1018 1.158 pk omask = wd->sc_dk.dk_openmask & (1 << part);
1019 1.158 pk
1020 1.158 pk if (omask == 0 && wdopen(dev, 0, S_IFBLK, NULL) != 0)
1021 1.158 pk return (-1);
1022 1.144 thorpej if (wd->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP)
1023 1.108 mycroft size = -1;
1024 1.108 mycroft else
1025 1.160 thorpej size = wd->sc_dk.dk_label->d_partitions[part].p_size *
1026 1.181 bouyer (wd->sc_dk.dk_label->d_secsize / DEV_BSIZE);
1027 1.158 pk if (omask == 0 && wdclose(dev, 0, S_IFBLK, NULL) != 0)
1028 1.158 pk return (-1);
1029 1.158 pk return (size);
1030 1.1 cgd }
1031 1.1 cgd
1032 1.140 cgd #ifndef __BDEVSW_DUMP_OLD_TYPE
1033 1.140 cgd /* #define WD_DUMP_NOT_TRUSTED if you just want to watch */
1034 1.181 bouyer static int wddoingadump = 0;
1035 1.181 bouyer static int wddumprecalibrated = 0;
1036 1.181 bouyer static int wddumpmulti = 1;
1037 1.140 cgd
1038 1.64 mycroft /*
1039 1.64 mycroft * Dump core after a system crash.
1040 1.64 mycroft */
1041 1.1 cgd int
1042 1.140 cgd wddump(dev, blkno, va, size)
1043 1.181 bouyer dev_t dev;
1044 1.181 bouyer daddr_t blkno;
1045 1.181 bouyer caddr_t va;
1046 1.181 bouyer size_t size;
1047 1.140 cgd {
1048 1.140 cgd struct wd_softc *wd; /* disk unit to do the I/O */
1049 1.181 bouyer struct disklabel *lp; /* disk's disklabel */
1050 1.181 bouyer int unit, part;
1051 1.181 bouyer int nblks; /* total number of sectors left to write */
1052 1.181 bouyer int err;
1053 1.181 bouyer char errbuf[256];
1054 1.140 cgd
1055 1.140 cgd /* Check if recursive dump; if so, punt. */
1056 1.116 mycroft if (wddoingadump)
1057 1.116 mycroft return EFAULT;
1058 1.142 mycroft wddoingadump = 1;
1059 1.140 cgd
1060 1.142 mycroft unit = WDUNIT(dev);
1061 1.147 thorpej if (unit >= wd_cd.cd_ndevs)
1062 1.142 mycroft return ENXIO;
1063 1.147 thorpej wd = wd_cd.cd_devs[unit];
1064 1.163 bouyer if (wd == (struct wd_softc *)0)
1065 1.142 mycroft return ENXIO;
1066 1.60 mycroft
1067 1.140 cgd part = WDPART(dev);
1068 1.140 cgd
1069 1.140 cgd /* Make sure it was initialized. */
1070 1.181 bouyer if (wd->drvp->state < READY)
1071 1.37 mycroft return ENXIO;
1072 1.140 cgd
1073 1.181 bouyer /* Convert to disk sectors. Request must be a multiple of size. */
1074 1.144 thorpej lp = wd->sc_dk.dk_label;
1075 1.142 mycroft if ((size % lp->d_secsize) != 0)
1076 1.140 cgd return EFAULT;
1077 1.142 mycroft nblks = size / lp->d_secsize;
1078 1.142 mycroft blkno = blkno / (lp->d_secsize / DEV_BSIZE);
1079 1.116 mycroft
1080 1.64 mycroft /* Check transfer bounds against partition size. */
1081 1.142 mycroft if ((blkno < 0) || ((blkno + nblks) > lp->d_partitions[part].p_size))
1082 1.140 cgd return EINVAL;
1083 1.140 cgd
1084 1.140 cgd /* Offset block number to start of partition. */
1085 1.142 mycroft blkno += lp->d_partitions[part].p_offset;
1086 1.60 mycroft
1087 1.140 cgd /* Recalibrate, if first dump transfer. */
1088 1.140 cgd if (wddumprecalibrated == 0) {
1089 1.181 bouyer wddumpmulti = wd->sc_multi;
1090 1.140 cgd wddumprecalibrated = 1;
1091 1.181 bouyer wd->drvp->state = RECAL;
1092 1.63 mycroft }
1093 1.181 bouyer
1094 1.142 mycroft while (nblks > 0) {
1095 1.181 bouyer again:
1096 1.181 bouyer wd->sc_wdc_bio.blkno = blkno;
1097 1.181 bouyer wd->sc_wdc_bio.flags = ATA_POLL;
1098 1.181 bouyer if (wddumpmulti == 1)
1099 1.181 bouyer wd->sc_wdc_bio.flags |= ATA_SINGLE;
1100 1.181 bouyer if (wd->sc_flags & WDF_LBA)
1101 1.181 bouyer wd->sc_wdc_bio.flags |= ATA_LBA;
1102 1.181 bouyer wd->sc_wdc_bio.bcount =
1103 1.181 bouyer min(nblks, wddumpmulti) * lp->d_secsize;
1104 1.181 bouyer wd->sc_wdc_bio.databuf = va;
1105 1.181 bouyer #ifndef WD_DUMP_NOT_TRUSTED
1106 1.181 bouyer switch (wdc_ata_bio(wd->drvp, &wd->sc_wdc_bio)) {
1107 1.181 bouyer case WDC_TRY_AGAIN:
1108 1.181 bouyer panic("wddump: try again");
1109 1.181 bouyer break;
1110 1.181 bouyer case WDC_QUEUED:
1111 1.181 bouyer panic("wddump: polled command has been queued");
1112 1.181 bouyer break;
1113 1.181 bouyer case WDC_COMPLETE:
1114 1.181 bouyer break;
1115 1.116 mycroft }
1116 1.181 bouyer switch(wd->sc_wdc_bio.error) {
1117 1.181 bouyer case TIMEOUT:
1118 1.181 bouyer printf("wddump: device timed out");
1119 1.181 bouyer err = EIO;
1120 1.181 bouyer break;
1121 1.181 bouyer case ERR_DF:
1122 1.181 bouyer printf("wddump: drive fault");
1123 1.181 bouyer err = EIO;
1124 1.181 bouyer break;
1125 1.181 bouyer case ERR_DMA:
1126 1.181 bouyer printf("wddump: DMA error");
1127 1.181 bouyer err = EIO;
1128 1.181 bouyer break;
1129 1.181 bouyer case ERROR:
1130 1.181 bouyer errbuf[0] = '\0';
1131 1.190 bouyer ata_perror(wd->drvp, wd->sc_wdc_bio.r_error, errbuf);
1132 1.181 bouyer printf("wddump: %s", errbuf);
1133 1.181 bouyer err = EIO;
1134 1.181 bouyer break;
1135 1.181 bouyer case NOERROR:
1136 1.181 bouyer err = 0;
1137 1.181 bouyer break;
1138 1.181 bouyer default:
1139 1.181 bouyer panic("wddump: unknown error type");
1140 1.3 deraadt }
1141 1.181 bouyer if (err != 0) {
1142 1.181 bouyer if (wddumpmulti != 1) {
1143 1.181 bouyer wddumpmulti = 1; /* retry in single-sector */
1144 1.181 bouyer printf(", retrying\n");
1145 1.181 bouyer goto again;
1146 1.181 bouyer }
1147 1.181 bouyer printf("\n");
1148 1.181 bouyer return err;
1149 1.63 mycroft }
1150 1.140 cgd #else /* WD_DUMP_NOT_TRUSTED */
1151 1.140 cgd /* Let's just talk about this first... */
1152 1.153 christos printf("wd%d: dump addr 0x%x, cylin %d, head %d, sector %d\n",
1153 1.140 cgd unit, va, cylin, head, sector);
1154 1.140 cgd delay(500 * 1000); /* half a second */
1155 1.140 cgd #endif
1156 1.1 cgd
1157 1.140 cgd /* update block count */
1158 1.181 bouyer nblks -= min(nblks, wddumpmulti);
1159 1.181 bouyer blkno += min(nblks, wddumpmulti);
1160 1.181 bouyer va += min(nblks, wddumpmulti) * lp->d_secsize;
1161 1.1 cgd }
1162 1.142 mycroft
1163 1.140 cgd wddoingadump = 0;
1164 1.140 cgd return 0;
1165 1.140 cgd }
1166 1.140 cgd #else /* __BDEVSW_DUMP_NEW_TYPE */
1167 1.163 bouyer
1168 1.163 bouyer
1169 1.140 cgd int
1170 1.140 cgd wddump(dev, blkno, va, size)
1171 1.181 bouyer dev_t dev;
1172 1.181 bouyer daddr_t blkno;
1173 1.181 bouyer caddr_t va;
1174 1.181 bouyer size_t size;
1175 1.140 cgd {
1176 1.116 mycroft
1177 1.140 cgd /* Not implemented. */
1178 1.140 cgd return ENXIO;
1179 1.1 cgd }
1180 1.140 cgd #endif /* __BDEVSW_DUMP_NEW_TYPE */
1181 1.3 deraadt
1182 1.170 leo #ifdef HAS_BAD144_HANDLING
1183 1.3 deraadt /*
1184 1.3 deraadt * Internalize the bad sector table.
1185 1.3 deraadt */
1186 1.3 deraadt void
1187 1.64 mycroft bad144intern(wd)
1188 1.64 mycroft struct wd_softc *wd;
1189 1.3 deraadt {
1190 1.144 thorpej struct dkbad *bt = &wd->sc_dk.dk_cpulabel->bad;
1191 1.144 thorpej struct disklabel *lp = wd->sc_dk.dk_label;
1192 1.98 mycroft int i = 0;
1193 1.55 mycroft
1194 1.182 bouyer WDCDEBUG_PRINT(("bad144intern\n"), DEBUG_XFERS);
1195 1.163 bouyer
1196 1.170 leo for (; i < NBT_BAD; i++) {
1197 1.98 mycroft if (bt->bt_bad[i].bt_cyl == 0xffff)
1198 1.55 mycroft break;
1199 1.181 bouyer wd->sc_badsect[i] =
1200 1.98 mycroft bt->bt_bad[i].bt_cyl * lp->d_secpercyl +
1201 1.98 mycroft (bt->bt_bad[i].bt_trksec >> 8) * lp->d_nsectors +
1202 1.98 mycroft (bt->bt_bad[i].bt_trksec & 0xff);
1203 1.3 deraadt }
1204 1.170 leo for (; i < NBT_BAD+1; i++)
1205 1.181 bouyer wd->sc_badsect[i] = -1;
1206 1.64 mycroft }
1207 1.170 leo #endif
1208 1.64 mycroft
1209 1.181 bouyer int
1210 1.181 bouyer wd_get_params(wd, flags, params)
1211 1.181 bouyer struct wd_softc *wd;
1212 1.181 bouyer u_int8_t flags;
1213 1.181 bouyer struct ataparams *params;
1214 1.63 mycroft {
1215 1.181 bouyer switch (ata_get_params(wd->drvp, flags, params)) {
1216 1.181 bouyer case CMD_AGAIN:
1217 1.181 bouyer return 1;
1218 1.181 bouyer case CMD_ERR:
1219 1.181 bouyer /*
1220 1.181 bouyer * We `know' there's a drive here; just assume it's old.
1221 1.181 bouyer * This geometry is only used to read the MBR and print a
1222 1.181 bouyer * (false) attach message.
1223 1.181 bouyer */
1224 1.181 bouyer strncpy(params->atap_model, "ST506",
1225 1.181 bouyer sizeof params->atap_model);
1226 1.181 bouyer params->atap_config = ATA_CFG_FIXED;
1227 1.181 bouyer params->atap_cylinders = 1024;
1228 1.181 bouyer params->atap_heads = 8;
1229 1.181 bouyer params->atap_sectors = 17;
1230 1.181 bouyer params->atap_multi = 1;
1231 1.181 bouyer params->atap_capabilities1 = params->atap_capabilities2 = 0;
1232 1.190 bouyer wd->drvp->ata_vers = -1; /* Mark it as pre-ATA */
1233 1.181 bouyer return 0;
1234 1.181 bouyer case CMD_OK:
1235 1.181 bouyer return 0;
1236 1.181 bouyer default:
1237 1.181 bouyer panic("wd_get_params: bad return code from ata_get_params");
1238 1.181 bouyer /* NOTREACHED */
1239 1.181 bouyer }
1240 1.190 bouyer }
1241 1.190 bouyer
1242 1.190 bouyer void
1243 1.190 bouyer wd_flushcache(wd, flags)
1244 1.190 bouyer struct wd_softc *wd;
1245 1.190 bouyer int flags;
1246 1.190 bouyer {
1247 1.190 bouyer struct wdc_command wdc_c;
1248 1.190 bouyer
1249 1.190 bouyer if (wd->drvp->ata_vers < 4) /* WDCC_FLUSHCACHE is here since ATA-4 */
1250 1.190 bouyer return;
1251 1.190 bouyer memset(&wdc_c, 0, sizeof(struct wdc_command));
1252 1.190 bouyer wdc_c.r_command = WDCC_FLUSHCACHE;
1253 1.190 bouyer wdc_c.r_st_bmask = WDCS_DRDY;
1254 1.190 bouyer wdc_c.r_st_pmask = WDCS_DRDY;
1255 1.190 bouyer wdc_c.flags = flags | AT_WAIT;
1256 1.190 bouyer wdc_c.timeout = 30000; /* 30s timeout */
1257 1.190 bouyer if (wdc_exec_command(wd->drvp, &wdc_c) != WDC_COMPLETE) {
1258 1.190 bouyer printf("%s: flush cache command didn't complete\n",
1259 1.190 bouyer wd->sc_dev.dv_xname);
1260 1.190 bouyer }
1261 1.190 bouyer if (wdc_c.flags & AT_TIMEOU) {
1262 1.190 bouyer printf("%s: flush cache command timeout\n",
1263 1.190 bouyer wd->sc_dev.dv_xname);
1264 1.190 bouyer }
1265 1.190 bouyer if (wdc_c.flags & AT_DF) {
1266 1.190 bouyer printf("%s: flush cache command: drive fault\n",
1267 1.190 bouyer wd->sc_dev.dv_xname);
1268 1.190 bouyer }
1269 1.190 bouyer /*
1270 1.190 bouyer * Ignore error register, it shouldn't report anything else
1271 1.190 bouyer * than COMMAND ABORTED, which means the device doesn't support
1272 1.190 bouyer * flush cache
1273 1.190 bouyer */
1274 1.190 bouyer }
1275 1.190 bouyer
1276 1.190 bouyer void
1277 1.190 bouyer wd_shutdown(arg)
1278 1.190 bouyer void *arg;
1279 1.190 bouyer {
1280 1.190 bouyer struct wd_softc *wd = arg;
1281 1.190 bouyer wd_flushcache(wd, ATA_POLL);
1282 1.185 kenh }
1283 1.185 kenh
1284 1.185 kenh /*
1285 1.185 kenh * Allocate space for a ioctl queue structure. Mostly taken from
1286 1.185 kenh * scsipi_ioctl.c
1287 1.185 kenh */
1288 1.185 kenh struct wd_ioctl *
1289 1.185 kenh wi_get()
1290 1.185 kenh {
1291 1.185 kenh struct wd_ioctl *wi;
1292 1.185 kenh int s;
1293 1.185 kenh
1294 1.185 kenh wi = malloc(sizeof(struct wd_ioctl), M_TEMP, M_WAITOK);
1295 1.185 kenh memset(wi, 0, sizeof (struct wd_ioctl));
1296 1.185 kenh s = splbio();
1297 1.185 kenh LIST_INSERT_HEAD(&wi_head, wi, wi_list);
1298 1.185 kenh splx(s);
1299 1.185 kenh return (wi);
1300 1.185 kenh }
1301 1.185 kenh
1302 1.185 kenh /*
1303 1.185 kenh * Free an ioctl structure and remove it from our list
1304 1.185 kenh */
1305 1.185 kenh
1306 1.185 kenh void
1307 1.185 kenh wi_free(wi)
1308 1.185 kenh struct wd_ioctl *wi;
1309 1.185 kenh {
1310 1.185 kenh int s;
1311 1.185 kenh
1312 1.185 kenh s = splbio();
1313 1.185 kenh LIST_REMOVE(wi, wi_list);
1314 1.185 kenh splx(s);
1315 1.185 kenh free(wi, M_TEMP);
1316 1.185 kenh }
1317 1.185 kenh
1318 1.185 kenh /*
1319 1.185 kenh * Find a wd_ioctl structure based on the struct buf.
1320 1.185 kenh */
1321 1.185 kenh
1322 1.185 kenh struct wd_ioctl *
1323 1.185 kenh wi_find(bp)
1324 1.185 kenh struct buf *bp;
1325 1.185 kenh {
1326 1.185 kenh struct wd_ioctl *wi;
1327 1.185 kenh int s;
1328 1.185 kenh
1329 1.185 kenh s = splbio();
1330 1.185 kenh for (wi = wi_head.lh_first; wi != 0; wi = wi->wi_list.le_next)
1331 1.185 kenh if (bp == &wi->wi_bp)
1332 1.185 kenh break;
1333 1.185 kenh splx(s);
1334 1.185 kenh return (wi);
1335 1.185 kenh }
1336 1.185 kenh
1337 1.185 kenh /*
1338 1.185 kenh * Ioctl pseudo strategy routine
1339 1.185 kenh *
1340 1.185 kenh * This is mostly stolen from scsipi_ioctl.c:scsistrategy(). What
1341 1.185 kenh * happens here is:
1342 1.185 kenh *
1343 1.185 kenh * - wdioctl() queues a wd_ioctl structure.
1344 1.185 kenh *
1345 1.185 kenh * - wdioctl() calls physio/wdioctlstrategy based on whether or not
1346 1.185 kenh * user space I/O is required. If physio() is called, physio() eventually
1347 1.185 kenh * calls wdioctlstrategy().
1348 1.185 kenh *
1349 1.185 kenh * - In either case, wdioctlstrategy() calls wdc_exec_command()
1350 1.185 kenh * to perform the actual command
1351 1.185 kenh *
1352 1.185 kenh * The reason for the use of the pseudo strategy routine is because
1353 1.185 kenh * when doing I/O to/from user space, physio _really_ wants to be in
1354 1.185 kenh * the loop. We could put the entire buffer into the ioctl request
1355 1.185 kenh * structure, but that won't scale if we want to do things like download
1356 1.185 kenh * microcode.
1357 1.185 kenh */
1358 1.185 kenh
1359 1.185 kenh void
1360 1.185 kenh wdioctlstrategy(bp)
1361 1.185 kenh struct buf *bp;
1362 1.185 kenh {
1363 1.185 kenh struct wd_ioctl *wi;
1364 1.185 kenh struct wdc_command wdc_c;
1365 1.185 kenh int error = 0;
1366 1.185 kenh
1367 1.185 kenh wi = wi_find(bp);
1368 1.185 kenh if (wi == NULL) {
1369 1.185 kenh printf("user_strat: No ioctl\n");
1370 1.185 kenh error = EINVAL;
1371 1.185 kenh goto bad;
1372 1.185 kenh }
1373 1.185 kenh
1374 1.185 kenh memset(&wdc_c, 0, sizeof(wdc_c));
1375 1.185 kenh
1376 1.185 kenh /*
1377 1.185 kenh * Abort if physio broke up the transfer
1378 1.185 kenh */
1379 1.185 kenh
1380 1.186 kenh if (bp->b_bcount != wi->wi_atareq.datalen) {
1381 1.185 kenh printf("physio split wd ioctl request... cannot proceed\n");
1382 1.185 kenh error = EIO;
1383 1.185 kenh goto bad;
1384 1.185 kenh }
1385 1.185 kenh
1386 1.185 kenh /*
1387 1.185 kenh * Abort if we didn't get a buffer size that was a multiple of
1388 1.185 kenh * our sector size (or was larger than NBBY)
1389 1.185 kenh */
1390 1.185 kenh
1391 1.185 kenh if ((bp->b_bcount % wi->wi_softc->sc_dk.dk_label->d_secsize) != 0 ||
1392 1.185 kenh (bp->b_bcount / wi->wi_softc->sc_dk.dk_label->d_secsize) >=
1393 1.185 kenh (1 << NBBY)) {
1394 1.185 kenh error = EINVAL;
1395 1.185 kenh goto bad;
1396 1.185 kenh }
1397 1.185 kenh
1398 1.185 kenh /*
1399 1.185 kenh * Make sure a timeout was supplied in the ioctl request
1400 1.185 kenh */
1401 1.185 kenh
1402 1.186 kenh if (wi->wi_atareq.timeout == 0) {
1403 1.185 kenh error = EINVAL;
1404 1.185 kenh goto bad;
1405 1.185 kenh }
1406 1.185 kenh
1407 1.186 kenh if (wi->wi_atareq.flags & ATACMD_READ)
1408 1.185 kenh wdc_c.flags |= AT_READ;
1409 1.186 kenh else if (wi->wi_atareq.flags & ATACMD_WRITE)
1410 1.185 kenh wdc_c.flags |= AT_WRITE;
1411 1.185 kenh
1412 1.188 kenh if (wi->wi_atareq.flags & ATACMD_READREG)
1413 1.188 kenh wdc_c.flags |= AT_READREG;
1414 1.188 kenh
1415 1.185 kenh wdc_c.flags |= AT_WAIT;
1416 1.185 kenh
1417 1.186 kenh wdc_c.timeout = wi->wi_atareq.timeout;
1418 1.186 kenh wdc_c.r_command = wi->wi_atareq.command;
1419 1.186 kenh wdc_c.r_head = wi->wi_atareq.head & 0x0f;
1420 1.186 kenh wdc_c.r_cyl = wi->wi_atareq.cylinder;
1421 1.186 kenh wdc_c.r_sector = wi->wi_atareq.sec_num;
1422 1.186 kenh wdc_c.r_count = wi->wi_atareq.sec_count;
1423 1.186 kenh wdc_c.r_precomp = wi->wi_atareq.features;
1424 1.185 kenh wdc_c.r_st_bmask = WDCS_DRDY;
1425 1.185 kenh wdc_c.r_st_pmask = WDCS_DRDY;
1426 1.185 kenh wdc_c.data = wi->wi_bp.b_data;
1427 1.185 kenh wdc_c.bcount = wi->wi_bp.b_bcount;
1428 1.185 kenh
1429 1.185 kenh if (wdc_exec_command(wi->wi_softc->drvp, &wdc_c) != WDC_COMPLETE) {
1430 1.186 kenh wi->wi_atareq.retsts = ATACMD_ERROR;
1431 1.185 kenh goto bad;
1432 1.185 kenh }
1433 1.185 kenh
1434 1.185 kenh if (wdc_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
1435 1.185 kenh if (wdc_c.flags & AT_ERROR) {
1436 1.186 kenh wi->wi_atareq.retsts = ATACMD_ERROR;
1437 1.186 kenh wi->wi_atareq.error = wdc_c.r_error;
1438 1.185 kenh } else if (wdc_c.flags & AT_DF)
1439 1.186 kenh wi->wi_atareq.retsts = ATACMD_DF;
1440 1.185 kenh else
1441 1.186 kenh wi->wi_atareq.retsts = ATACMD_TIMEOUT;
1442 1.188 kenh } else {
1443 1.186 kenh wi->wi_atareq.retsts = ATACMD_OK;
1444 1.188 kenh if (wi->wi_atareq.flags & ATACMD_READREG) {
1445 1.188 kenh wi->wi_atareq.head = wdc_c.r_head ;
1446 1.188 kenh wi->wi_atareq.cylinder = wdc_c.r_cyl;
1447 1.188 kenh wi->wi_atareq.sec_num = wdc_c.r_sector;
1448 1.188 kenh wi->wi_atareq.sec_count = wdc_c.r_count;
1449 1.188 kenh wi->wi_atareq.features = wdc_c.r_precomp;
1450 1.188 kenh wi->wi_atareq.error = wdc_c.r_error;
1451 1.188 kenh }
1452 1.188 kenh }
1453 1.185 kenh
1454 1.185 kenh bp->b_error = 0;
1455 1.185 kenh biodone(bp);
1456 1.185 kenh return;
1457 1.185 kenh bad:
1458 1.185 kenh bp->b_flags |= B_ERROR;
1459 1.185 kenh bp->b_error = error;
1460 1.185 kenh biodone(bp);
1461 1.21 deraadt }
1462