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