wdc.c revision 1.252 1 1.252 dyoung /* $NetBSD: wdc.c,v 1.252 2008/01/28 18:17:05 dyoung Exp $ */
2 1.31 bouyer
3 1.31 bouyer /*
4 1.137 bouyer * Copyright (c) 1998, 2001, 2003 Manuel Bouyer. All rights reserved.
5 1.31 bouyer *
6 1.31 bouyer * Redistribution and use in source and binary forms, with or without
7 1.31 bouyer * modification, are permitted provided that the following conditions
8 1.31 bouyer * are met:
9 1.31 bouyer * 1. Redistributions of source code must retain the above copyright
10 1.31 bouyer * notice, this list of conditions and the following disclaimer.
11 1.31 bouyer * 2. Redistributions in binary form must reproduce the above copyright
12 1.31 bouyer * notice, this list of conditions and the following disclaimer in the
13 1.31 bouyer * documentation and/or other materials provided with the distribution.
14 1.31 bouyer * 3. All advertising materials mentioning features or use of this software
15 1.31 bouyer * must display the following acknowledgement:
16 1.31 bouyer * This product includes software developed by Manuel Bouyer.
17 1.31 bouyer * 4. The name of the author may not be used to endorse or promote products
18 1.31 bouyer * derived from this software without specific prior written permission.
19 1.31 bouyer *
20 1.31 bouyer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 1.31 bouyer * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22 1.31 bouyer * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23 1.31 bouyer * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 1.31 bouyer * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 1.31 bouyer * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 1.31 bouyer * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27 1.31 bouyer * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 1.31 bouyer * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 1.31 bouyer * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 1.31 bouyer */
31 1.2 bouyer
32 1.27 mycroft /*-
33 1.220 mycroft * Copyright (c) 1998, 2003, 2004 The NetBSD Foundation, Inc.
34 1.27 mycroft * All rights reserved.
35 1.2 bouyer *
36 1.27 mycroft * This code is derived from software contributed to The NetBSD Foundation
37 1.27 mycroft * by Charles M. Hannum, by Onno van der Linden and by Manuel Bouyer.
38 1.12 cgd *
39 1.2 bouyer * Redistribution and use in source and binary forms, with or without
40 1.2 bouyer * modification, are permitted provided that the following conditions
41 1.2 bouyer * are met:
42 1.2 bouyer * 1. Redistributions of source code must retain the above copyright
43 1.2 bouyer * notice, this list of conditions and the following disclaimer.
44 1.2 bouyer * 2. Redistributions in binary form must reproduce the above copyright
45 1.2 bouyer * notice, this list of conditions and the following disclaimer in the
46 1.2 bouyer * documentation and/or other materials provided with the distribution.
47 1.2 bouyer * 3. All advertising materials mentioning features or use of this software
48 1.2 bouyer * must display the following acknowledgement:
49 1.27 mycroft * This product includes software developed by the NetBSD
50 1.27 mycroft * Foundation, Inc. and its contributors.
51 1.27 mycroft * 4. Neither the name of The NetBSD Foundation nor the names of its
52 1.27 mycroft * contributors may be used to endorse or promote products derived
53 1.27 mycroft * from this software without specific prior written permission.
54 1.2 bouyer *
55 1.27 mycroft * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
56 1.27 mycroft * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
57 1.27 mycroft * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
58 1.27 mycroft * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
59 1.27 mycroft * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
60 1.27 mycroft * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
61 1.27 mycroft * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
62 1.27 mycroft * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
63 1.27 mycroft * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
64 1.27 mycroft * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
65 1.27 mycroft * POSSIBILITY OF SUCH DAMAGE.
66 1.2 bouyer */
67 1.2 bouyer
68 1.12 cgd /*
69 1.12 cgd * CODE UNTESTED IN THE CURRENT REVISION:
70 1.12 cgd */
71 1.100 lukem
72 1.100 lukem #include <sys/cdefs.h>
73 1.252 dyoung __KERNEL_RCSID(0, "$NetBSD: wdc.c,v 1.252 2008/01/28 18:17:05 dyoung Exp $");
74 1.12 cgd
75 1.247 dyoung #include "opt_ata.h"
76 1.31 bouyer
77 1.2 bouyer #include <sys/param.h>
78 1.2 bouyer #include <sys/systm.h>
79 1.2 bouyer #include <sys/kernel.h>
80 1.2 bouyer #include <sys/conf.h>
81 1.2 bouyer #include <sys/buf.h>
82 1.31 bouyer #include <sys/device.h>
83 1.2 bouyer #include <sys/malloc.h>
84 1.2 bouyer #include <sys/syslog.h>
85 1.2 bouyer #include <sys/proc.h>
86 1.2 bouyer
87 1.249 ad #include <sys/intr.h>
88 1.249 ad #include <sys/bus.h>
89 1.2 bouyer
90 1.17 sakamoto #ifndef __BUS_SPACE_HAS_STREAM_METHODS
91 1.31 bouyer #define bus_space_write_multi_stream_2 bus_space_write_multi_2
92 1.31 bouyer #define bus_space_write_multi_stream_4 bus_space_write_multi_4
93 1.31 bouyer #define bus_space_read_multi_stream_2 bus_space_read_multi_2
94 1.31 bouyer #define bus_space_read_multi_stream_4 bus_space_read_multi_4
95 1.246 sborrill #define bus_space_read_stream_2 bus_space_read_2
96 1.246 sborrill #define bus_space_read_stream_4 bus_space_read_4
97 1.246 sborrill #define bus_space_write_stream_2 bus_space_write_2
98 1.246 sborrill #define bus_space_write_stream_4 bus_space_write_4
99 1.17 sakamoto #endif /* __BUS_SPACE_HAS_STREAM_METHODS */
100 1.16 sakamoto
101 1.103 bouyer #include <dev/ata/atavar.h>
102 1.31 bouyer #include <dev/ata/atareg.h>
103 1.239 bouyer #include <dev/ata/satareg.h>
104 1.239 bouyer #include <dev/ata/satavar.h>
105 1.12 cgd #include <dev/ic/wdcreg.h>
106 1.12 cgd #include <dev/ic/wdcvar.h>
107 1.31 bouyer
108 1.137 bouyer #include "locators.h"
109 1.137 bouyer
110 1.2 bouyer #include "atapibus.h"
111 1.106 bouyer #include "wd.h"
112 1.240 bouyer #include "sata.h"
113 1.2 bouyer
114 1.31 bouyer #define WDCDELAY 100 /* 100 microseconds */
115 1.31 bouyer #define WDCNDELAY_RST (WDC_RESET_WAIT * 1000 / WDCDELAY)
116 1.2 bouyer #if 0
117 1.31 bouyer /* If you enable this, it will report any delays more than WDCDELAY * N long. */
118 1.2 bouyer #define WDCNDELAY_DEBUG 50
119 1.2 bouyer #endif
120 1.2 bouyer
121 1.137 bouyer /* When polling wait that much and then tsleep for 1/hz seconds */
122 1.219 perry #define WDCDELAY_POLL 1 /* ms */
123 1.137 bouyer
124 1.137 bouyer /* timeout for the control commands */
125 1.137 bouyer #define WDC_CTRL_DELAY 10000 /* 10s, for the recall command */
126 1.137 bouyer
127 1.224 bouyer /*
128 1.224 bouyer * timeout when waiting for BSY to deassert when probing.
129 1.224 bouyer * set to 5s. From the standards this could be up to 31, but we can't
130 1.224 bouyer * wait that much at boot time, and 5s seems to be enouth.
131 1.224 bouyer */
132 1.224 bouyer #define WDC_PROBE_WAIT 5
133 1.224 bouyer
134 1.224 bouyer
135 1.106 bouyer #if NWD > 0
136 1.103 bouyer extern const struct ata_bustype wdc_ata_bustype; /* in ata_wdc.c */
137 1.106 bouyer #else
138 1.106 bouyer /* A fake one, the autoconfig will print "wd at foo ... not configured */
139 1.106 bouyer const struct ata_bustype wdc_ata_bustype = {
140 1.106 bouyer SCSIPI_BUSTYPE_ATA,
141 1.214 enami NULL, /* wdc_ata_bio */
142 1.214 enami NULL, /* wdc_reset_drive */
143 1.214 enami wdc_reset_channel,
144 1.214 enami wdc_exec_command,
145 1.214 enami NULL, /* ata_get_params */
146 1.214 enami NULL, /* wdc_ata_addref */
147 1.214 enami NULL, /* wdc_ata_delref */
148 1.214 enami NULL /* ata_kill_pending */
149 1.106 bouyer };
150 1.106 bouyer #endif
151 1.102 bouyer
152 1.213 thorpej /* Flags to wdcreset(). */
153 1.213 thorpej #define RESET_POLL 1
154 1.213 thorpej #define RESET_SLEEP 0 /* wdcreset() will use tsleep() */
155 1.213 thorpej
156 1.213 thorpej static int wdcprobe1(struct ata_channel *, int);
157 1.213 thorpej static int wdcreset(struct ata_channel *, int);
158 1.222 christos static void __wdcerror(struct ata_channel *, const char *);
159 1.205 thorpej static int __wdcwait_reset(struct ata_channel *, int, int);
160 1.205 thorpej static void __wdccommand_done(struct ata_channel *, struct ata_xfer *);
161 1.205 thorpej static void __wdccommand_done_end(struct ata_channel *, struct ata_xfer *);
162 1.205 thorpej static void __wdccommand_kill_xfer(struct ata_channel *,
163 1.182 bouyer struct ata_xfer *, int);
164 1.205 thorpej static void __wdccommand_start(struct ata_channel *, struct ata_xfer *);
165 1.205 thorpej static int __wdccommand_intr(struct ata_channel *, struct ata_xfer *, int);
166 1.205 thorpej static int __wdcwait(struct ata_channel *, int, int, int);
167 1.31 bouyer
168 1.213 thorpej static void wdc_datain_pio(struct ata_channel *, int, void *, size_t);
169 1.213 thorpej static void wdc_dataout_pio(struct ata_channel *, int, void *, size_t);
170 1.213 thorpej
171 1.31 bouyer #define DEBUG_INTR 0x01
172 1.31 bouyer #define DEBUG_XFERS 0x02
173 1.31 bouyer #define DEBUG_STATUS 0x04
174 1.31 bouyer #define DEBUG_FUNCS 0x08
175 1.31 bouyer #define DEBUG_PROBE 0x10
176 1.74 enami #define DEBUG_DETACH 0x20
177 1.87 bouyer #define DEBUG_DELAY 0x40
178 1.204 thorpej #ifdef ATADEBUG
179 1.204 thorpej extern int atadebug_mask; /* init'ed in ata.c */
180 1.31 bouyer int wdc_nxfer = 0;
181 1.204 thorpej #define ATADEBUG_PRINT(args, level) if (atadebug_mask & (level)) printf args
182 1.2 bouyer #else
183 1.204 thorpej #define ATADEBUG_PRINT(args, level)
184 1.2 bouyer #endif
185 1.2 bouyer
186 1.162 thorpej /*
187 1.176 thorpej * Initialize the "shadow register" handles for a standard wdc controller.
188 1.176 thorpej */
189 1.176 thorpej void
190 1.205 thorpej wdc_init_shadow_regs(struct ata_channel *chp)
191 1.176 thorpej {
192 1.206 thorpej struct wdc_regs *wdr = CHAN_TO_WDC_REGS(chp);
193 1.176 thorpej
194 1.205 thorpej wdr->cmd_iohs[wd_status] = wdr->cmd_iohs[wd_command];
195 1.205 thorpej wdr->cmd_iohs[wd_features] = wdr->cmd_iohs[wd_error];
196 1.205 thorpej }
197 1.205 thorpej
198 1.205 thorpej /*
199 1.205 thorpej * Allocate a wdc_regs array, based on the number of channels.
200 1.205 thorpej */
201 1.205 thorpej void
202 1.205 thorpej wdc_allocate_regs(struct wdc_softc *wdc)
203 1.205 thorpej {
204 1.205 thorpej
205 1.207 thorpej wdc->regs = malloc(wdc->sc_atac.atac_nchannels *
206 1.207 thorpej sizeof(struct wdc_regs), M_DEVBUF, M_WAITOK);
207 1.176 thorpej }
208 1.176 thorpej
209 1.240 bouyer #if NSATA > 0
210 1.239 bouyer /*
211 1.239 bouyer * probe drives on SATA controllers with standard SATA registers:
212 1.239 bouyer * bring the PHYs online, read the drive signature and set drive flags
213 1.239 bouyer * appropriately.
214 1.239 bouyer */
215 1.239 bouyer void
216 1.239 bouyer wdc_sataprobe(struct ata_channel *chp)
217 1.239 bouyer {
218 1.239 bouyer struct wdc_regs *wdr = CHAN_TO_WDC_REGS(chp);
219 1.239 bouyer uint16_t scnt, sn, cl, ch;
220 1.239 bouyer int i, s;
221 1.239 bouyer
222 1.239 bouyer /* XXX This should be done by other code. */
223 1.239 bouyer for (i = 0; i < chp->ch_ndrive; i++) {
224 1.239 bouyer chp->ch_drive[i].chnl_softc = chp;
225 1.239 bouyer chp->ch_drive[i].drive = i;
226 1.239 bouyer }
227 1.239 bouyer
228 1.242 bouyer /* reset the PHY and bring online */
229 1.242 bouyer switch (sata_reset_interface(chp, wdr->sata_iot, wdr->sata_control,
230 1.242 bouyer wdr->sata_status)) {
231 1.239 bouyer case SStatus_DET_DEV:
232 1.239 bouyer bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh], 0,
233 1.239 bouyer WDSD_IBM);
234 1.239 bouyer delay(10); /* 400ns delay */
235 1.239 bouyer scnt = bus_space_read_2(wdr->cmd_iot,
236 1.239 bouyer wdr->cmd_iohs[wd_seccnt], 0);
237 1.239 bouyer sn = bus_space_read_2(wdr->cmd_iot,
238 1.239 bouyer wdr->cmd_iohs[wd_sector], 0);
239 1.239 bouyer cl = bus_space_read_2(wdr->cmd_iot,
240 1.239 bouyer wdr->cmd_iohs[wd_cyl_lo], 0);
241 1.239 bouyer ch = bus_space_read_2(wdr->cmd_iot,
242 1.239 bouyer wdr->cmd_iohs[wd_cyl_hi], 0);
243 1.239 bouyer ATADEBUG_PRINT(("%s: port %d: scnt=0x%x sn=0x%x "
244 1.239 bouyer "cl=0x%x ch=0x%x\n",
245 1.239 bouyer chp->ch_atac->atac_dev.dv_xname, chp->ch_channel,
246 1.239 bouyer scnt, sn, cl, ch), DEBUG_PROBE);
247 1.239 bouyer /*
248 1.239 bouyer * scnt and sn are supposed to be 0x1 for ATAPI, but in some
249 1.239 bouyer * cases we get wrong values here, so ignore it.
250 1.239 bouyer */
251 1.239 bouyer s = splbio();
252 1.239 bouyer if (cl == 0x14 && ch == 0xeb)
253 1.239 bouyer chp->ch_drive[0].drive_flags |= DRIVE_ATAPI;
254 1.239 bouyer else
255 1.239 bouyer chp->ch_drive[0].drive_flags |= DRIVE_ATA;
256 1.239 bouyer splx(s);
257 1.239 bouyer
258 1.241 bouyer /*
259 1.241 bouyer * issue a reset in case only the interface part of the drive
260 1.241 bouyer * is up
261 1.241 bouyer */
262 1.241 bouyer if (wdcreset(chp, RESET_SLEEP) != 0)
263 1.241 bouyer chp->ch_drive[0].drive_flags = 0;
264 1.239 bouyer break;
265 1.239 bouyer
266 1.239 bouyer default:
267 1.242 bouyer break;
268 1.239 bouyer }
269 1.239 bouyer }
270 1.240 bouyer #endif /* NSATA > 0 */
271 1.239 bouyer
272 1.239 bouyer
273 1.162 thorpej /* Test to see controller with at last one attached drive is there.
274 1.162 thorpej * Returns a bit for each possible drive found (0x01 for drive 0,
275 1.162 thorpej * 0x02 for drive 1).
276 1.162 thorpej * Logic:
277 1.162 thorpej * - If a status register is at 0xff, assume there is no drive here
278 1.162 thorpej * (ISA has pull-up resistors). Similarly if the status register has
279 1.162 thorpej * the value we last wrote to the bus (for IDE interfaces without pullups).
280 1.162 thorpej * If no drive at all -> return.
281 1.162 thorpej * - reset the controller, wait for it to complete (may take up to 31s !).
282 1.162 thorpej * If timeout -> return.
283 1.162 thorpej * - test ATA/ATAPI signatures. If at last one drive found -> return.
284 1.162 thorpej * - try an ATA command on the master.
285 1.162 thorpej */
286 1.137 bouyer
287 1.239 bouyer void
288 1.205 thorpej wdc_drvprobe(struct ata_channel *chp)
289 1.137 bouyer {
290 1.137 bouyer struct ataparams params;
291 1.207 thorpej struct atac_softc *atac = chp->ch_atac;
292 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
293 1.205 thorpej struct wdc_regs *wdr = &wdc->regs[chp->ch_channel];
294 1.145 christos u_int8_t st0 = 0, st1 = 0;
295 1.232 bouyer int i, j, error, s;
296 1.137 bouyer
297 1.164 thorpej if (wdcprobe1(chp, 0) == 0) {
298 1.164 thorpej /* No drives, abort the attach here. */
299 1.164 thorpej return;
300 1.161 thorpej }
301 1.137 bouyer
302 1.137 bouyer /* for ATA/OLD drives, wait for DRDY, 3s timeout */
303 1.137 bouyer for (i = 0; i < mstohz(3000); i++) {
304 1.174 bouyer if (chp->ch_drive[0].drive_flags & (DRIVE_ATA|DRIVE_OLD)) {
305 1.207 thorpej if (wdc->select)
306 1.174 bouyer wdc->select(chp,0);
307 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh],
308 1.174 bouyer 0, WDSD_IBM);
309 1.174 bouyer delay(10); /* 400ns delay */
310 1.205 thorpej st0 = bus_space_read_1(wdr->cmd_iot,
311 1.205 thorpej wdr->cmd_iohs[wd_status], 0);
312 1.174 bouyer }
313 1.219 perry
314 1.174 bouyer if (chp->ch_drive[1].drive_flags & (DRIVE_ATA|DRIVE_OLD)) {
315 1.207 thorpej if (wdc->select)
316 1.174 bouyer wdc->select(chp,1);
317 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh],
318 1.174 bouyer 0, WDSD_IBM | 0x10);
319 1.174 bouyer delay(10); /* 400ns delay */
320 1.205 thorpej st1 = bus_space_read_1(wdr->cmd_iot,
321 1.205 thorpej wdr->cmd_iohs[wd_status], 0);
322 1.174 bouyer }
323 1.219 perry
324 1.137 bouyer if (((chp->ch_drive[0].drive_flags & (DRIVE_ATA|DRIVE_OLD))
325 1.137 bouyer == 0 ||
326 1.137 bouyer (st0 & WDCS_DRDY)) &&
327 1.137 bouyer ((chp->ch_drive[1].drive_flags & (DRIVE_ATA|DRIVE_OLD))
328 1.137 bouyer == 0 ||
329 1.137 bouyer (st1 & WDCS_DRDY)))
330 1.137 bouyer break;
331 1.164 thorpej tsleep(¶ms, PRIBIO, "atadrdy", 1);
332 1.137 bouyer }
333 1.212 thorpej s = splbio();
334 1.137 bouyer if ((st0 & WDCS_DRDY) == 0)
335 1.137 bouyer chp->ch_drive[0].drive_flags &= ~(DRIVE_ATA|DRIVE_OLD);
336 1.137 bouyer if ((st1 & WDCS_DRDY) == 0)
337 1.137 bouyer chp->ch_drive[1].drive_flags &= ~(DRIVE_ATA|DRIVE_OLD);
338 1.212 thorpej splx(s);
339 1.137 bouyer
340 1.204 thorpej ATADEBUG_PRINT(("%s:%d: wait DRDY st0 0x%x st1 0x%x\n",
341 1.207 thorpej atac->atac_dev.dv_xname,
342 1.169 thorpej chp->ch_channel, st0, st1), DEBUG_PROBE);
343 1.137 bouyer
344 1.137 bouyer /* Wait a bit, some devices are weird just after a reset. */
345 1.137 bouyer delay(5000);
346 1.137 bouyer
347 1.232 bouyer for (i = 0; i < chp->ch_ndrive; i++) {
348 1.171 thorpej /* XXX This should be done by other code. */
349 1.137 bouyer chp->ch_drive[i].chnl_softc = chp;
350 1.137 bouyer chp->ch_drive[i].drive = i;
351 1.171 thorpej
352 1.238 itohy #if NATA_DMA
353 1.137 bouyer /*
354 1.137 bouyer * Init error counter so that an error withing the first xfers
355 1.137 bouyer * will trigger a downgrade
356 1.137 bouyer */
357 1.137 bouyer chp->ch_drive[i].n_dmaerrs = NERRS_MAX-1;
358 1.238 itohy #endif
359 1.137 bouyer
360 1.137 bouyer /* If controller can't do 16bit flag the drives as 32bit */
361 1.207 thorpej if ((atac->atac_cap &
362 1.212 thorpej (ATAC_CAP_DATA16 | ATAC_CAP_DATA32)) == ATAC_CAP_DATA32) {
363 1.212 thorpej s = splbio();
364 1.137 bouyer chp->ch_drive[i].drive_flags |= DRIVE_CAP32;
365 1.212 thorpej splx(s);
366 1.212 thorpej }
367 1.137 bouyer if ((chp->ch_drive[i].drive_flags & DRIVE) == 0)
368 1.137 bouyer continue;
369 1.137 bouyer
370 1.144 briggs /* Shortcut in case we've been shutdown */
371 1.205 thorpej if (chp->ch_flags & ATACH_SHUTDOWN)
372 1.164 thorpej return;
373 1.144 briggs
374 1.216 bouyer /*
375 1.216 bouyer * Issue an identify, to try to detect ghosts.
376 1.216 bouyer * Note that we can't use interrupts here, because if there
377 1.216 bouyer * is no devices, we will get a command aborted without
378 1.216 bouyer * interrupts.
379 1.216 bouyer */
380 1.216 bouyer error = ata_get_params(&chp->ch_drive[i],
381 1.216 bouyer AT_WAIT | AT_POLL, ¶ms);
382 1.137 bouyer if (error != CMD_OK) {
383 1.164 thorpej tsleep(¶ms, PRIBIO, "atacnf", mstohz(1000));
384 1.144 briggs
385 1.144 briggs /* Shortcut in case we've been shutdown */
386 1.205 thorpej if (chp->ch_flags & ATACH_SHUTDOWN)
387 1.164 thorpej return;
388 1.144 briggs
389 1.137 bouyer error = ata_get_params(&chp->ch_drive[i],
390 1.216 bouyer AT_WAIT | AT_POLL, ¶ms);
391 1.137 bouyer }
392 1.137 bouyer if (error == CMD_OK) {
393 1.152 wiz /* If IDENTIFY succeeded, this is not an OLD ctrl */
394 1.212 thorpej s = splbio();
395 1.232 bouyer for (j = 0; j < chp->ch_ndrive; j++)
396 1.232 bouyer chp->ch_drive[j].drive_flags &= ~DRIVE_OLD;
397 1.212 thorpej splx(s);
398 1.137 bouyer } else {
399 1.212 thorpej s = splbio();
400 1.155 bouyer chp->ch_drive[i].drive_flags &=
401 1.137 bouyer ~(DRIVE_ATA | DRIVE_ATAPI);
402 1.212 thorpej splx(s);
403 1.204 thorpej ATADEBUG_PRINT(("%s:%d:%d: IDENTIFY failed (%d)\n",
404 1.207 thorpej atac->atac_dev.dv_xname,
405 1.169 thorpej chp->ch_channel, i, error), DEBUG_PROBE);
406 1.137 bouyer if ((chp->ch_drive[i].drive_flags & DRIVE_OLD) == 0)
407 1.137 bouyer continue;
408 1.137 bouyer /*
409 1.137 bouyer * Pre-ATA drive ?
410 1.137 bouyer * Test registers writability (Error register not
411 1.137 bouyer * writable, but cyllo is), then try an ATA command.
412 1.137 bouyer */
413 1.203 thorpej if (wdc->select)
414 1.169 thorpej wdc->select(chp,i);
415 1.205 thorpej bus_space_write_1(wdr->cmd_iot,
416 1.205 thorpej wdr->cmd_iohs[wd_sdh], 0, WDSD_IBM | (i << 4));
417 1.137 bouyer delay(10); /* 400ns delay */
418 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_error],
419 1.157 fvdl 0, 0x58);
420 1.205 thorpej bus_space_write_1(wdr->cmd_iot,
421 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0, 0xa5);
422 1.205 thorpej if (bus_space_read_1(wdr->cmd_iot,
423 1.205 thorpej wdr->cmd_iohs[wd_error], 0) == 0x58 ||
424 1.205 thorpej bus_space_read_1(wdr->cmd_iot,
425 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0) != 0xa5) {
426 1.204 thorpej ATADEBUG_PRINT(("%s:%d:%d: register "
427 1.137 bouyer "writability failed\n",
428 1.207 thorpej atac->atac_dev.dv_xname,
429 1.169 thorpej chp->ch_channel, i), DEBUG_PROBE);
430 1.212 thorpej s = splbio();
431 1.137 bouyer chp->ch_drive[i].drive_flags &= ~DRIVE_OLD;
432 1.212 thorpej splx(s);
433 1.155 bouyer continue;
434 1.137 bouyer }
435 1.166 thorpej if (wdc_wait_for_ready(chp, 10000, 0) == WDCWAIT_TOUT) {
436 1.204 thorpej ATADEBUG_PRINT(("%s:%d:%d: not ready\n",
437 1.207 thorpej atac->atac_dev.dv_xname,
438 1.169 thorpej chp->ch_channel, i), DEBUG_PROBE);
439 1.212 thorpej s = splbio();
440 1.137 bouyer chp->ch_drive[i].drive_flags &= ~DRIVE_OLD;
441 1.212 thorpej splx(s);
442 1.137 bouyer continue;
443 1.137 bouyer }
444 1.205 thorpej bus_space_write_1(wdr->cmd_iot,
445 1.205 thorpej wdr->cmd_iohs[wd_command], 0, WDCC_RECAL);
446 1.137 bouyer delay(10); /* 400ns delay */
447 1.166 thorpej if (wdc_wait_for_ready(chp, 10000, 0) == WDCWAIT_TOUT) {
448 1.204 thorpej ATADEBUG_PRINT(("%s:%d:%d: WDCC_RECAL failed\n",
449 1.207 thorpej atac->atac_dev.dv_xname,
450 1.169 thorpej chp->ch_channel, i), DEBUG_PROBE);
451 1.212 thorpej s = splbio();
452 1.137 bouyer chp->ch_drive[i].drive_flags &= ~DRIVE_OLD;
453 1.212 thorpej splx(s);
454 1.155 bouyer } else {
455 1.212 thorpej s = splbio();
456 1.232 bouyer for (j = 0; j < chp->ch_ndrive; j++)
457 1.232 bouyer chp->ch_drive[j].drive_flags &=
458 1.232 bouyer ~(DRIVE_ATA | DRIVE_ATAPI);
459 1.212 thorpej splx(s);
460 1.137 bouyer }
461 1.137 bouyer }
462 1.137 bouyer }
463 1.164 thorpej }
464 1.164 thorpej
465 1.2 bouyer int
466 1.205 thorpej wdcprobe(struct ata_channel *chp)
467 1.12 cgd {
468 1.228 bouyer struct wdc_softc *wdc = CHAN_TO_WDC(chp);
469 1.227 bouyer /* default reset method */
470 1.227 bouyer if (wdc->reset == NULL)
471 1.227 bouyer wdc->reset = wdc_do_reset;
472 1.163 thorpej
473 1.163 thorpej return (wdcprobe1(chp, 1));
474 1.137 bouyer }
475 1.137 bouyer
476 1.167 thorpej static int
477 1.205 thorpej wdcprobe1(struct ata_channel *chp, int poll)
478 1.137 bouyer {
479 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
480 1.205 thorpej struct wdc_regs *wdr = &wdc->regs[chp->ch_channel];
481 1.224 bouyer u_int8_t st0 = 0, st1 = 0, sc, sn, cl, ch;
482 1.31 bouyer u_int8_t ret_value = 0x03;
483 1.31 bouyer u_int8_t drive;
484 1.156 bouyer int s;
485 1.247 dyoung /* XXX if poll, wdc_probe_count is 0. */
486 1.224 bouyer int wdc_probe_count =
487 1.247 dyoung poll ? (WDC_PROBE_WAIT / WDCDELAY)
488 1.247 dyoung : (WDC_PROBE_WAIT * hz);
489 1.31 bouyer
490 1.31 bouyer /*
491 1.31 bouyer * Sanity check to see if the wdc channel responds at all.
492 1.31 bouyer */
493 1.31 bouyer
494 1.174 bouyer s = splbio();
495 1.207 thorpej if ((wdc->cap & WDC_CAPABILITY_NO_EXTRA_RESETS) == 0) {
496 1.224 bouyer while (wdc_probe_count-- > 0) {
497 1.224 bouyer if (wdc->select)
498 1.224 bouyer wdc->select(chp,0);
499 1.107 dbj
500 1.224 bouyer bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh],
501 1.224 bouyer 0, WDSD_IBM);
502 1.224 bouyer delay(10); /* 400ns delay */
503 1.224 bouyer st0 = bus_space_read_1(wdr->cmd_iot,
504 1.224 bouyer wdr->cmd_iohs[wd_status], 0);
505 1.137 bouyer
506 1.224 bouyer if (wdc->select)
507 1.224 bouyer wdc->select(chp,1);
508 1.219 perry
509 1.224 bouyer bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh],
510 1.224 bouyer 0, WDSD_IBM | 0x10);
511 1.224 bouyer delay(10); /* 400ns delay */
512 1.224 bouyer st1 = bus_space_read_1(wdr->cmd_iot,
513 1.224 bouyer wdr->cmd_iohs[wd_status], 0);
514 1.224 bouyer if ((st0 & WDCS_BSY) == 0)
515 1.224 bouyer break;
516 1.224 bouyer }
517 1.43 kenh
518 1.204 thorpej ATADEBUG_PRINT(("%s:%d: before reset, st0=0x%x, st1=0x%x\n",
519 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
520 1.169 thorpej chp->ch_channel, st0, st1), DEBUG_PROBE);
521 1.43 kenh
522 1.142 bouyer if (st0 == 0xff || st0 == WDSD_IBM)
523 1.43 kenh ret_value &= ~0x01;
524 1.142 bouyer if (st1 == 0xff || st1 == (WDSD_IBM | 0x10))
525 1.43 kenh ret_value &= ~0x02;
526 1.125 mycroft /* Register writability test, drive 0. */
527 1.125 mycroft if (ret_value & 0x01) {
528 1.207 thorpej if (wdc->select)
529 1.169 thorpej wdc->select(chp,0);
530 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh],
531 1.157 fvdl 0, WDSD_IBM);
532 1.205 thorpej bus_space_write_1(wdr->cmd_iot,
533 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0, 0x02);
534 1.205 thorpej cl = bus_space_read_1(wdr->cmd_iot,
535 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0);
536 1.174 bouyer if (cl != 0x02) {
537 1.204 thorpej ATADEBUG_PRINT(("%s:%d drive 0 wd_cyl_lo: "
538 1.174 bouyer "got 0x%x != 0x02\n",
539 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
540 1.174 bouyer chp->ch_channel, cl),
541 1.174 bouyer DEBUG_PROBE);
542 1.125 mycroft ret_value &= ~0x01;
543 1.174 bouyer }
544 1.205 thorpej bus_space_write_1(wdr->cmd_iot,
545 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0, 0x01);
546 1.205 thorpej cl = bus_space_read_1(wdr->cmd_iot,
547 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0);
548 1.174 bouyer if (cl != 0x01) {
549 1.204 thorpej ATADEBUG_PRINT(("%s:%d drive 0 wd_cyl_lo: "
550 1.174 bouyer "got 0x%x != 0x01\n",
551 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
552 1.174 bouyer chp->ch_channel, cl),
553 1.174 bouyer DEBUG_PROBE);
554 1.125 mycroft ret_value &= ~0x01;
555 1.174 bouyer }
556 1.205 thorpej bus_space_write_1(wdr->cmd_iot,
557 1.205 thorpej wdr->cmd_iohs[wd_sector], 0, 0x01);
558 1.205 thorpej cl = bus_space_read_1(wdr->cmd_iot,
559 1.205 thorpej wdr->cmd_iohs[wd_sector], 0);
560 1.174 bouyer if (cl != 0x01) {
561 1.204 thorpej ATADEBUG_PRINT(("%s:%d drive 0 wd_sector: "
562 1.174 bouyer "got 0x%x != 0x01\n",
563 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
564 1.174 bouyer chp->ch_channel, cl),
565 1.174 bouyer DEBUG_PROBE);
566 1.125 mycroft ret_value &= ~0x01;
567 1.174 bouyer }
568 1.205 thorpej bus_space_write_1(wdr->cmd_iot,
569 1.205 thorpej wdr->cmd_iohs[wd_sector], 0, 0x02);
570 1.205 thorpej cl = bus_space_read_1(wdr->cmd_iot,
571 1.205 thorpej wdr->cmd_iohs[wd_sector], 0);
572 1.174 bouyer if (cl != 0x02) {
573 1.204 thorpej ATADEBUG_PRINT(("%s:%d drive 0 wd_sector: "
574 1.174 bouyer "got 0x%x != 0x02\n",
575 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
576 1.174 bouyer chp->ch_channel, cl),
577 1.174 bouyer DEBUG_PROBE);
578 1.125 mycroft ret_value &= ~0x01;
579 1.174 bouyer }
580 1.205 thorpej cl = bus_space_read_1(wdr->cmd_iot,
581 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0);
582 1.174 bouyer if (cl != 0x01) {
583 1.204 thorpej ATADEBUG_PRINT(("%s:%d drive 0 wd_cyl_lo(2): "
584 1.174 bouyer "got 0x%x != 0x01\n",
585 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
586 1.174 bouyer chp->ch_channel, cl),
587 1.174 bouyer DEBUG_PROBE);
588 1.131 mycroft ret_value &= ~0x01;
589 1.174 bouyer }
590 1.125 mycroft }
591 1.125 mycroft /* Register writability test, drive 1. */
592 1.125 mycroft if (ret_value & 0x02) {
593 1.207 thorpej if (wdc->select)
594 1.169 thorpej wdc->select(chp,1);
595 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh],
596 1.157 fvdl 0, WDSD_IBM | 0x10);
597 1.205 thorpej bus_space_write_1(wdr->cmd_iot,
598 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0, 0x02);
599 1.205 thorpej cl = bus_space_read_1(wdr->cmd_iot,
600 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0);
601 1.174 bouyer if (cl != 0x02) {
602 1.204 thorpej ATADEBUG_PRINT(("%s:%d drive 1 wd_cyl_lo: "
603 1.174 bouyer "got 0x%x != 0x02\n",
604 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
605 1.174 bouyer chp->ch_channel, cl),
606 1.174 bouyer DEBUG_PROBE);
607 1.125 mycroft ret_value &= ~0x02;
608 1.174 bouyer }
609 1.205 thorpej bus_space_write_1(wdr->cmd_iot,
610 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0, 0x01);
611 1.205 thorpej cl = bus_space_read_1(wdr->cmd_iot,
612 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0);
613 1.174 bouyer if (cl != 0x01) {
614 1.204 thorpej ATADEBUG_PRINT(("%s:%d drive 1 wd_cyl_lo: "
615 1.174 bouyer "got 0x%x != 0x01\n",
616 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
617 1.174 bouyer chp->ch_channel, cl),
618 1.174 bouyer DEBUG_PROBE);
619 1.125 mycroft ret_value &= ~0x02;
620 1.174 bouyer }
621 1.205 thorpej bus_space_write_1(wdr->cmd_iot,
622 1.205 thorpej wdr->cmd_iohs[wd_sector], 0, 0x01);
623 1.205 thorpej cl = bus_space_read_1(wdr->cmd_iot,
624 1.205 thorpej wdr->cmd_iohs[wd_sector], 0);
625 1.174 bouyer if (cl != 0x01) {
626 1.204 thorpej ATADEBUG_PRINT(("%s:%d drive 1 wd_sector: "
627 1.174 bouyer "got 0x%x != 0x01\n",
628 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
629 1.174 bouyer chp->ch_channel, cl),
630 1.174 bouyer DEBUG_PROBE);
631 1.125 mycroft ret_value &= ~0x02;
632 1.174 bouyer }
633 1.205 thorpej bus_space_write_1(wdr->cmd_iot,
634 1.205 thorpej wdr->cmd_iohs[wd_sector], 0, 0x02);
635 1.205 thorpej cl = bus_space_read_1(wdr->cmd_iot,
636 1.205 thorpej wdr->cmd_iohs[wd_sector], 0);
637 1.174 bouyer if (cl != 0x02) {
638 1.204 thorpej ATADEBUG_PRINT(("%s:%d drive 1 wd_sector: "
639 1.174 bouyer "got 0x%x != 0x02\n",
640 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
641 1.174 bouyer chp->ch_channel, cl),
642 1.174 bouyer DEBUG_PROBE);
643 1.125 mycroft ret_value &= ~0x02;
644 1.174 bouyer }
645 1.205 thorpej cl = bus_space_read_1(wdr->cmd_iot,
646 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0);
647 1.174 bouyer if (cl != 0x01) {
648 1.204 thorpej ATADEBUG_PRINT(("%s:%d drive 1 wd_cyl_lo(2): "
649 1.174 bouyer "got 0x%x != 0x01\n",
650 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
651 1.174 bouyer chp->ch_channel, cl),
652 1.174 bouyer DEBUG_PROBE);
653 1.131 mycroft ret_value &= ~0x02;
654 1.174 bouyer }
655 1.125 mycroft }
656 1.137 bouyer
657 1.174 bouyer if (ret_value == 0) {
658 1.174 bouyer splx(s);
659 1.137 bouyer return 0;
660 1.174 bouyer }
661 1.62 bouyer }
662 1.31 bouyer
663 1.174 bouyer
664 1.181 bouyer #if 0 /* XXX this break some ATA or ATAPI devices */
665 1.174 bouyer /*
666 1.174 bouyer * reset bus. Also send an ATAPI_RESET to devices, in case there are
667 1.174 bouyer * ATAPI device out there which don't react to the bus reset
668 1.174 bouyer */
669 1.174 bouyer if (ret_value & 0x01) {
670 1.207 thorpej if (wdc->select)
671 1.174 bouyer wdc->select(chp,0);
672 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh],
673 1.174 bouyer 0, WDSD_IBM);
674 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_command], 0,
675 1.174 bouyer ATAPI_SOFT_RESET);
676 1.174 bouyer }
677 1.174 bouyer if (ret_value & 0x02) {
678 1.207 thorpej if (wdc->select)
679 1.174 bouyer wdc->select(chp,0);
680 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh],
681 1.174 bouyer 0, WDSD_IBM | 0x10);
682 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_command], 0,
683 1.174 bouyer ATAPI_SOFT_RESET);
684 1.174 bouyer }
685 1.156 bouyer
686 1.175 bouyer delay(5000);
687 1.181 bouyer #endif
688 1.175 bouyer
689 1.225 bouyer wdc->reset(chp, RESET_POLL);
690 1.137 bouyer DELAY(2000);
691 1.205 thorpej (void) bus_space_read_1(wdr->cmd_iot, wdr->cmd_iohs[wd_error], 0);
692 1.205 thorpej bus_space_write_1(wdr->ctl_iot, wdr->ctl_ioh, wd_aux_ctlr, WDCTL_4BIT);
693 1.156 bouyer splx(s);
694 1.137 bouyer
695 1.137 bouyer ret_value = __wdcwait_reset(chp, ret_value, poll);
696 1.204 thorpej ATADEBUG_PRINT(("%s:%d: after reset, ret_value=0x%d\n",
697 1.247 dyoung chp->ch_atac->atac_dev.dv_xname, chp->ch_channel,
698 1.137 bouyer ret_value), DEBUG_PROBE);
699 1.12 cgd
700 1.137 bouyer /* if reset failed, there's nothing here */
701 1.137 bouyer if (ret_value == 0)
702 1.137 bouyer return 0;
703 1.67 bouyer
704 1.12 cgd /*
705 1.167 thorpej * Test presence of drives. First test register signatures looking
706 1.167 thorpej * for ATAPI devices. If it's not an ATAPI and reset said there may
707 1.167 thorpej * be something here assume it's ATA or OLD. Ghost will be killed
708 1.167 thorpej * later in attach routine.
709 1.12 cgd */
710 1.232 bouyer for (drive = 0; drive < chp->ch_ndrive; drive++) {
711 1.137 bouyer if ((ret_value & (0x01 << drive)) == 0)
712 1.137 bouyer continue;
713 1.207 thorpej if (wdc->select)
714 1.169 thorpej wdc->select(chp,drive);
715 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh], 0,
716 1.137 bouyer WDSD_IBM | (drive << 4));
717 1.137 bouyer delay(10); /* 400ns delay */
718 1.137 bouyer /* Save registers contents */
719 1.205 thorpej sc = bus_space_read_1(wdr->cmd_iot,
720 1.205 thorpej wdr->cmd_iohs[wd_seccnt], 0);
721 1.205 thorpej sn = bus_space_read_1(wdr->cmd_iot,
722 1.205 thorpej wdr->cmd_iohs[wd_sector], 0);
723 1.205 thorpej cl = bus_space_read_1(wdr->cmd_iot,
724 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0);
725 1.205 thorpej ch = bus_space_read_1(wdr->cmd_iot,
726 1.205 thorpej wdr->cmd_iohs[wd_cyl_hi], 0);
727 1.137 bouyer
728 1.204 thorpej ATADEBUG_PRINT(("%s:%d:%d: after reset, sc=0x%x sn=0x%x "
729 1.137 bouyer "cl=0x%x ch=0x%x\n",
730 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
731 1.169 thorpej chp->ch_channel, drive, sc, sn, cl, ch), DEBUG_PROBE);
732 1.31 bouyer /*
733 1.137 bouyer * sc & sn are supposted to be 0x1 for ATAPI but in some cases
734 1.137 bouyer * we get wrong values here, so ignore it.
735 1.31 bouyer */
736 1.212 thorpej s = splbio();
737 1.137 bouyer if (cl == 0x14 && ch == 0xeb) {
738 1.137 bouyer chp->ch_drive[drive].drive_flags |= DRIVE_ATAPI;
739 1.137 bouyer } else {
740 1.137 bouyer chp->ch_drive[drive].drive_flags |= DRIVE_ATA;
741 1.223 bouyer if ((wdc->cap & WDC_CAPABILITY_PREATA) != 0)
742 1.137 bouyer chp->ch_drive[drive].drive_flags |= DRIVE_OLD;
743 1.137 bouyer }
744 1.212 thorpej splx(s);
745 1.31 bouyer }
746 1.219 perry return (ret_value);
747 1.137 bouyer }
748 1.31 bouyer
749 1.137 bouyer void
750 1.205 thorpej wdcattach(struct ata_channel *chp)
751 1.137 bouyer {
752 1.207 thorpej struct atac_softc *atac = chp->ch_atac;
753 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
754 1.32 bouyer
755 1.232 bouyer KASSERT(chp->ch_ndrive > 0 && chp->ch_ndrive < 3);
756 1.205 thorpej
757 1.191 mycroft /* default data transfer methods */
758 1.210 thorpej if (wdc->datain_pio == NULL)
759 1.191 mycroft wdc->datain_pio = wdc_datain_pio;
760 1.210 thorpej if (wdc->dataout_pio == NULL)
761 1.191 mycroft wdc->dataout_pio = wdc_dataout_pio;
762 1.225 bouyer /* default reset method */
763 1.225 bouyer if (wdc->reset == NULL)
764 1.225 bouyer wdc->reset = wdc_do_reset;
765 1.191 mycroft
766 1.137 bouyer /* initialise global data */
767 1.208 thorpej if (atac->atac_bustype_ata == NULL)
768 1.208 thorpej atac->atac_bustype_ata = &wdc_ata_bustype;
769 1.207 thorpej if (atac->atac_probe == NULL)
770 1.207 thorpej atac->atac_probe = wdc_drvprobe;
771 1.208 thorpej #if NATAPIBUS > 0
772 1.208 thorpej if (atac->atac_atapibus_attach == NULL)
773 1.208 thorpej atac->atac_atapibus_attach = wdc_atapibus_attach;
774 1.208 thorpej #endif
775 1.198 thorpej
776 1.210 thorpej ata_channel_attach(chp);
777 1.74 enami }
778 1.74 enami
779 1.163 thorpej int
780 1.250 dyoung wdcactivate(device_t self, enum devact act)
781 1.137 bouyer {
782 1.250 dyoung struct atac_softc *atac = device_private(self);
783 1.250 dyoung struct ata_channel *chp;
784 1.137 bouyer int s, i, error = 0;
785 1.137 bouyer
786 1.137 bouyer s = splbio();
787 1.137 bouyer switch (act) {
788 1.137 bouyer case DVACT_ACTIVATE:
789 1.137 bouyer error = EOPNOTSUPP;
790 1.137 bouyer break;
791 1.137 bouyer
792 1.137 bouyer case DVACT_DEACTIVATE:
793 1.207 thorpej for (i = 0; i < atac->atac_nchannels; i++) {
794 1.250 dyoung chp = atac->atac_channels[i];
795 1.250 dyoung if (chp->atabus == NULL)
796 1.250 dyoung continue;
797 1.250 dyoung error = config_deactivate(chp->atabus);
798 1.137 bouyer if (error)
799 1.137 bouyer break;
800 1.137 bouyer }
801 1.137 bouyer break;
802 1.137 bouyer }
803 1.137 bouyer splx(s);
804 1.137 bouyer return (error);
805 1.137 bouyer }
806 1.219 perry
807 1.250 dyoung void
808 1.250 dyoung wdc_childdetached(device_t self, device_t child)
809 1.250 dyoung {
810 1.250 dyoung struct atac_softc *atac = device_private(self);
811 1.250 dyoung struct ata_channel *chp;
812 1.250 dyoung int i;
813 1.250 dyoung
814 1.250 dyoung for (i = 0; i < atac->atac_nchannels; i++) {
815 1.250 dyoung chp = atac->atac_channels[i];
816 1.250 dyoung if (child == chp->atabus) {
817 1.250 dyoung chp->atabus = NULL;
818 1.250 dyoung return;
819 1.250 dyoung }
820 1.250 dyoung }
821 1.250 dyoung }
822 1.250 dyoung
823 1.137 bouyer int
824 1.250 dyoung wdcdetach(device_t self, int flags)
825 1.137 bouyer {
826 1.250 dyoung struct atac_softc *atac = device_private(self);
827 1.205 thorpej struct ata_channel *chp;
828 1.207 thorpej struct scsipi_adapter *adapt = &atac->atac_atapi_adapter._generic;
829 1.137 bouyer int i, error = 0;
830 1.137 bouyer
831 1.207 thorpej for (i = 0; i < atac->atac_nchannels; i++) {
832 1.207 thorpej chp = atac->atac_channels[i];
833 1.250 dyoung if (chp->atabus == NULL)
834 1.250 dyoung continue;
835 1.204 thorpej ATADEBUG_PRINT(("wdcdetach: %s: detaching %s\n",
836 1.207 thorpej atac->atac_dev.dv_xname, chp->atabus->dv_xname),
837 1.207 thorpej DEBUG_DETACH);
838 1.251 dyoung if ((error = config_detach(chp->atabus, flags)) != 0)
839 1.251 dyoung return error;
840 1.137 bouyer }
841 1.252 dyoung if (adapt->adapt_refcnt != 0)
842 1.252 dyoung return EBUSY;
843 1.251 dyoung return 0;
844 1.137 bouyer }
845 1.137 bouyer
846 1.31 bouyer /* restart an interrupted I/O */
847 1.31 bouyer void
848 1.163 thorpej wdcrestart(void *v)
849 1.31 bouyer {
850 1.205 thorpej struct ata_channel *chp = v;
851 1.31 bouyer int s;
852 1.2 bouyer
853 1.31 bouyer s = splbio();
854 1.202 thorpej atastart(chp);
855 1.31 bouyer splx(s);
856 1.2 bouyer }
857 1.219 perry
858 1.2 bouyer
859 1.31 bouyer /*
860 1.31 bouyer * Interrupt routine for the controller. Acknowledge the interrupt, check for
861 1.31 bouyer * errors on the current operation, mark it done if necessary, and start the
862 1.31 bouyer * next request. Also check for a partially done transfer, and continue with
863 1.31 bouyer * the next chunk if so.
864 1.31 bouyer */
865 1.12 cgd int
866 1.163 thorpej wdcintr(void *arg)
867 1.12 cgd {
868 1.205 thorpej struct ata_channel *chp = arg;
869 1.207 thorpej struct atac_softc *atac = chp->ch_atac;
870 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
871 1.205 thorpej struct wdc_regs *wdr = &wdc->regs[chp->ch_channel];
872 1.165 thorpej struct ata_xfer *xfer;
873 1.76 bouyer int ret;
874 1.12 cgd
875 1.235 thorpej if (!device_is_active(&atac->atac_dev)) {
876 1.204 thorpej ATADEBUG_PRINT(("wdcintr: deactivated controller\n"),
877 1.80 enami DEBUG_INTR);
878 1.80 enami return (0);
879 1.80 enami }
880 1.205 thorpej if ((chp->ch_flags & ATACH_IRQ_WAIT) == 0) {
881 1.204 thorpej ATADEBUG_PRINT(("wdcintr: inactive controller\n"), DEBUG_INTR);
882 1.113 bouyer /* try to clear the pending interrupt anyway */
883 1.205 thorpej (void)bus_space_read_1(wdr->cmd_iot,
884 1.205 thorpej wdr->cmd_iohs[wd_status], 0);
885 1.80 enami return (0);
886 1.31 bouyer }
887 1.12 cgd
888 1.204 thorpej ATADEBUG_PRINT(("wdcintr\n"), DEBUG_INTR);
889 1.186 bouyer xfer = chp->ch_queue->active_xfer;
890 1.186 bouyer #ifdef DIAGNOSTIC
891 1.186 bouyer if (xfer == NULL)
892 1.186 bouyer panic("wdcintr: no xfer");
893 1.233 bouyer if (xfer->c_chp != chp) {
894 1.233 bouyer printf("channel %d expected %d\n", xfer->c_chp->ch_channel,
895 1.233 bouyer chp->ch_channel);
896 1.233 bouyer panic("wdcintr: wrong channel");
897 1.233 bouyer }
898 1.186 bouyer #endif
899 1.238 itohy #if NATA_DMA || NATA_PIOBM
900 1.205 thorpej if (chp->ch_flags & ATACH_DMA_WAIT) {
901 1.169 thorpej wdc->dma_status =
902 1.169 thorpej (*wdc->dma_finish)(wdc->dma_arg, chp->ch_channel,
903 1.185 bouyer xfer->c_drive, WDC_DMAEND_END);
904 1.169 thorpej if (wdc->dma_status & WDC_DMAST_NOIRQ) {
905 1.84 bouyer /* IRQ not for us, not detected by DMA engine */
906 1.84 bouyer return 0;
907 1.84 bouyer }
908 1.205 thorpej chp->ch_flags &= ~ATACH_DMA_WAIT;
909 1.84 bouyer }
910 1.238 itohy #endif
911 1.205 thorpej chp->ch_flags &= ~ATACH_IRQ_WAIT;
912 1.76 bouyer ret = xfer->c_intr(chp, xfer, 1);
913 1.76 bouyer if (ret == 0) /* irq was not for us, still waiting for irq */
914 1.205 thorpej chp->ch_flags |= ATACH_IRQ_WAIT;
915 1.76 bouyer return (ret);
916 1.12 cgd }
917 1.12 cgd
918 1.31 bouyer /* Put all disk in RESET state */
919 1.125 mycroft void
920 1.183 bouyer wdc_reset_drive(struct ata_drive_datas *drvp, int flags)
921 1.2 bouyer {
922 1.205 thorpej struct ata_channel *chp = drvp->chnl_softc;
923 1.207 thorpej
924 1.211 thorpej ATADEBUG_PRINT(("wdc_reset_drive %s:%d for drive %d\n",
925 1.248 dyoung chp->ch_atac->atac_dev.dv_xname, chp->ch_channel, drvp->drive),
926 1.34 bouyer DEBUG_FUNCS);
927 1.182 bouyer
928 1.211 thorpej ata_reset_channel(chp, flags);
929 1.182 bouyer }
930 1.182 bouyer
931 1.183 bouyer void
932 1.205 thorpej wdc_reset_channel(struct ata_channel *chp, int flags)
933 1.182 bouyer {
934 1.186 bouyer TAILQ_HEAD(, ata_xfer) reset_xfer;
935 1.183 bouyer struct ata_xfer *xfer, *next_xfer;
936 1.238 itohy #if NATA_DMA || NATA_PIOBM
937 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
938 1.238 itohy #endif
939 1.182 bouyer
940 1.186 bouyer TAILQ_INIT(&reset_xfer);
941 1.184 bouyer
942 1.211 thorpej chp->ch_flags &= ~ATACH_IRQ_WAIT;
943 1.184 bouyer
944 1.186 bouyer /*
945 1.186 bouyer * if the current command if on an ATAPI device, issue a
946 1.186 bouyer * ATAPI_SOFT_RESET
947 1.186 bouyer */
948 1.186 bouyer xfer = chp->ch_queue->active_xfer;
949 1.186 bouyer if (xfer && xfer->c_chp == chp && (xfer->c_flags & C_ATAPI)) {
950 1.186 bouyer wdccommandshort(chp, xfer->c_drive, ATAPI_SOFT_RESET);
951 1.186 bouyer if (flags & AT_WAIT)
952 1.186 bouyer tsleep(&flags, PRIBIO, "atardl", mstohz(1) + 1);
953 1.219 perry else
954 1.186 bouyer delay(1000);
955 1.186 bouyer }
956 1.186 bouyer
957 1.184 bouyer /* reset the channel */
958 1.186 bouyer if (flags & AT_WAIT)
959 1.186 bouyer (void) wdcreset(chp, RESET_SLEEP);
960 1.186 bouyer else
961 1.184 bouyer (void) wdcreset(chp, RESET_POLL);
962 1.184 bouyer
963 1.184 bouyer /*
964 1.186 bouyer * wait a bit after reset; in case the DMA engines needs some time
965 1.184 bouyer * to recover.
966 1.184 bouyer */
967 1.184 bouyer if (flags & AT_WAIT)
968 1.186 bouyer tsleep(&flags, PRIBIO, "atardl", mstohz(1) + 1);
969 1.219 perry else
970 1.184 bouyer delay(1000);
971 1.182 bouyer /*
972 1.182 bouyer * look for pending xfers. If we have a shared queue, we'll also reset
973 1.182 bouyer * the other channel if the current xfer is running on it.
974 1.184 bouyer * Then we'll dequeue only the xfers for this channel.
975 1.182 bouyer */
976 1.182 bouyer if ((flags & AT_RST_NOCMD) == 0) {
977 1.186 bouyer /*
978 1.186 bouyer * move all xfers queued for this channel to the reset queue,
979 1.186 bouyer * and then process the current xfer and then the reset queue.
980 1.186 bouyer * We have to use a temporary queue because c_kill_xfer()
981 1.186 bouyer * may requeue commands.
982 1.186 bouyer */
983 1.186 bouyer for (xfer = TAILQ_FIRST(&chp->ch_queue->queue_xfer);
984 1.186 bouyer xfer != NULL; xfer = next_xfer) {
985 1.186 bouyer next_xfer = TAILQ_NEXT(xfer, c_xferchain);
986 1.186 bouyer if (xfer->c_chp != chp)
987 1.186 bouyer continue;
988 1.186 bouyer TAILQ_REMOVE(&chp->ch_queue->queue_xfer,
989 1.186 bouyer xfer, c_xferchain);
990 1.186 bouyer TAILQ_INSERT_TAIL(&reset_xfer, xfer, c_xferchain);
991 1.186 bouyer }
992 1.186 bouyer xfer = chp->ch_queue->active_xfer;
993 1.184 bouyer if (xfer) {
994 1.184 bouyer if (xfer->c_chp != chp)
995 1.211 thorpej ata_reset_channel(xfer->c_chp, flags);
996 1.184 bouyer else {
997 1.186 bouyer callout_stop(&chp->ch_callout);
998 1.238 itohy #if NATA_DMA || NATA_PIOBM
999 1.184 bouyer /*
1000 1.184 bouyer * If we're waiting for DMA, stop the
1001 1.184 bouyer * DMA engine
1002 1.184 bouyer */
1003 1.205 thorpej if (chp->ch_flags & ATACH_DMA_WAIT) {
1004 1.207 thorpej (*wdc->dma_finish)(
1005 1.207 thorpej wdc->dma_arg,
1006 1.184 bouyer chp->ch_channel,
1007 1.184 bouyer xfer->c_drive,
1008 1.185 bouyer WDC_DMAEND_ABRT_QUIET);
1009 1.205 thorpej chp->ch_flags &= ~ATACH_DMA_WAIT;
1010 1.184 bouyer }
1011 1.238 itohy #endif
1012 1.186 bouyer chp->ch_queue->active_xfer = NULL;
1013 1.186 bouyer if ((flags & AT_RST_EMERG) == 0)
1014 1.186 bouyer xfer->c_kill_xfer(
1015 1.186 bouyer chp, xfer, KILL_RESET);
1016 1.184 bouyer }
1017 1.184 bouyer }
1018 1.186 bouyer
1019 1.186 bouyer for (xfer = TAILQ_FIRST(&reset_xfer);
1020 1.183 bouyer xfer != NULL; xfer = next_xfer) {
1021 1.183 bouyer next_xfer = TAILQ_NEXT(xfer, c_xferchain);
1022 1.186 bouyer TAILQ_REMOVE(&reset_xfer, xfer, c_xferchain);
1023 1.182 bouyer if ((flags & AT_RST_EMERG) == 0)
1024 1.182 bouyer xfer->c_kill_xfer(chp, xfer, KILL_RESET);
1025 1.182 bouyer }
1026 1.182 bouyer }
1027 1.31 bouyer }
1028 1.12 cgd
1029 1.213 thorpej static int
1030 1.205 thorpej wdcreset(struct ata_channel *chp, int poll)
1031 1.31 bouyer {
1032 1.207 thorpej struct atac_softc *atac = chp->ch_atac;
1033 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
1034 1.205 thorpej struct wdc_regs *wdr = &wdc->regs[chp->ch_channel];
1035 1.31 bouyer int drv_mask1, drv_mask2;
1036 1.225 bouyer
1037 1.225 bouyer wdc->reset(chp, poll);
1038 1.225 bouyer
1039 1.225 bouyer drv_mask1 = (chp->ch_drive[0].drive_flags & DRIVE) ? 0x01:0x00;
1040 1.225 bouyer drv_mask1 |= (chp->ch_drive[1].drive_flags & DRIVE) ? 0x02:0x00;
1041 1.225 bouyer drv_mask2 = __wdcwait_reset(chp, drv_mask1,
1042 1.225 bouyer (poll == RESET_SLEEP) ? 0 : 1);
1043 1.225 bouyer if (drv_mask2 != drv_mask1) {
1044 1.225 bouyer printf("%s channel %d: reset failed for",
1045 1.225 bouyer atac->atac_dev.dv_xname, chp->ch_channel);
1046 1.225 bouyer if ((drv_mask1 & 0x01) != 0 && (drv_mask2 & 0x01) == 0)
1047 1.225 bouyer printf(" drive 0");
1048 1.225 bouyer if ((drv_mask1 & 0x02) != 0 && (drv_mask2 & 0x02) == 0)
1049 1.225 bouyer printf(" drive 1");
1050 1.225 bouyer printf("\n");
1051 1.225 bouyer }
1052 1.225 bouyer bus_space_write_1(wdr->ctl_iot, wdr->ctl_ioh, wd_aux_ctlr, WDCTL_4BIT);
1053 1.225 bouyer return (drv_mask1 != drv_mask2) ? 1 : 0;
1054 1.225 bouyer }
1055 1.225 bouyer
1056 1.225 bouyer void
1057 1.225 bouyer wdc_do_reset(struct ata_channel *chp, int poll)
1058 1.225 bouyer {
1059 1.225 bouyer struct wdc_softc *wdc = CHAN_TO_WDC(chp);
1060 1.225 bouyer struct wdc_regs *wdr = &wdc->regs[chp->ch_channel];
1061 1.156 bouyer int s = 0;
1062 1.2 bouyer
1063 1.225 bouyer if (poll != RESET_SLEEP)
1064 1.225 bouyer s = splbio();
1065 1.203 thorpej if (wdc->select)
1066 1.169 thorpej wdc->select(chp,0);
1067 1.157 fvdl /* master */
1068 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh], 0, WDSD_IBM);
1069 1.131 mycroft delay(10); /* 400ns delay */
1070 1.225 bouyer /* assert SRST, wait for reset to complete */
1071 1.205 thorpej bus_space_write_1(wdr->ctl_iot, wdr->ctl_ioh, wd_aux_ctlr,
1072 1.131 mycroft WDCTL_RST | WDCTL_IDS | WDCTL_4BIT);
1073 1.131 mycroft delay(2000);
1074 1.205 thorpej (void) bus_space_read_1(wdr->cmd_iot, wdr->cmd_iohs[wd_error], 0);
1075 1.205 thorpej bus_space_write_1(wdr->ctl_iot, wdr->ctl_ioh, wd_aux_ctlr,
1076 1.137 bouyer WDCTL_4BIT | WDCTL_IDS);
1077 1.131 mycroft delay(10); /* 400ns delay */
1078 1.156 bouyer if (poll != RESET_SLEEP) {
1079 1.233 bouyer /* ACK interrupt in case there is one pending left */
1080 1.203 thorpej if (wdc->irqack)
1081 1.169 thorpej wdc->irqack(chp);
1082 1.156 bouyer splx(s);
1083 1.156 bouyer }
1084 1.31 bouyer }
1085 1.31 bouyer
1086 1.31 bouyer static int
1087 1.205 thorpej __wdcwait_reset(struct ata_channel *chp, int drv_mask, int poll)
1088 1.31 bouyer {
1089 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
1090 1.205 thorpej struct wdc_regs *wdr = &wdc->regs[chp->ch_channel];
1091 1.137 bouyer int timeout, nloop;
1092 1.149 bouyer u_int8_t st0 = 0, st1 = 0;
1093 1.204 thorpej #ifdef ATADEBUG
1094 1.146 christos u_int8_t sc0 = 0, sn0 = 0, cl0 = 0, ch0 = 0;
1095 1.146 christos u_int8_t sc1 = 0, sn1 = 0, cl1 = 0, ch1 = 0;
1096 1.70 bouyer #endif
1097 1.137 bouyer
1098 1.137 bouyer if (poll)
1099 1.137 bouyer nloop = WDCNDELAY_RST;
1100 1.137 bouyer else
1101 1.137 bouyer nloop = WDC_RESET_WAIT * hz / 1000;
1102 1.31 bouyer /* wait for BSY to deassert */
1103 1.137 bouyer for (timeout = 0; timeout < nloop; timeout++) {
1104 1.174 bouyer if ((drv_mask & 0x01) != 0) {
1105 1.236 bouyer if (wdc->select)
1106 1.174 bouyer wdc->select(chp,0);
1107 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh],
1108 1.174 bouyer 0, WDSD_IBM); /* master */
1109 1.174 bouyer delay(10);
1110 1.205 thorpej st0 = bus_space_read_1(wdr->cmd_iot,
1111 1.205 thorpej wdr->cmd_iohs[wd_status], 0);
1112 1.204 thorpej #ifdef ATADEBUG
1113 1.205 thorpej sc0 = bus_space_read_1(wdr->cmd_iot,
1114 1.205 thorpej wdr->cmd_iohs[wd_seccnt], 0);
1115 1.205 thorpej sn0 = bus_space_read_1(wdr->cmd_iot,
1116 1.205 thorpej wdr->cmd_iohs[wd_sector], 0);
1117 1.205 thorpej cl0 = bus_space_read_1(wdr->cmd_iot,
1118 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0);
1119 1.205 thorpej ch0 = bus_space_read_1(wdr->cmd_iot,
1120 1.205 thorpej wdr->cmd_iohs[wd_cyl_hi], 0);
1121 1.70 bouyer #endif
1122 1.174 bouyer }
1123 1.174 bouyer if ((drv_mask & 0x02) != 0) {
1124 1.236 bouyer if (wdc->select)
1125 1.174 bouyer wdc->select(chp,1);
1126 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh],
1127 1.174 bouyer 0, WDSD_IBM | 0x10); /* slave */
1128 1.174 bouyer delay(10);
1129 1.205 thorpej st1 = bus_space_read_1(wdr->cmd_iot,
1130 1.205 thorpej wdr->cmd_iohs[wd_status], 0);
1131 1.204 thorpej #ifdef ATADEBUG
1132 1.205 thorpej sc1 = bus_space_read_1(wdr->cmd_iot,
1133 1.205 thorpej wdr->cmd_iohs[wd_seccnt], 0);
1134 1.205 thorpej sn1 = bus_space_read_1(wdr->cmd_iot,
1135 1.205 thorpej wdr->cmd_iohs[wd_sector], 0);
1136 1.205 thorpej cl1 = bus_space_read_1(wdr->cmd_iot,
1137 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0);
1138 1.205 thorpej ch1 = bus_space_read_1(wdr->cmd_iot,
1139 1.205 thorpej wdr->cmd_iohs[wd_cyl_hi], 0);
1140 1.70 bouyer #endif
1141 1.174 bouyer }
1142 1.31 bouyer
1143 1.31 bouyer if ((drv_mask & 0x01) == 0) {
1144 1.31 bouyer /* no master */
1145 1.31 bouyer if ((drv_mask & 0x02) != 0 && (st1 & WDCS_BSY) == 0) {
1146 1.31 bouyer /* No master, slave is ready, it's done */
1147 1.65 bouyer goto end;
1148 1.31 bouyer }
1149 1.231 bouyer if ((drv_mask & 0x02) == 0) {
1150 1.231 bouyer /* No master, no slave: it's done */
1151 1.231 bouyer goto end;
1152 1.231 bouyer }
1153 1.31 bouyer } else if ((drv_mask & 0x02) == 0) {
1154 1.31 bouyer /* no slave */
1155 1.31 bouyer if ((drv_mask & 0x01) != 0 && (st0 & WDCS_BSY) == 0) {
1156 1.31 bouyer /* No slave, master is ready, it's done */
1157 1.65 bouyer goto end;
1158 1.31 bouyer }
1159 1.2 bouyer } else {
1160 1.31 bouyer /* Wait for both master and slave to be ready */
1161 1.31 bouyer if ((st0 & WDCS_BSY) == 0 && (st1 & WDCS_BSY) == 0) {
1162 1.65 bouyer goto end;
1163 1.2 bouyer }
1164 1.2 bouyer }
1165 1.137 bouyer if (poll)
1166 1.137 bouyer delay(WDCDELAY);
1167 1.137 bouyer else
1168 1.137 bouyer tsleep(&nloop, PRIBIO, "atarst", 1);
1169 1.2 bouyer }
1170 1.116 wiz /* Reset timed out. Maybe it's because drv_mask was not right */
1171 1.31 bouyer if (st0 & WDCS_BSY)
1172 1.31 bouyer drv_mask &= ~0x01;
1173 1.31 bouyer if (st1 & WDCS_BSY)
1174 1.31 bouyer drv_mask &= ~0x02;
1175 1.65 bouyer end:
1176 1.204 thorpej ATADEBUG_PRINT(("%s:%d:0: after reset, sc=0x%x sn=0x%x "
1177 1.70 bouyer "cl=0x%x ch=0x%x\n",
1178 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
1179 1.169 thorpej chp->ch_channel, sc0, sn0, cl0, ch0), DEBUG_PROBE);
1180 1.204 thorpej ATADEBUG_PRINT(("%s:%d:1: after reset, sc=0x%x sn=0x%x "
1181 1.70 bouyer "cl=0x%x ch=0x%x\n",
1182 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
1183 1.169 thorpej chp->ch_channel, sc1, sn1, cl1, ch1), DEBUG_PROBE);
1184 1.70 bouyer
1185 1.204 thorpej ATADEBUG_PRINT(("%s:%d: wdcwait_reset() end, st0=0x%x st1=0x%x\n",
1186 1.247 dyoung chp->ch_atac->atac_dev.dv_xname, chp->ch_channel,
1187 1.149 bouyer st0, st1), DEBUG_PROBE);
1188 1.65 bouyer
1189 1.31 bouyer return drv_mask;
1190 1.2 bouyer }
1191 1.2 bouyer
1192 1.2 bouyer /*
1193 1.31 bouyer * Wait for a drive to be !BSY, and have mask in its status register.
1194 1.31 bouyer * return -1 for a timeout after "timeout" ms.
1195 1.2 bouyer */
1196 1.167 thorpej static int
1197 1.205 thorpej __wdcwait(struct ata_channel *chp, int mask, int bits, int timeout)
1198 1.2 bouyer {
1199 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
1200 1.205 thorpej struct wdc_regs *wdr = &wdc->regs[chp->ch_channel];
1201 1.31 bouyer u_char status;
1202 1.222 christos int xtime = 0;
1203 1.60 abs
1204 1.207 thorpej ATADEBUG_PRINT(("__wdcwait %s:%d\n",
1205 1.247 dyoung chp->ch_atac->atac_dev.dv_xname,
1206 1.169 thorpej chp->ch_channel), DEBUG_STATUS);
1207 1.31 bouyer chp->ch_error = 0;
1208 1.31 bouyer
1209 1.31 bouyer timeout = timeout * 1000 / WDCDELAY; /* delay uses microseconds */
1210 1.2 bouyer
1211 1.31 bouyer for (;;) {
1212 1.31 bouyer chp->ch_status = status =
1213 1.205 thorpej bus_space_read_1(wdr->cmd_iot, wdr->cmd_iohs[wd_status], 0);
1214 1.131 mycroft if ((status & (WDCS_BSY | mask)) == bits)
1215 1.31 bouyer break;
1216 1.222 christos if (++xtime > timeout) {
1217 1.204 thorpej ATADEBUG_PRINT(("__wdcwait: timeout (time=%d), "
1218 1.87 bouyer "status %x error %x (mask 0x%x bits 0x%x)\n",
1219 1.222 christos xtime, status,
1220 1.205 thorpej bus_space_read_1(wdr->cmd_iot,
1221 1.205 thorpej wdr->cmd_iohs[wd_error], 0), mask, bits),
1222 1.87 bouyer DEBUG_STATUS | DEBUG_PROBE | DEBUG_DELAY);
1223 1.137 bouyer return(WDCWAIT_TOUT);
1224 1.31 bouyer }
1225 1.31 bouyer delay(WDCDELAY);
1226 1.2 bouyer }
1227 1.204 thorpej #ifdef ATADEBUG
1228 1.222 christos if (xtime > 0 && (atadebug_mask & DEBUG_DELAY))
1229 1.222 christos printf("__wdcwait: did busy-wait, time=%d\n", xtime);
1230 1.87 bouyer #endif
1231 1.31 bouyer if (status & WDCS_ERR)
1232 1.205 thorpej chp->ch_error = bus_space_read_1(wdr->cmd_iot,
1233 1.205 thorpej wdr->cmd_iohs[wd_error], 0);
1234 1.31 bouyer #ifdef WDCNDELAY_DEBUG
1235 1.31 bouyer /* After autoconfig, there should be no long delays. */
1236 1.222 christos if (!cold && xtime > WDCNDELAY_DEBUG) {
1237 1.186 bouyer struct ata_xfer *xfer = chp->ch_queue->active_xfer;
1238 1.31 bouyer if (xfer == NULL)
1239 1.31 bouyer printf("%s channel %d: warning: busy-wait took %dus\n",
1240 1.247 dyoung chp->ch_atac->atac_dev.dv_xname, chp->ch_channel,
1241 1.222 christos WDCDELAY * xtime);
1242 1.219 perry else
1243 1.31 bouyer printf("%s:%d:%d: warning: busy-wait took %dus\n",
1244 1.247 dyoung chp->ch_atac->atac_dev.dv_xname, chp->ch_channel,
1245 1.237 christos xfer->c_drive,
1246 1.222 christos WDCDELAY * xtime);
1247 1.2 bouyer }
1248 1.2 bouyer #endif
1249 1.137 bouyer return(WDCWAIT_OK);
1250 1.137 bouyer }
1251 1.137 bouyer
1252 1.137 bouyer /*
1253 1.137 bouyer * Call __wdcwait(), polling using tsleep() or waking up the kernel
1254 1.137 bouyer * thread if possible
1255 1.137 bouyer */
1256 1.137 bouyer int
1257 1.205 thorpej wdcwait(struct ata_channel *chp, int mask, int bits, int timeout, int flags)
1258 1.137 bouyer {
1259 1.137 bouyer int error, i, timeout_hz = mstohz(timeout);
1260 1.137 bouyer
1261 1.137 bouyer if (timeout_hz == 0 ||
1262 1.137 bouyer (flags & (AT_WAIT | AT_POLL)) == AT_POLL)
1263 1.137 bouyer error = __wdcwait(chp, mask, bits, timeout);
1264 1.137 bouyer else {
1265 1.137 bouyer error = __wdcwait(chp, mask, bits, WDCDELAY_POLL);
1266 1.137 bouyer if (error != 0) {
1267 1.205 thorpej if ((chp->ch_flags & ATACH_TH_RUN) ||
1268 1.147 bouyer (flags & AT_WAIT)) {
1269 1.137 bouyer /*
1270 1.147 bouyer * we're running in the channel thread
1271 1.147 bouyer * or some userland thread context
1272 1.137 bouyer */
1273 1.137 bouyer for (i = 0; i < timeout_hz; i++) {
1274 1.137 bouyer if (__wdcwait(chp, mask, bits,
1275 1.137 bouyer WDCDELAY_POLL) == 0) {
1276 1.137 bouyer error = 0;
1277 1.137 bouyer break;
1278 1.137 bouyer }
1279 1.137 bouyer tsleep(&chp, PRIBIO, "atapoll", 1);
1280 1.137 bouyer }
1281 1.137 bouyer } else {
1282 1.137 bouyer /*
1283 1.137 bouyer * we're probably in interrupt context,
1284 1.137 bouyer * ask the thread to come back here
1285 1.137 bouyer */
1286 1.147 bouyer #ifdef DIAGNOSTIC
1287 1.148 bouyer if (chp->ch_queue->queue_freeze > 0)
1288 1.148 bouyer panic("wdcwait: queue_freeze");
1289 1.147 bouyer #endif
1290 1.148 bouyer chp->ch_queue->queue_freeze++;
1291 1.170 thorpej wakeup(&chp->ch_thread);
1292 1.137 bouyer return(WDCWAIT_THR);
1293 1.137 bouyer }
1294 1.137 bouyer }
1295 1.137 bouyer }
1296 1.163 thorpej return (error);
1297 1.2 bouyer }
1298 1.2 bouyer
1299 1.137 bouyer
1300 1.238 itohy #if NATA_DMA
1301 1.84 bouyer /*
1302 1.84 bouyer * Busy-wait for DMA to complete
1303 1.84 bouyer */
1304 1.84 bouyer int
1305 1.205 thorpej wdc_dmawait(struct ata_channel *chp, struct ata_xfer *xfer, int timeout)
1306 1.84 bouyer {
1307 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
1308 1.222 christos int xtime;
1309 1.169 thorpej
1310 1.222 christos for (xtime = 0; xtime < timeout * 1000 / WDCDELAY; xtime++) {
1311 1.169 thorpej wdc->dma_status =
1312 1.169 thorpej (*wdc->dma_finish)(wdc->dma_arg,
1313 1.185 bouyer chp->ch_channel, xfer->c_drive, WDC_DMAEND_END);
1314 1.169 thorpej if ((wdc->dma_status & WDC_DMAST_NOIRQ) == 0)
1315 1.84 bouyer return 0;
1316 1.84 bouyer delay(WDCDELAY);
1317 1.84 bouyer }
1318 1.84 bouyer /* timeout, force a DMA halt */
1319 1.169 thorpej wdc->dma_status = (*wdc->dma_finish)(wdc->dma_arg,
1320 1.185 bouyer chp->ch_channel, xfer->c_drive, WDC_DMAEND_ABRT);
1321 1.84 bouyer return 1;
1322 1.84 bouyer }
1323 1.238 itohy #endif
1324 1.84 bouyer
1325 1.31 bouyer void
1326 1.163 thorpej wdctimeout(void *arg)
1327 1.2 bouyer {
1328 1.205 thorpej struct ata_channel *chp = (struct ata_channel *)arg;
1329 1.238 itohy #if NATA_DMA || NATA_PIOBM
1330 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
1331 1.238 itohy #endif
1332 1.186 bouyer struct ata_xfer *xfer = chp->ch_queue->active_xfer;
1333 1.31 bouyer int s;
1334 1.2 bouyer
1335 1.204 thorpej ATADEBUG_PRINT(("wdctimeout\n"), DEBUG_FUNCS);
1336 1.31 bouyer
1337 1.31 bouyer s = splbio();
1338 1.205 thorpej if ((chp->ch_flags & ATACH_IRQ_WAIT) != 0) {
1339 1.31 bouyer __wdcerror(chp, "lost interrupt");
1340 1.88 mrg printf("\ttype: %s tc_bcount: %d tc_skip: %d\n",
1341 1.88 mrg (xfer->c_flags & C_ATAPI) ? "atapi" : "ata",
1342 1.88 mrg xfer->c_bcount,
1343 1.88 mrg xfer->c_skip);
1344 1.238 itohy #if NATA_DMA || NATA_PIOBM
1345 1.205 thorpej if (chp->ch_flags & ATACH_DMA_WAIT) {
1346 1.169 thorpej wdc->dma_status =
1347 1.169 thorpej (*wdc->dma_finish)(wdc->dma_arg,
1348 1.185 bouyer chp->ch_channel, xfer->c_drive,
1349 1.185 bouyer WDC_DMAEND_ABRT);
1350 1.205 thorpej chp->ch_flags &= ~ATACH_DMA_WAIT;
1351 1.84 bouyer }
1352 1.238 itohy #endif
1353 1.31 bouyer /*
1354 1.119 drochner * Call the interrupt routine. If we just missed an interrupt,
1355 1.31 bouyer * it will do what's needed. Else, it will take the needed
1356 1.31 bouyer * action (reset the device).
1357 1.70 bouyer * Before that we need to reinstall the timeout callback,
1358 1.70 bouyer * in case it will miss another irq while in this transfer
1359 1.70 bouyer * We arbitray chose it to be 1s
1360 1.31 bouyer */
1361 1.81 thorpej callout_reset(&chp->ch_callout, hz, wdctimeout, chp);
1362 1.31 bouyer xfer->c_flags |= C_TIMEOU;
1363 1.205 thorpej chp->ch_flags &= ~ATACH_IRQ_WAIT;
1364 1.66 bouyer xfer->c_intr(chp, xfer, 1);
1365 1.31 bouyer } else
1366 1.31 bouyer __wdcerror(chp, "missing untimeout");
1367 1.31 bouyer splx(s);
1368 1.2 bouyer }
1369 1.2 bouyer
1370 1.2 bouyer int
1371 1.192 thorpej wdc_exec_command(struct ata_drive_datas *drvp, struct ata_command *ata_c)
1372 1.31 bouyer {
1373 1.205 thorpej struct ata_channel *chp = drvp->chnl_softc;
1374 1.165 thorpej struct ata_xfer *xfer;
1375 1.31 bouyer int s, ret;
1376 1.2 bouyer
1377 1.204 thorpej ATADEBUG_PRINT(("wdc_exec_command %s:%d:%d\n",
1378 1.247 dyoung chp->ch_atac->atac_dev.dv_xname, chp->ch_channel, drvp->drive),
1379 1.34 bouyer DEBUG_FUNCS);
1380 1.2 bouyer
1381 1.31 bouyer /* set up an xfer and queue. Wait for completion */
1382 1.198 thorpej xfer = ata_get_xfer(ata_c->flags & AT_WAIT ? ATAXF_CANSLEEP :
1383 1.198 thorpej ATAXF_NOSLEEP);
1384 1.31 bouyer if (xfer == NULL) {
1385 1.193 thorpej return ATACMD_TRY_AGAIN;
1386 1.31 bouyer }
1387 1.2 bouyer
1388 1.247 dyoung if (chp->ch_atac->atac_cap & ATAC_CAP_NOIRQ)
1389 1.192 thorpej ata_c->flags |= AT_POLL;
1390 1.192 thorpej if (ata_c->flags & AT_POLL)
1391 1.31 bouyer xfer->c_flags |= C_POLL;
1392 1.217 bouyer if (ata_c->flags & AT_WAIT)
1393 1.217 bouyer xfer->c_flags |= C_WAIT;
1394 1.165 thorpej xfer->c_drive = drvp->drive;
1395 1.192 thorpej xfer->c_databuf = ata_c->data;
1396 1.192 thorpej xfer->c_bcount = ata_c->bcount;
1397 1.192 thorpej xfer->c_cmd = ata_c;
1398 1.31 bouyer xfer->c_start = __wdccommand_start;
1399 1.31 bouyer xfer->c_intr = __wdccommand_intr;
1400 1.182 bouyer xfer->c_kill_xfer = __wdccommand_kill_xfer;
1401 1.2 bouyer
1402 1.31 bouyer s = splbio();
1403 1.201 thorpej ata_exec_xfer(chp, xfer);
1404 1.31 bouyer #ifdef DIAGNOSTIC
1405 1.192 thorpej if ((ata_c->flags & AT_POLL) != 0 &&
1406 1.192 thorpej (ata_c->flags & AT_DONE) == 0)
1407 1.118 provos panic("wdc_exec_command: polled command not done");
1408 1.2 bouyer #endif
1409 1.192 thorpej if (ata_c->flags & AT_DONE) {
1410 1.193 thorpej ret = ATACMD_COMPLETE;
1411 1.31 bouyer } else {
1412 1.192 thorpej if (ata_c->flags & AT_WAIT) {
1413 1.192 thorpej while ((ata_c->flags & AT_DONE) == 0) {
1414 1.192 thorpej tsleep(ata_c, PRIBIO, "wdccmd", 0);
1415 1.69 bouyer }
1416 1.193 thorpej ret = ATACMD_COMPLETE;
1417 1.31 bouyer } else {
1418 1.193 thorpej ret = ATACMD_QUEUED;
1419 1.2 bouyer }
1420 1.2 bouyer }
1421 1.31 bouyer splx(s);
1422 1.31 bouyer return ret;
1423 1.2 bouyer }
1424 1.2 bouyer
1425 1.167 thorpej static void
1426 1.205 thorpej __wdccommand_start(struct ata_channel *chp, struct ata_xfer *xfer)
1427 1.219 perry {
1428 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
1429 1.205 thorpej struct wdc_regs *wdr = &wdc->regs[chp->ch_channel];
1430 1.165 thorpej int drive = xfer->c_drive;
1431 1.230 bouyer int wait_flags = (xfer->c_flags & C_POLL) ? AT_POLL : 0;
1432 1.192 thorpej struct ata_command *ata_c = xfer->c_cmd;
1433 1.31 bouyer
1434 1.204 thorpej ATADEBUG_PRINT(("__wdccommand_start %s:%d:%d\n",
1435 1.247 dyoung chp->ch_atac->atac_dev.dv_xname, chp->ch_channel, xfer->c_drive),
1436 1.34 bouyer DEBUG_FUNCS);
1437 1.31 bouyer
1438 1.203 thorpej if (wdc->select)
1439 1.169 thorpej wdc->select(chp,drive);
1440 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh], 0,
1441 1.31 bouyer WDSD_IBM | (drive << 4));
1442 1.192 thorpej switch(wdcwait(chp, ata_c->r_st_bmask | WDCS_DRQ,
1443 1.230 bouyer ata_c->r_st_bmask, ata_c->timeout, wait_flags)) {
1444 1.137 bouyer case WDCWAIT_OK:
1445 1.137 bouyer break;
1446 1.137 bouyer case WDCWAIT_TOUT:
1447 1.192 thorpej ata_c->flags |= AT_TIMEOU;
1448 1.31 bouyer __wdccommand_done(chp, xfer);
1449 1.53 bouyer return;
1450 1.137 bouyer case WDCWAIT_THR:
1451 1.137 bouyer return;
1452 1.31 bouyer }
1453 1.192 thorpej if (ata_c->flags & AT_POLL) {
1454 1.135 bouyer /* polled command, disable interrupts */
1455 1.205 thorpej bus_space_write_1(wdr->ctl_iot, wdr->ctl_ioh, wd_aux_ctlr,
1456 1.135 bouyer WDCTL_4BIT | WDCTL_IDS);
1457 1.135 bouyer }
1458 1.192 thorpej wdccommand(chp, drive, ata_c->r_command, ata_c->r_cyl, ata_c->r_head,
1459 1.192 thorpej ata_c->r_sector, ata_c->r_count, ata_c->r_features);
1460 1.139 bouyer
1461 1.192 thorpej if ((ata_c->flags & AT_POLL) == 0) {
1462 1.205 thorpej chp->ch_flags |= ATACH_IRQ_WAIT; /* wait for interrupt */
1463 1.192 thorpej callout_reset(&chp->ch_callout, ata_c->timeout / 1000 * hz,
1464 1.81 thorpej wdctimeout, chp);
1465 1.31 bouyer return;
1466 1.2 bouyer }
1467 1.2 bouyer /*
1468 1.31 bouyer * Polled command. Wait for drive ready or drq. Done in intr().
1469 1.31 bouyer * Wait for at last 400ns for status bit to be valid.
1470 1.2 bouyer */
1471 1.134 mycroft delay(10); /* 400ns delay */
1472 1.66 bouyer __wdccommand_intr(chp, xfer, 0);
1473 1.2 bouyer }
1474 1.2 bouyer
1475 1.167 thorpej static int
1476 1.205 thorpej __wdccommand_intr(struct ata_channel *chp, struct ata_xfer *xfer, int irq)
1477 1.2 bouyer {
1478 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
1479 1.205 thorpej struct wdc_regs *wdr = &wdc->regs[chp->ch_channel];
1480 1.192 thorpej struct ata_command *ata_c = xfer->c_cmd;
1481 1.192 thorpej int bcount = ata_c->bcount;
1482 1.192 thorpej char *data = ata_c->data;
1483 1.137 bouyer int wflags;
1484 1.226 bouyer int drive_flags;
1485 1.226 bouyer
1486 1.226 bouyer if (ata_c->r_command == WDCC_IDENTIFY ||
1487 1.226 bouyer ata_c->r_command == ATAPI_IDENTIFY_DEVICE) {
1488 1.226 bouyer /*
1489 1.226 bouyer * The IDENTIFY data has been designed as an array of
1490 1.226 bouyer * u_int16_t, so we can byteswap it on the fly.
1491 1.226 bouyer * Historically it's what we have always done so keeping it
1492 1.226 bouyer * here ensure binary backward compatibility.
1493 1.226 bouyer */
1494 1.229 tacha drive_flags = DRIVE_NOSTREAM |
1495 1.229 tacha chp->ch_drive[xfer->c_drive].drive_flags;
1496 1.226 bouyer } else {
1497 1.226 bouyer /*
1498 1.226 bouyer * Other data structure are opaque and should be transfered
1499 1.226 bouyer * as is.
1500 1.226 bouyer */
1501 1.226 bouyer drive_flags = chp->ch_drive[xfer->c_drive].drive_flags;
1502 1.226 bouyer }
1503 1.137 bouyer
1504 1.192 thorpej if ((ata_c->flags & (AT_WAIT | AT_POLL)) == (AT_WAIT | AT_POLL)) {
1505 1.137 bouyer /* both wait and poll, we can tsleep here */
1506 1.147 bouyer wflags = AT_WAIT | AT_POLL;
1507 1.137 bouyer } else {
1508 1.137 bouyer wflags = AT_POLL;
1509 1.137 bouyer }
1510 1.31 bouyer
1511 1.163 thorpej again:
1512 1.204 thorpej ATADEBUG_PRINT(("__wdccommand_intr %s:%d:%d\n",
1513 1.247 dyoung chp->ch_atac->atac_dev.dv_xname, chp->ch_channel, xfer->c_drive),
1514 1.165 thorpej DEBUG_INTR);
1515 1.137 bouyer /*
1516 1.137 bouyer * after a ATAPI_SOFT_RESET, the device will have released the bus.
1517 1.137 bouyer * Reselect again, it doesn't hurt for others commands, and the time
1518 1.137 bouyer * penalty for the extra regiter write is acceptable,
1519 1.137 bouyer * wdc_exec_command() isn't called often (mosly for autoconfig)
1520 1.137 bouyer */
1521 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh], 0,
1522 1.165 thorpej WDSD_IBM | (xfer->c_drive << 4));
1523 1.192 thorpej if ((ata_c->flags & AT_XFDONE) != 0) {
1524 1.114 bouyer /*
1525 1.114 bouyer * We have completed a data xfer. The drive should now be
1526 1.114 bouyer * in its initial state
1527 1.114 bouyer */
1528 1.192 thorpej if (wdcwait(chp, ata_c->r_st_bmask | WDCS_DRQ,
1529 1.192 thorpej ata_c->r_st_bmask, (irq == 0) ? ata_c->timeout : 0,
1530 1.137 bouyer wflags) == WDCWAIT_TOUT) {
1531 1.219 perry if (irq && (xfer->c_flags & C_TIMEOU) == 0)
1532 1.114 bouyer return 0; /* IRQ was not for us */
1533 1.192 thorpej ata_c->flags |= AT_TIMEOU;
1534 1.114 bouyer }
1535 1.131 mycroft goto out;
1536 1.114 bouyer }
1537 1.192 thorpej if (wdcwait(chp, ata_c->r_st_pmask, ata_c->r_st_pmask,
1538 1.192 thorpej (irq == 0) ? ata_c->timeout : 0, wflags) == WDCWAIT_TOUT) {
1539 1.219 perry if (irq && (xfer->c_flags & C_TIMEOU) == 0)
1540 1.63 bouyer return 0; /* IRQ was not for us */
1541 1.192 thorpej ata_c->flags |= AT_TIMEOU;
1542 1.131 mycroft goto out;
1543 1.2 bouyer }
1544 1.203 thorpej if (wdc->irqack)
1545 1.169 thorpej wdc->irqack(chp);
1546 1.192 thorpej if (ata_c->flags & AT_READ) {
1547 1.131 mycroft if ((chp->ch_status & WDCS_DRQ) == 0) {
1548 1.192 thorpej ata_c->flags |= AT_TIMEOU;
1549 1.131 mycroft goto out;
1550 1.131 mycroft }
1551 1.226 bouyer wdc->datain_pio(chp, drive_flags, data, bcount);
1552 1.114 bouyer /* at this point the drive should be in its initial state */
1553 1.192 thorpej ata_c->flags |= AT_XFDONE;
1554 1.234 bouyer /*
1555 1.234 bouyer * XXX checking the status register again here cause some
1556 1.234 bouyer * hardware to timeout.
1557 1.234 bouyer */
1558 1.192 thorpej } else if (ata_c->flags & AT_WRITE) {
1559 1.131 mycroft if ((chp->ch_status & WDCS_DRQ) == 0) {
1560 1.192 thorpej ata_c->flags |= AT_TIMEOU;
1561 1.131 mycroft goto out;
1562 1.131 mycroft }
1563 1.226 bouyer wdc->dataout_pio(chp, drive_flags, data, bcount);
1564 1.192 thorpej ata_c->flags |= AT_XFDONE;
1565 1.192 thorpej if ((ata_c->flags & AT_POLL) == 0) {
1566 1.205 thorpej chp->ch_flags |= ATACH_IRQ_WAIT; /* wait for interrupt */
1567 1.114 bouyer callout_reset(&chp->ch_callout,
1568 1.243 bouyer mstohz(ata_c->timeout), wdctimeout, chp);
1569 1.114 bouyer return 1;
1570 1.114 bouyer } else {
1571 1.114 bouyer goto again;
1572 1.114 bouyer }
1573 1.2 bouyer }
1574 1.163 thorpej out:
1575 1.31 bouyer __wdccommand_done(chp, xfer);
1576 1.31 bouyer return 1;
1577 1.2 bouyer }
1578 1.2 bouyer
1579 1.167 thorpej static void
1580 1.205 thorpej __wdccommand_done(struct ata_channel *chp, struct ata_xfer *xfer)
1581 1.2 bouyer {
1582 1.207 thorpej struct atac_softc *atac = chp->ch_atac;
1583 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
1584 1.205 thorpej struct wdc_regs *wdr = &wdc->regs[chp->ch_channel];
1585 1.192 thorpej struct ata_command *ata_c = xfer->c_cmd;
1586 1.2 bouyer
1587 1.233 bouyer ATADEBUG_PRINT(("__wdccommand_done %s:%d:%d flags 0x%x\n",
1588 1.233 bouyer atac->atac_dev.dv_xname, chp->ch_channel, xfer->c_drive,
1589 1.233 bouyer ata_c->flags), DEBUG_FUNCS);
1590 1.70 bouyer
1591 1.70 bouyer
1592 1.31 bouyer if (chp->ch_status & WDCS_DWF)
1593 1.192 thorpej ata_c->flags |= AT_DF;
1594 1.31 bouyer if (chp->ch_status & WDCS_ERR) {
1595 1.192 thorpej ata_c->flags |= AT_ERROR;
1596 1.192 thorpej ata_c->r_error = chp->ch_error;
1597 1.31 bouyer }
1598 1.192 thorpej if ((ata_c->flags & AT_READREG) != 0 &&
1599 1.235 thorpej device_is_active(&atac->atac_dev) &&
1600 1.192 thorpej (ata_c->flags & (AT_ERROR | AT_DF)) == 0) {
1601 1.205 thorpej ata_c->r_head = bus_space_read_1(wdr->cmd_iot,
1602 1.205 thorpej wdr->cmd_iohs[wd_sdh], 0);
1603 1.205 thorpej ata_c->r_count = bus_space_read_1(wdr->cmd_iot,
1604 1.205 thorpej wdr->cmd_iohs[wd_seccnt], 0);
1605 1.205 thorpej ata_c->r_sector = bus_space_read_1(wdr->cmd_iot,
1606 1.205 thorpej wdr->cmd_iohs[wd_sector], 0);
1607 1.221 fvdl ata_c->r_cyl = bus_space_read_1(wdr->cmd_iot,
1608 1.221 fvdl wdr->cmd_iohs[wd_cyl_hi], 0) << 8;
1609 1.205 thorpej ata_c->r_cyl |= bus_space_read_1(wdr->cmd_iot,
1610 1.205 thorpej wdr->cmd_iohs[wd_cyl_lo], 0);
1611 1.205 thorpej ata_c->r_error = bus_space_read_1(wdr->cmd_iot,
1612 1.205 thorpej wdr->cmd_iohs[wd_error], 0);
1613 1.205 thorpej ata_c->r_features = bus_space_read_1(wdr->cmd_iot,
1614 1.205 thorpej wdr->cmd_iohs[wd_features], 0);
1615 1.135 bouyer }
1616 1.186 bouyer callout_stop(&chp->ch_callout);
1617 1.187 bouyer chp->ch_queue->active_xfer = NULL;
1618 1.192 thorpej if (ata_c->flags & AT_POLL) {
1619 1.187 bouyer /* enable interrupts */
1620 1.205 thorpej bus_space_write_1(wdr->ctl_iot, wdr->ctl_ioh, wd_aux_ctlr,
1621 1.187 bouyer WDCTL_4BIT);
1622 1.187 bouyer delay(10); /* some drives need a little delay here */
1623 1.187 bouyer }
1624 1.187 bouyer if (chp->ch_drive[xfer->c_drive].drive_flags & DRIVE_WAITDRAIN) {
1625 1.187 bouyer __wdccommand_kill_xfer(chp, xfer, KILL_GONE);
1626 1.187 bouyer chp->ch_drive[xfer->c_drive].drive_flags &= ~DRIVE_WAITDRAIN;
1627 1.187 bouyer wakeup(&chp->ch_queue->active_xfer);
1628 1.219 perry } else
1629 1.187 bouyer __wdccommand_done_end(chp, xfer);
1630 1.182 bouyer }
1631 1.219 perry
1632 1.182 bouyer static void
1633 1.205 thorpej __wdccommand_done_end(struct ata_channel *chp, struct ata_xfer *xfer)
1634 1.182 bouyer {
1635 1.192 thorpej struct ata_command *ata_c = xfer->c_cmd;
1636 1.182 bouyer
1637 1.192 thorpej ata_c->flags |= AT_DONE;
1638 1.198 thorpej ata_free_xfer(chp, xfer);
1639 1.192 thorpej if (ata_c->flags & AT_WAIT)
1640 1.192 thorpej wakeup(ata_c);
1641 1.192 thorpej else if (ata_c->callback)
1642 1.192 thorpej ata_c->callback(ata_c->callback_arg);
1643 1.202 thorpej atastart(chp);
1644 1.31 bouyer return;
1645 1.2 bouyer }
1646 1.2 bouyer
1647 1.182 bouyer static void
1648 1.205 thorpej __wdccommand_kill_xfer(struct ata_channel *chp, struct ata_xfer *xfer,
1649 1.182 bouyer int reason)
1650 1.182 bouyer {
1651 1.192 thorpej struct ata_command *ata_c = xfer->c_cmd;
1652 1.182 bouyer
1653 1.182 bouyer switch (reason) {
1654 1.182 bouyer case KILL_GONE:
1655 1.192 thorpej ata_c->flags |= AT_GONE;
1656 1.219 perry break;
1657 1.182 bouyer case KILL_RESET:
1658 1.192 thorpej ata_c->flags |= AT_RESET;
1659 1.182 bouyer break;
1660 1.182 bouyer default:
1661 1.182 bouyer printf("__wdccommand_kill_xfer: unknown reason %d\n",
1662 1.182 bouyer reason);
1663 1.182 bouyer panic("__wdccommand_kill_xfer");
1664 1.182 bouyer }
1665 1.182 bouyer __wdccommand_done_end(chp, xfer);
1666 1.182 bouyer }
1667 1.182 bouyer
1668 1.2 bouyer /*
1669 1.31 bouyer * Send a command. The drive should be ready.
1670 1.2 bouyer * Assumes interrupts are blocked.
1671 1.2 bouyer */
1672 1.31 bouyer void
1673 1.205 thorpej wdccommand(struct ata_channel *chp, u_int8_t drive, u_int8_t command,
1674 1.163 thorpej u_int16_t cylin, u_int8_t head, u_int8_t sector, u_int8_t count,
1675 1.178 thorpej u_int8_t features)
1676 1.31 bouyer {
1677 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
1678 1.205 thorpej struct wdc_regs *wdr = &wdc->regs[chp->ch_channel];
1679 1.163 thorpej
1680 1.204 thorpej ATADEBUG_PRINT(("wdccommand %s:%d:%d: command=0x%x cylin=%d head=%d "
1681 1.247 dyoung "sector=%d count=%d features=%d\n", chp->ch_atac->atac_dev.dv_xname,
1682 1.169 thorpej chp->ch_channel, drive, command, cylin, head, sector, count,
1683 1.178 thorpej features), DEBUG_FUNCS);
1684 1.31 bouyer
1685 1.203 thorpej if (wdc->select)
1686 1.169 thorpej wdc->select(chp,drive);
1687 1.107 dbj
1688 1.31 bouyer /* Select drive, head, and addressing mode. */
1689 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh], 0,
1690 1.31 bouyer WDSD_IBM | (drive << 4) | head);
1691 1.177 thorpej /* Load parameters into the wd_features register. */
1692 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_features], 0,
1693 1.178 thorpej features);
1694 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_seccnt], 0, count);
1695 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sector], 0, sector);
1696 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_cyl_lo], 0, cylin);
1697 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_cyl_hi],
1698 1.157 fvdl 0, cylin >> 8);
1699 1.108 christos
1700 1.108 christos /* Send command. */
1701 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_command], 0, command);
1702 1.108 christos return;
1703 1.108 christos }
1704 1.108 christos
1705 1.108 christos /*
1706 1.108 christos * Send a 48-bit addressing command. The drive should be ready.
1707 1.108 christos * Assumes interrupts are blocked.
1708 1.108 christos */
1709 1.108 christos void
1710 1.205 thorpej wdccommandext(struct ata_channel *chp, u_int8_t drive, u_int8_t command,
1711 1.163 thorpej u_int64_t blkno, u_int16_t count)
1712 1.108 christos {
1713 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
1714 1.205 thorpej struct wdc_regs *wdr = &wdc->regs[chp->ch_channel];
1715 1.163 thorpej
1716 1.204 thorpej ATADEBUG_PRINT(("wdccommandext %s:%d:%d: command=0x%x blkno=%d "
1717 1.247 dyoung "count=%d\n", chp->ch_atac->atac_dev.dv_xname,
1718 1.169 thorpej chp->ch_channel, drive, command, (u_int32_t) blkno, count),
1719 1.108 christos DEBUG_FUNCS);
1720 1.108 christos
1721 1.203 thorpej if (wdc->select)
1722 1.169 thorpej wdc->select(chp,drive);
1723 1.108 christos
1724 1.108 christos /* Select drive, head, and addressing mode. */
1725 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh], 0,
1726 1.108 christos (drive << 4) | WDSD_LBA);
1727 1.108 christos
1728 1.218 rearnsha if (wdc->cap & WDC_CAPABILITY_WIDEREGS) {
1729 1.218 rearnsha bus_space_write_2(wdr->cmd_iot, wdr->cmd_iohs[wd_features], 0,
1730 1.218 rearnsha 0);
1731 1.218 rearnsha bus_space_write_2(wdr->cmd_iot, wdr->cmd_iohs[wd_seccnt],
1732 1.218 rearnsha 0, count);
1733 1.218 rearnsha bus_space_write_2(wdr->cmd_iot, wdr->cmd_iohs[wd_lba_lo],
1734 1.218 rearnsha 0, (((blkno >> 16) & 0xff00) | (blkno & 0x00ff)));
1735 1.218 rearnsha bus_space_write_2(wdr->cmd_iot, wdr->cmd_iohs[wd_lba_mi],
1736 1.218 rearnsha 0, (((blkno >> 24) & 0xff00) | ((blkno >> 8) & 0x00ff)));
1737 1.218 rearnsha bus_space_write_2(wdr->cmd_iot, wdr->cmd_iohs[wd_lba_hi],
1738 1.218 rearnsha 0, (((blkno >> 32) & 0xff00) | ((blkno >> 16) & 0x00ff)));
1739 1.218 rearnsha } else {
1740 1.218 rearnsha /* previous */
1741 1.218 rearnsha bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_features], 0,
1742 1.218 rearnsha 0);
1743 1.218 rearnsha bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_seccnt],
1744 1.218 rearnsha 0, count >> 8);
1745 1.218 rearnsha bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_lba_lo],
1746 1.218 rearnsha 0, blkno >> 24);
1747 1.218 rearnsha bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_lba_mi],
1748 1.218 rearnsha 0, blkno >> 32);
1749 1.218 rearnsha bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_lba_hi],
1750 1.218 rearnsha 0, blkno >> 40);
1751 1.218 rearnsha
1752 1.218 rearnsha /* current */
1753 1.218 rearnsha bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_features], 0,
1754 1.218 rearnsha 0);
1755 1.218 rearnsha bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_seccnt], 0,
1756 1.218 rearnsha count);
1757 1.218 rearnsha bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_lba_lo], 0,
1758 1.218 rearnsha blkno);
1759 1.218 rearnsha bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_lba_mi],
1760 1.218 rearnsha 0, blkno >> 8);
1761 1.218 rearnsha bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_lba_hi],
1762 1.218 rearnsha 0, blkno >> 16);
1763 1.218 rearnsha }
1764 1.2 bouyer
1765 1.31 bouyer /* Send command. */
1766 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_command], 0, command);
1767 1.31 bouyer return;
1768 1.2 bouyer }
1769 1.2 bouyer
1770 1.2 bouyer /*
1771 1.31 bouyer * Simplified version of wdccommand(). Unbusy/ready/drq must be
1772 1.31 bouyer * tested by the caller.
1773 1.2 bouyer */
1774 1.31 bouyer void
1775 1.205 thorpej wdccommandshort(struct ata_channel *chp, int drive, int command)
1776 1.2 bouyer {
1777 1.207 thorpej struct wdc_softc *wdc = CHAN_TO_WDC(chp);
1778 1.205 thorpej struct wdc_regs *wdr = &wdc->regs[chp->ch_channel];
1779 1.2 bouyer
1780 1.204 thorpej ATADEBUG_PRINT(("wdccommandshort %s:%d:%d command 0x%x\n",
1781 1.247 dyoung chp->ch_atac->atac_dev.dv_xname, chp->ch_channel, drive, command),
1782 1.31 bouyer DEBUG_FUNCS);
1783 1.107 dbj
1784 1.203 thorpej if (wdc->select)
1785 1.169 thorpej wdc->select(chp,drive);
1786 1.2 bouyer
1787 1.31 bouyer /* Select drive. */
1788 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh], 0,
1789 1.31 bouyer WDSD_IBM | (drive << 4));
1790 1.2 bouyer
1791 1.205 thorpej bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_command], 0, command);
1792 1.31 bouyer }
1793 1.2 bouyer
1794 1.31 bouyer static void
1795 1.222 christos __wdcerror(struct ata_channel *chp, const char *msg)
1796 1.2 bouyer {
1797 1.207 thorpej struct atac_softc *atac = chp->ch_atac;
1798 1.217 bouyer struct ata_xfer *xfer = chp->ch_queue->active_xfer;
1799 1.88 mrg
1800 1.2 bouyer if (xfer == NULL)
1801 1.207 thorpej printf("%s:%d: %s\n", atac->atac_dev.dv_xname, chp->ch_channel,
1802 1.31 bouyer msg);
1803 1.2 bouyer else
1804 1.207 thorpej printf("%s:%d:%d: %s\n", atac->atac_dev.dv_xname,
1805 1.169 thorpej chp->ch_channel, xfer->c_drive, msg);
1806 1.2 bouyer }
1807 1.2 bouyer
1808 1.219 perry /*
1809 1.2 bouyer * the bit bucket
1810 1.2 bouyer */
1811 1.2 bouyer void
1812 1.205 thorpej wdcbit_bucket(struct ata_channel *chp, int size)
1813 1.2 bouyer {
1814 1.207 thorpej struct wdc_regs *wdr = CHAN_TO_WDC_REGS(chp);
1815 1.2 bouyer
1816 1.12 cgd for (; size >= 2; size -= 2)
1817 1.205 thorpej (void)bus_space_read_2(wdr->cmd_iot, wdr->cmd_iohs[wd_data], 0);
1818 1.12 cgd if (size)
1819 1.205 thorpej (void)bus_space_read_1(wdr->cmd_iot, wdr->cmd_iohs[wd_data], 0);
1820 1.44 thorpej }
1821 1.44 thorpej
1822 1.213 thorpej static void
1823 1.222 christos wdc_datain_pio(struct ata_channel *chp, int flags, void *bf, size_t len)
1824 1.190 mycroft {
1825 1.207 thorpej struct wdc_regs *wdr = CHAN_TO_WDC_REGS(chp);
1826 1.190 mycroft
1827 1.244 martin #ifndef __NO_STRICT_ALIGNMENT
1828 1.244 martin if ((uintptr_t)bf & 1)
1829 1.244 martin goto unaligned;
1830 1.244 martin if ((flags & DRIVE_CAP32) && ((uintptr_t)bf & 3))
1831 1.244 martin goto unaligned;
1832 1.244 martin #endif
1833 1.244 martin
1834 1.190 mycroft if (flags & DRIVE_NOSTREAM) {
1835 1.190 mycroft if (flags & DRIVE_CAP32) {
1836 1.205 thorpej bus_space_read_multi_4(wdr->data32iot,
1837 1.222 christos wdr->data32ioh, 0, bf, len >> 2);
1838 1.222 christos bf = (char *)bf + (len & ~3);
1839 1.190 mycroft len &= 3;
1840 1.190 mycroft }
1841 1.190 mycroft if (len) {
1842 1.205 thorpej bus_space_read_multi_2(wdr->cmd_iot,
1843 1.222 christos wdr->cmd_iohs[wd_data], 0, bf, len >> 1);
1844 1.190 mycroft }
1845 1.190 mycroft } else {
1846 1.190 mycroft if (flags & DRIVE_CAP32) {
1847 1.205 thorpej bus_space_read_multi_stream_4(wdr->data32iot,
1848 1.222 christos wdr->data32ioh, 0, bf, len >> 2);
1849 1.222 christos bf = (char *)bf + (len & ~3);
1850 1.190 mycroft len &= 3;
1851 1.190 mycroft }
1852 1.190 mycroft if (len) {
1853 1.205 thorpej bus_space_read_multi_stream_2(wdr->cmd_iot,
1854 1.222 christos wdr->cmd_iohs[wd_data], 0, bf, len >> 1);
1855 1.190 mycroft }
1856 1.190 mycroft }
1857 1.244 martin return;
1858 1.244 martin
1859 1.244 martin #ifndef __NO_STRICT_ALIGNMENT
1860 1.244 martin unaligned:
1861 1.245 bouyer if (flags & DRIVE_NOSTREAM) {
1862 1.245 bouyer if (flags & DRIVE_CAP32) {
1863 1.245 bouyer while (len > 3) {
1864 1.245 bouyer uint32_t val;
1865 1.245 bouyer
1866 1.245 bouyer val = bus_space_read_4(wdr->data32iot,
1867 1.245 bouyer wdr->data32ioh, 0);
1868 1.245 bouyer memcpy(bf, &val, 4);
1869 1.245 bouyer bf = (char *)bf + 4;
1870 1.245 bouyer len -= 4;
1871 1.245 bouyer }
1872 1.245 bouyer }
1873 1.245 bouyer while (len > 1) {
1874 1.245 bouyer uint16_t val;
1875 1.245 bouyer
1876 1.245 bouyer val = bus_space_read_2(wdr->cmd_iot,
1877 1.245 bouyer wdr->cmd_iohs[wd_data], 0);
1878 1.245 bouyer memcpy(bf, &val, 2);
1879 1.245 bouyer bf = (char *)bf + 2;
1880 1.245 bouyer len -= 2;
1881 1.245 bouyer }
1882 1.245 bouyer } else {
1883 1.245 bouyer if (flags & DRIVE_CAP32) {
1884 1.245 bouyer while (len > 3) {
1885 1.245 bouyer uint32_t val;
1886 1.244 martin
1887 1.245 bouyer val = bus_space_read_stream_4(wdr->data32iot,
1888 1.245 bouyer wdr->data32ioh, 0);
1889 1.245 bouyer memcpy(bf, &val, 4);
1890 1.245 bouyer bf = (char *)bf + 4;
1891 1.245 bouyer len -= 4;
1892 1.245 bouyer }
1893 1.245 bouyer }
1894 1.245 bouyer while (len > 1) {
1895 1.245 bouyer uint16_t val;
1896 1.245 bouyer
1897 1.245 bouyer val = bus_space_read_stream_2(wdr->cmd_iot,
1898 1.244 martin wdr->cmd_iohs[wd_data], 0);
1899 1.245 bouyer memcpy(bf, &val, 2);
1900 1.245 bouyer bf = (char *)bf + 2;
1901 1.245 bouyer len -= 2;
1902 1.244 martin }
1903 1.244 martin }
1904 1.244 martin #endif
1905 1.190 mycroft }
1906 1.190 mycroft
1907 1.213 thorpej static void
1908 1.222 christos wdc_dataout_pio(struct ata_channel *chp, int flags, void *bf, size_t len)
1909 1.190 mycroft {
1910 1.207 thorpej struct wdc_regs *wdr = CHAN_TO_WDC_REGS(chp);
1911 1.190 mycroft
1912 1.244 martin #ifndef __NO_STRICT_ALIGNMENT
1913 1.244 martin if ((uintptr_t)bf & 1)
1914 1.244 martin goto unaligned;
1915 1.244 martin if ((flags & DRIVE_CAP32) && ((uintptr_t)bf & 3))
1916 1.244 martin goto unaligned;
1917 1.244 martin #endif
1918 1.244 martin
1919 1.190 mycroft if (flags & DRIVE_NOSTREAM) {
1920 1.190 mycroft if (flags & DRIVE_CAP32) {
1921 1.205 thorpej bus_space_write_multi_4(wdr->data32iot,
1922 1.222 christos wdr->data32ioh, 0, bf, len >> 2);
1923 1.222 christos bf = (char *)bf + (len & ~3);
1924 1.190 mycroft len &= 3;
1925 1.190 mycroft }
1926 1.190 mycroft if (len) {
1927 1.205 thorpej bus_space_write_multi_2(wdr->cmd_iot,
1928 1.222 christos wdr->cmd_iohs[wd_data], 0, bf, len >> 1);
1929 1.190 mycroft }
1930 1.190 mycroft } else {
1931 1.190 mycroft if (flags & DRIVE_CAP32) {
1932 1.205 thorpej bus_space_write_multi_stream_4(wdr->data32iot,
1933 1.222 christos wdr->data32ioh, 0, bf, len >> 2);
1934 1.222 christos bf = (char *)bf + (len & ~3);
1935 1.190 mycroft len &= 3;
1936 1.190 mycroft }
1937 1.190 mycroft if (len) {
1938 1.205 thorpej bus_space_write_multi_stream_2(wdr->cmd_iot,
1939 1.222 christos wdr->cmd_iohs[wd_data], 0, bf, len >> 1);
1940 1.190 mycroft }
1941 1.190 mycroft }
1942 1.244 martin return;
1943 1.244 martin
1944 1.244 martin #ifndef __NO_STRICT_ALIGNMENT
1945 1.244 martin unaligned:
1946 1.245 bouyer if (flags & DRIVE_NOSTREAM) {
1947 1.245 bouyer if (flags & DRIVE_CAP32) {
1948 1.245 bouyer while (len > 3) {
1949 1.245 bouyer uint32_t val;
1950 1.244 martin
1951 1.245 bouyer memcpy(&val, bf, 4);
1952 1.245 bouyer bus_space_write_4(wdr->data32iot,
1953 1.245 bouyer wdr->data32ioh, 0, val);
1954 1.245 bouyer bf = (char *)bf + 4;
1955 1.245 bouyer len -= 4;
1956 1.245 bouyer }
1957 1.245 bouyer }
1958 1.245 bouyer while (len > 1) {
1959 1.245 bouyer uint16_t val;
1960 1.245 bouyer
1961 1.245 bouyer memcpy(&val, bf, 2);
1962 1.245 bouyer bus_space_write_2(wdr->cmd_iot,
1963 1.244 martin wdr->cmd_iohs[wd_data], 0, val);
1964 1.245 bouyer bf = (char *)bf + 2;
1965 1.245 bouyer len -= 2;
1966 1.244 martin }
1967 1.245 bouyer } else {
1968 1.245 bouyer if (flags & DRIVE_CAP32) {
1969 1.245 bouyer while (len > 3) {
1970 1.245 bouyer uint32_t val;
1971 1.245 bouyer
1972 1.245 bouyer memcpy(&val, bf, 4);
1973 1.245 bouyer bus_space_write_stream_4(wdr->data32iot,
1974 1.245 bouyer wdr->data32ioh, 0, val);
1975 1.245 bouyer bf = (char *)bf + 4;
1976 1.245 bouyer len -= 4;
1977 1.245 bouyer }
1978 1.245 bouyer }
1979 1.245 bouyer while (len > 1) {
1980 1.245 bouyer uint16_t val;
1981 1.244 martin
1982 1.245 bouyer memcpy(&val, bf, 2);
1983 1.245 bouyer bus_space_write_stream_2(wdr->cmd_iot,
1984 1.245 bouyer wdr->cmd_iohs[wd_data], 0, val);
1985 1.245 bouyer bf = (char *)bf + 2;
1986 1.245 bouyer len -= 2;
1987 1.245 bouyer }
1988 1.244 martin }
1989 1.244 martin #endif
1990 1.190 mycroft }
1991