atapi_wdc.c revision 1.30 1 1.30 bouyer /* $NetBSD: atapi_wdc.c,v 1.30 2000/01/17 00:01:01 bouyer Exp $ */
2 1.2 bouyer
3 1.2 bouyer /*
4 1.2 bouyer * Copyright (c) 1998 Manuel Bouyer.
5 1.2 bouyer *
6 1.2 bouyer * Redistribution and use in source and binary forms, with or without
7 1.2 bouyer * modification, are permitted provided that the following conditions
8 1.2 bouyer * are met:
9 1.2 bouyer * 1. Redistributions of source code must retain the above copyright
10 1.2 bouyer * notice, this list of conditions and the following disclaimer.
11 1.2 bouyer * 2. Redistributions in binary form must reproduce the above copyright
12 1.2 bouyer * notice, this list of conditions and the following disclaimer in the
13 1.2 bouyer * documentation and/or other materials provided with the distribution.
14 1.2 bouyer * 3. All advertising materials mentioning features or use of this software
15 1.2 bouyer * must display the following acknowledgement:
16 1.2 bouyer * This product includes software developed by the University of
17 1.2 bouyer * California, Berkeley and its contributors.
18 1.2 bouyer * 4. Neither the name of the University nor the names of its contributors
19 1.2 bouyer * may be used to endorse or promote products derived from this software
20 1.2 bouyer * without specific prior written permission.
21 1.2 bouyer *
22 1.2 bouyer * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
23 1.2 bouyer * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24 1.2 bouyer * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25 1.2 bouyer * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
26 1.2 bouyer * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27 1.2 bouyer * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
28 1.2 bouyer * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29 1.2 bouyer * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30 1.2 bouyer * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31 1.2 bouyer * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32 1.2 bouyer * SUCH DAMAGE.
33 1.2 bouyer *
34 1.2 bouyer */
35 1.2 bouyer
36 1.18 hubertf #ifndef WDCDEBUG
37 1.2 bouyer #define WDCDEBUG
38 1.18 hubertf #endif /* WDCDEBUG */
39 1.2 bouyer
40 1.2 bouyer #include <sys/param.h>
41 1.2 bouyer #include <sys/systm.h>
42 1.2 bouyer #include <sys/kernel.h>
43 1.2 bouyer #include <sys/file.h>
44 1.2 bouyer #include <sys/stat.h>
45 1.2 bouyer #include <sys/buf.h>
46 1.2 bouyer #include <sys/malloc.h>
47 1.2 bouyer #include <sys/device.h>
48 1.2 bouyer #include <sys/syslog.h>
49 1.2 bouyer #include <sys/proc.h>
50 1.2 bouyer
51 1.2 bouyer #include <vm/vm.h>
52 1.2 bouyer
53 1.2 bouyer #include <machine/intr.h>
54 1.2 bouyer #include <machine/bus.h>
55 1.2 bouyer
56 1.2 bouyer #ifndef __BUS_SPACE_HAS_STREAM_METHODS
57 1.2 bouyer #define bus_space_write_multi_stream_2 bus_space_write_multi_2
58 1.2 bouyer #define bus_space_write_multi_stream_4 bus_space_write_multi_4
59 1.2 bouyer #define bus_space_read_multi_stream_2 bus_space_read_multi_2
60 1.2 bouyer #define bus_space_read_multi_stream_4 bus_space_read_multi_4
61 1.2 bouyer #endif /* __BUS_SPACE_HAS_STREAM_METHODS */
62 1.2 bouyer
63 1.2 bouyer #include <dev/ata/atareg.h>
64 1.2 bouyer #include <dev/ata/atavar.h>
65 1.2 bouyer #include <dev/ic/wdcreg.h>
66 1.2 bouyer #include <dev/ic/wdcvar.h>
67 1.2 bouyer #include <dev/scsipi/scsipi_all.h>
68 1.2 bouyer #include <dev/scsipi/scsipiconf.h>
69 1.2 bouyer #include <dev/scsipi/atapiconf.h>
70 1.2 bouyer
71 1.2 bouyer #define DEBUG_INTR 0x01
72 1.2 bouyer #define DEBUG_XFERS 0x02
73 1.2 bouyer #define DEBUG_STATUS 0x04
74 1.2 bouyer #define DEBUG_FUNCS 0x08
75 1.2 bouyer #define DEBUG_PROBE 0x10
76 1.2 bouyer #ifdef WDCDEBUG
77 1.3 bouyer int wdcdebug_atapi_mask = 0;
78 1.2 bouyer #define WDCDEBUG_PRINT(args, level) \
79 1.2 bouyer if (wdcdebug_atapi_mask & (level)) \
80 1.2 bouyer printf args
81 1.2 bouyer #else
82 1.2 bouyer #define WDCDEBUG_PRINT(args, level)
83 1.2 bouyer #endif
84 1.2 bouyer
85 1.2 bouyer #define ATAPI_DELAY 10 /* 10 ms, this is used only before sending a cmd */
86 1.2 bouyer
87 1.2 bouyer void wdc_atapi_minphys __P((struct buf *bp));
88 1.2 bouyer void wdc_atapi_start __P((struct channel_softc *,struct wdc_xfer *));
89 1.20 bouyer int wdc_atapi_intr __P((struct channel_softc *, struct wdc_xfer *, int));
90 1.28 enami void wdc_atapi_kill_xfer __P((struct channel_softc *, struct wdc_xfer *));
91 1.20 bouyer int wdc_atapi_ctrl __P((struct channel_softc *, struct wdc_xfer *, int));
92 1.2 bouyer void wdc_atapi_done __P((struct channel_softc *, struct wdc_xfer *));
93 1.2 bouyer void wdc_atapi_reset __P((struct channel_softc *, struct wdc_xfer *));
94 1.2 bouyer int wdc_atapi_send_cmd __P((struct scsipi_xfer *sc_xfer));
95 1.2 bouyer
96 1.2 bouyer #define MAX_SIZE MAXPHYS
97 1.2 bouyer
98 1.2 bouyer void
99 1.2 bouyer wdc_atapibus_attach(chp)
100 1.2 bouyer struct channel_softc *chp;
101 1.2 bouyer {
102 1.2 bouyer struct wdc_softc *wdc = chp->wdc;
103 1.2 bouyer int channel = chp->channel;
104 1.2 bouyer struct ata_atapi_attach aa_link;
105 1.2 bouyer
106 1.9 thorpej /*
107 1.9 thorpej * Fill in the adapter.
108 1.9 thorpej */
109 1.9 thorpej wdc->sc_atapi_adapter.scsipi_cmd = wdc_atapi_send_cmd;
110 1.9 thorpej wdc->sc_atapi_adapter.scsipi_minphys = wdc_atapi_minphys;
111 1.9 thorpej
112 1.2 bouyer memset(&aa_link, 0, sizeof(struct ata_atapi_attach));
113 1.2 bouyer aa_link.aa_type = T_ATAPI;
114 1.2 bouyer aa_link.aa_channel = channel;
115 1.2 bouyer aa_link.aa_openings = 1;
116 1.2 bouyer aa_link.aa_drv_data = chp->ch_drive; /* pass the whole array */
117 1.9 thorpej aa_link.aa_bus_private = &wdc->sc_atapi_adapter;
118 1.26 enami chp->atapibus = config_found(&wdc->sc_dev, (void *)&aa_link,
119 1.26 enami atapi_print);
120 1.2 bouyer }
121 1.2 bouyer
122 1.2 bouyer void
123 1.2 bouyer wdc_atapi_minphys (struct buf *bp)
124 1.2 bouyer {
125 1.2 bouyer if(bp->b_bcount > MAX_SIZE)
126 1.2 bouyer bp->b_bcount = MAX_SIZE;
127 1.2 bouyer minphys(bp);
128 1.2 bouyer }
129 1.2 bouyer
130 1.28 enami /*
131 1.28 enami * Kill off all pending xfers for a scsipi_link.
132 1.28 enami *
133 1.28 enami * Must be called at splbio().
134 1.28 enami */
135 1.28 enami void
136 1.28 enami atapi_kill_pending(sc_link)
137 1.28 enami struct scsipi_link *sc_link;
138 1.28 enami {
139 1.28 enami struct wdc_softc *wdc = (void *)sc_link->adapter_softc;
140 1.28 enami struct channel_softc *chp =
141 1.28 enami wdc->channels[sc_link->scsipi_atapi.channel];
142 1.28 enami
143 1.28 enami wdc_kill_pending(chp);
144 1.28 enami }
145 1.28 enami
146 1.28 enami void
147 1.28 enami wdc_atapi_kill_xfer(chp, xfer)
148 1.28 enami struct channel_softc *chp;
149 1.28 enami struct wdc_xfer *xfer;
150 1.28 enami {
151 1.28 enami struct scsipi_xfer *sc_xfer = xfer->cmd;
152 1.28 enami
153 1.28 enami untimeout(wdctimeout, chp);
154 1.28 enami /* remove this command from xfer queue */
155 1.28 enami wdc_free_xfer(chp, xfer);
156 1.28 enami sc_xfer->xs_status |= XS_STS_DONE;
157 1.28 enami sc_xfer->error = XS_DRIVER_STUFFUP;
158 1.28 enami scsipi_done(sc_xfer);
159 1.28 enami }
160 1.28 enami
161 1.2 bouyer int
162 1.2 bouyer wdc_atapi_get_params(ab_link, drive, flags, id)
163 1.2 bouyer struct scsipi_link *ab_link;
164 1.2 bouyer u_int8_t drive;
165 1.2 bouyer int flags;
166 1.2 bouyer struct ataparams *id;
167 1.2 bouyer {
168 1.2 bouyer struct wdc_softc *wdc = (void*)ab_link->adapter_softc;
169 1.2 bouyer struct channel_softc *chp =
170 1.10 drochner wdc->channels[ab_link->scsipi_atapi.channel];
171 1.2 bouyer struct wdc_command wdc_c;
172 1.2 bouyer
173 1.2 bouyer /* if no ATAPI device detected at wdc attach time, skip */
174 1.2 bouyer /*
175 1.2 bouyer * XXX this will break scsireprobe if this is of any interest for
176 1.2 bouyer * ATAPI devices one day.
177 1.2 bouyer */
178 1.2 bouyer if ((chp->ch_drive[drive].drive_flags & DRIVE_ATAPI) == 0) {
179 1.2 bouyer WDCDEBUG_PRINT(("wdc_atapi_get_params: drive %d not present\n",
180 1.2 bouyer drive), DEBUG_PROBE);
181 1.2 bouyer return -1;
182 1.2 bouyer }
183 1.2 bouyer memset(&wdc_c, 0, sizeof(struct wdc_command));
184 1.2 bouyer wdc_c.r_command = ATAPI_SOFT_RESET;
185 1.2 bouyer wdc_c.r_st_bmask = 0;
186 1.2 bouyer wdc_c.r_st_pmask = 0;
187 1.2 bouyer wdc_c.flags = AT_POLL;
188 1.2 bouyer wdc_c.timeout = WDC_RESET_WAIT;
189 1.2 bouyer if (wdc_exec_command(&chp->ch_drive[drive], &wdc_c) != WDC_COMPLETE) {
190 1.2 bouyer printf("wdc_atapi_get_params: ATAPI_SOFT_RESET failed for"
191 1.2 bouyer " drive %s:%d:%d: driver failed\n",
192 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drive);
193 1.2 bouyer panic("wdc_atapi_get_params");
194 1.2 bouyer }
195 1.2 bouyer if (wdc_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
196 1.2 bouyer WDCDEBUG_PRINT(("wdc_atapi_get_params: ATAPI_SOFT_RESET "
197 1.2 bouyer "failed for drive %s:%d:%d: error 0x%x\n",
198 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drive,
199 1.2 bouyer wdc_c.r_error), DEBUG_PROBE);
200 1.2 bouyer return -1;
201 1.2 bouyer }
202 1.2 bouyer chp->ch_drive[drive].state = 0;
203 1.2 bouyer
204 1.2 bouyer bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_status);
205 1.2 bouyer
206 1.2 bouyer /* Some ATAPI devices need a bit more time after software reset. */
207 1.2 bouyer delay(5000);
208 1.2 bouyer if (ata_get_params(&chp->ch_drive[drive], AT_POLL, id) != 0) {
209 1.2 bouyer WDCDEBUG_PRINT(("wdc_atapi_get_params: ATAPI_IDENTIFY_DEVICE "
210 1.2 bouyer "failed for drive %s:%d:%d: error 0x%x\n",
211 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drive,
212 1.2 bouyer wdc_c.r_error), DEBUG_PROBE);
213 1.2 bouyer return -1;
214 1.2 bouyer }
215 1.2 bouyer return COMPLETE;
216 1.2 bouyer }
217 1.2 bouyer
218 1.2 bouyer int
219 1.2 bouyer wdc_atapi_send_cmd(sc_xfer)
220 1.2 bouyer struct scsipi_xfer *sc_xfer;
221 1.2 bouyer {
222 1.12 bouyer struct wdc_softc *wdc = (void*)sc_xfer->sc_link->adapter_softc;
223 1.2 bouyer struct wdc_xfer *xfer;
224 1.27 thorpej int flags = sc_xfer->xs_control;
225 1.2 bouyer int channel = sc_xfer->sc_link->scsipi_atapi.channel;
226 1.2 bouyer int drive = sc_xfer->sc_link->scsipi_atapi.drive;
227 1.2 bouyer int s, ret;
228 1.2 bouyer
229 1.5 bouyer WDCDEBUG_PRINT(("wdc_atapi_send_cmd %s:%d:%d\n",
230 1.5 bouyer wdc->sc_dev.dv_xname, channel, drive), DEBUG_XFERS);
231 1.2 bouyer
232 1.27 thorpej xfer = wdc_get_xfer((flags & XS_CTL_NOSLEEP) ?
233 1.27 thorpej WDC_NOSLEEP : WDC_CANSLEEP);
234 1.2 bouyer if (xfer == NULL) {
235 1.2 bouyer return TRY_AGAIN_LATER;
236 1.2 bouyer }
237 1.27 thorpej if (sc_xfer->xs_control & XS_CTL_POLL)
238 1.2 bouyer xfer->c_flags |= C_POLL;
239 1.2 bouyer xfer->drive = drive;
240 1.2 bouyer xfer->c_flags |= C_ATAPI;
241 1.2 bouyer xfer->cmd = sc_xfer;
242 1.2 bouyer xfer->databuf = sc_xfer->data;
243 1.2 bouyer xfer->c_bcount = sc_xfer->datalen;
244 1.2 bouyer xfer->c_start = wdc_atapi_start;
245 1.2 bouyer xfer->c_intr = wdc_atapi_intr;
246 1.28 enami xfer->c_kill_xfer = wdc_atapi_kill_xfer;
247 1.2 bouyer s = splbio();
248 1.10 drochner wdc_exec_xfer(wdc->channels[channel], xfer);
249 1.2 bouyer #ifdef DIAGNOSTIC
250 1.27 thorpej if ((sc_xfer->xs_control & XS_CTL_POLL) != 0 &&
251 1.27 thorpej (sc_xfer->xs_status & XS_STS_DONE) == 0)
252 1.2 bouyer panic("wdc_atapi_send_cmd: polled command not done");
253 1.2 bouyer #endif
254 1.27 thorpej ret = (sc_xfer->xs_status & XS_STS_DONE) ?
255 1.27 thorpej COMPLETE : SUCCESSFULLY_QUEUED;
256 1.2 bouyer splx(s);
257 1.2 bouyer return ret;
258 1.2 bouyer }
259 1.2 bouyer
260 1.2 bouyer void
261 1.2 bouyer wdc_atapi_start(chp, xfer)
262 1.2 bouyer struct channel_softc *chp;
263 1.2 bouyer struct wdc_xfer *xfer;
264 1.2 bouyer {
265 1.2 bouyer struct scsipi_xfer *sc_xfer = xfer->cmd;
266 1.2 bouyer struct ata_drive_datas *drvp = &chp->ch_drive[xfer->drive];
267 1.2 bouyer
268 1.5 bouyer WDCDEBUG_PRINT(("wdc_atapi_start %s:%d:%d, scsi flags 0x%x \n",
269 1.5 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drvp->drive,
270 1.27 thorpej sc_xfer->xs_control), DEBUG_XFERS);
271 1.19 bouyer /* Adjust C_DMA, it may have changed if we are requesting sense */
272 1.19 bouyer if ((drvp->drive_flags & (DRIVE_DMA | DRIVE_UDMA)) &&
273 1.30 bouyer (sc_xfer->datalen > 0 || (xfer->c_flags & C_SENSE))) {
274 1.30 bouyer if (drvp->n_xfers <= NXFER)
275 1.30 bouyer drvp->n_xfers++;
276 1.19 bouyer xfer->c_flags |= C_DMA;
277 1.30 bouyer } else {
278 1.19 bouyer xfer->c_flags &= ~C_DMA;
279 1.30 bouyer }
280 1.24 bouyer /* start timeout machinery */
281 1.27 thorpej if ((sc_xfer->xs_control & XS_CTL_POLL) == 0)
282 1.24 bouyer timeout(wdctimeout, chp, sc_xfer->timeout * hz / 1000);
283 1.2 bouyer /* Do control operations specially. */
284 1.2 bouyer if (drvp->state < READY) {
285 1.2 bouyer if (drvp->state != PIOMODE) {
286 1.2 bouyer printf("%s:%d:%d: bad state %d in wdc_atapi_start\n",
287 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel,
288 1.2 bouyer xfer->drive, drvp->state);
289 1.2 bouyer panic("wdc_atapi_start: bad state");
290 1.2 bouyer }
291 1.20 bouyer wdc_atapi_ctrl(chp, xfer, 0);
292 1.2 bouyer return;
293 1.2 bouyer }
294 1.2 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
295 1.2 bouyer WDSD_IBM | (xfer->drive << 4));
296 1.2 bouyer if (wait_for_unbusy(chp, ATAPI_DELAY) < 0) {
297 1.2 bouyer printf("wdc_atapi_start: not ready, st = %02x\n",
298 1.2 bouyer chp->ch_status);
299 1.3 bouyer sc_xfer->error = XS_TIMEOUT;
300 1.2 bouyer wdc_atapi_reset(chp, xfer);
301 1.2 bouyer return;
302 1.2 bouyer }
303 1.2 bouyer
304 1.2 bouyer /*
305 1.2 bouyer * Even with WDCS_ERR, the device should accept a command packet
306 1.2 bouyer * Limit length to what can be stuffed into the cylinder register
307 1.2 bouyer * (16 bits). Some CD-ROMs seem to interpret '0' as 65536,
308 1.2 bouyer * but not all devices do that and it's not obvious from the
309 1.2 bouyer * ATAPI spec that that behaviour should be expected. If more
310 1.2 bouyer * data is necessary, multiple data transfer phases will be done.
311 1.2 bouyer */
312 1.5 bouyer
313 1.2 bouyer wdccommand(chp, xfer->drive, ATAPI_PKT_CMD,
314 1.29 bouyer xfer->c_bcount <= 0xffff ? xfer->c_bcount : 0xffff,
315 1.2 bouyer 0, 0, 0,
316 1.2 bouyer (xfer->c_flags & C_DMA) ? ATAPI_PKT_CMD_FTRE_DMA : 0);
317 1.2 bouyer
318 1.2 bouyer /*
319 1.2 bouyer * If there is no interrupt for CMD input, busy-wait for it (done in
320 1.2 bouyer * the interrupt routine. If it is a polled command, call the interrupt
321 1.2 bouyer * routine until command is done.
322 1.2 bouyer */
323 1.21 bouyer if ((sc_xfer->sc_link->scsipi_atapi.cap & ATAPI_CFG_DRQ_MASK) !=
324 1.27 thorpej ATAPI_CFG_IRQ_DRQ || (sc_xfer->xs_control & XS_CTL_POLL)) {
325 1.2 bouyer /* Wait for at last 400ns for status bit to be valid */
326 1.20 bouyer DELAY(1);
327 1.20 bouyer wdc_atapi_intr(chp, xfer, 0);
328 1.21 bouyer } else {
329 1.21 bouyer chp->ch_flags |= WDCF_IRQ_WAIT;
330 1.2 bouyer }
331 1.27 thorpej if (sc_xfer->xs_control & XS_CTL_POLL) {
332 1.27 thorpej while ((sc_xfer->xs_status & XS_STS_DONE) == 0) {
333 1.2 bouyer /* Wait for at last 400ns for status bit to be valid */
334 1.20 bouyer DELAY(1);
335 1.20 bouyer wdc_atapi_intr(chp, xfer, 0);
336 1.2 bouyer }
337 1.2 bouyer }
338 1.2 bouyer }
339 1.2 bouyer
340 1.2 bouyer int
341 1.20 bouyer wdc_atapi_intr(chp, xfer, irq)
342 1.2 bouyer struct channel_softc *chp;
343 1.2 bouyer struct wdc_xfer *xfer;
344 1.20 bouyer int irq;
345 1.2 bouyer {
346 1.2 bouyer struct scsipi_xfer *sc_xfer = xfer->cmd;
347 1.2 bouyer struct ata_drive_datas *drvp = &chp->ch_drive[xfer->drive];
348 1.2 bouyer int len, phase, i, retries=0;
349 1.2 bouyer int ire, dma_err = 0;
350 1.2 bouyer int dma_flags = 0;
351 1.8 bouyer struct scsipi_generic _cmd_reqsense;
352 1.8 bouyer struct scsipi_sense *cmd_reqsense =
353 1.8 bouyer (struct scsipi_sense *)&_cmd_reqsense;
354 1.8 bouyer void *cmd;
355 1.2 bouyer
356 1.5 bouyer WDCDEBUG_PRINT(("wdc_atapi_intr %s:%d:%d\n",
357 1.5 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drvp->drive), DEBUG_INTR);
358 1.2 bouyer
359 1.2 bouyer /* Is it not a transfer, but a control operation? */
360 1.2 bouyer if (drvp->state < READY) {
361 1.2 bouyer printf("%s:%d:%d: bad state %d in wdc_atapi_intr\n",
362 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, xfer->drive,
363 1.2 bouyer drvp->state);
364 1.2 bouyer panic("wdc_atapi_intr: bad state\n");
365 1.2 bouyer }
366 1.24 bouyer /*
367 1.24 bouyer * If we missed an interrupt in a PIO transfer, reset and restart.
368 1.24 bouyer * Don't try to continue transfer, we may have missed cycles.
369 1.24 bouyer */
370 1.24 bouyer if ((xfer->c_flags & (C_TIMEOU | C_DMA)) == C_TIMEOU) {
371 1.24 bouyer sc_xfer->error = XS_TIMEOUT;
372 1.24 bouyer wdc_atapi_reset(chp, xfer);
373 1.25 bouyer return 1;
374 1.24 bouyer }
375 1.24 bouyer
376 1.2 bouyer /* Ack interrupt done in wait_for_unbusy */
377 1.2 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
378 1.2 bouyer WDSD_IBM | (xfer->drive << 4));
379 1.19 bouyer if (wait_for_unbusy(chp,
380 1.20 bouyer (irq == 0) ? sc_xfer->timeout : 0) != 0) {
381 1.20 bouyer if (irq && (xfer->c_flags & C_TIMEOU) == 0)
382 1.19 bouyer return 0; /* IRQ was not for us */
383 1.16 bouyer printf("%s:%d:%d: device timeout, c_bcount=%d, c_skip=%d\n",
384 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, xfer->drive,
385 1.2 bouyer xfer->c_bcount, xfer->c_skip);
386 1.11 bouyer if (xfer->c_flags & C_DMA)
387 1.30 bouyer ata_dmaerr(drvp);
388 1.3 bouyer sc_xfer->error = XS_TIMEOUT;
389 1.2 bouyer wdc_atapi_reset(chp, xfer);
390 1.2 bouyer return 1;
391 1.2 bouyer }
392 1.19 bouyer /* If we missed an IRQ and were using DMA, flag it as a DMA error */
393 1.19 bouyer if ((xfer->c_flags & C_TIMEOU) && (xfer->c_flags & C_DMA))
394 1.30 bouyer ata_dmaerr(drvp);
395 1.8 bouyer /*
396 1.8 bouyer * if the request sense command was aborted, report the short sense
397 1.8 bouyer * previously recorded, else continue normal processing
398 1.8 bouyer */
399 1.8 bouyer
400 1.8 bouyer if ((xfer->c_flags & C_SENSE) != 0 &&
401 1.8 bouyer (chp->ch_status & WDCS_ERR) != 0 &&
402 1.2 bouyer (chp->ch_error & WDCE_ABRT) != 0) {
403 1.8 bouyer WDCDEBUG_PRINT(("wdc_atapi_intr: request_sense aborted, "
404 1.8 bouyer "calling wdc_atapi_done(), sense 0x%x\n",
405 1.8 bouyer sc_xfer->sense.atapi_sense), DEBUG_INTR);
406 1.2 bouyer wdc_atapi_done(chp, xfer);
407 1.2 bouyer return 1;
408 1.2 bouyer }
409 1.2 bouyer
410 1.2 bouyer if (xfer->c_flags & C_DMA) {
411 1.27 thorpej dma_flags = ((sc_xfer->xs_control & XS_CTL_DATA_IN) ||
412 1.19 bouyer (xfer->c_flags & C_SENSE)) ? WDC_DMA_READ : 0;
413 1.27 thorpej dma_flags |= sc_xfer->xs_control & XS_CTL_POLL ?
414 1.27 thorpej WDC_DMA_POLL : 0;
415 1.2 bouyer }
416 1.2 bouyer again:
417 1.2 bouyer len = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_lo) +
418 1.2 bouyer 256 * bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_hi);
419 1.2 bouyer ire = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_ireason);
420 1.2 bouyer phase = (ire & (WDCI_CMD | WDCI_IN)) | (chp->ch_status & WDCS_DRQ);
421 1.2 bouyer WDCDEBUG_PRINT(("wdc_atapi_intr: c_bcount %d len %d st 0x%x err 0x%x "
422 1.2 bouyer "ire 0x%x :", xfer->c_bcount,
423 1.2 bouyer len, chp->ch_status, chp->ch_error, ire), DEBUG_INTR);
424 1.2 bouyer
425 1.2 bouyer switch (phase) {
426 1.2 bouyer case PHASE_CMDOUT:
427 1.8 bouyer if (xfer->c_flags & C_SENSE) {
428 1.8 bouyer memset(cmd_reqsense, 0, sizeof(struct scsipi_generic));
429 1.8 bouyer cmd_reqsense->opcode = REQUEST_SENSE;
430 1.8 bouyer cmd_reqsense->length = xfer->c_bcount;
431 1.8 bouyer cmd = cmd_reqsense;
432 1.8 bouyer } else {
433 1.8 bouyer cmd = sc_xfer->cmd;
434 1.8 bouyer }
435 1.2 bouyer WDCDEBUG_PRINT(("PHASE_CMDOUT\n"), DEBUG_INTR);
436 1.2 bouyer /* Init the DMA channel if necessary */
437 1.2 bouyer if (xfer->c_flags & C_DMA) {
438 1.2 bouyer if ((*chp->wdc->dma_init)(chp->wdc->dma_arg,
439 1.2 bouyer chp->channel, xfer->drive,
440 1.8 bouyer xfer->databuf, xfer->c_bcount, dma_flags) != 0) {
441 1.2 bouyer sc_xfer->error = XS_DRIVER_STUFFUP;
442 1.2 bouyer break;
443 1.2 bouyer }
444 1.2 bouyer }
445 1.2 bouyer /* send packet command */
446 1.2 bouyer /* Commands are 12 or 16 bytes long. It's 32-bit aligned */
447 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM)) {
448 1.2 bouyer if (drvp->drive_flags & DRIVE_CAP32) {
449 1.2 bouyer bus_space_write_multi_4(chp->data32iot,
450 1.2 bouyer chp->data32ioh, 0,
451 1.8 bouyer (u_int32_t *)cmd,
452 1.2 bouyer sc_xfer->cmdlen >> 2);
453 1.2 bouyer } else {
454 1.2 bouyer bus_space_write_multi_2(chp->cmd_iot,
455 1.2 bouyer chp->cmd_ioh, wd_data,
456 1.8 bouyer (u_int16_t *)cmd,
457 1.2 bouyer sc_xfer->cmdlen >> 1);
458 1.2 bouyer }
459 1.2 bouyer } else {
460 1.2 bouyer if (drvp->drive_flags & DRIVE_CAP32) {
461 1.2 bouyer bus_space_write_multi_stream_4(chp->data32iot,
462 1.2 bouyer chp->data32ioh, 0,
463 1.8 bouyer (u_int32_t *)cmd,
464 1.2 bouyer sc_xfer->cmdlen >> 2);
465 1.2 bouyer } else {
466 1.2 bouyer bus_space_write_multi_stream_2(chp->cmd_iot,
467 1.2 bouyer chp->cmd_ioh, wd_data,
468 1.8 bouyer (u_int16_t *)cmd,
469 1.2 bouyer sc_xfer->cmdlen >> 1);
470 1.2 bouyer }
471 1.2 bouyer }
472 1.2 bouyer /* Start the DMA channel if necessary */
473 1.2 bouyer if (xfer->c_flags & C_DMA) {
474 1.2 bouyer (*chp->wdc->dma_start)(chp->wdc->dma_arg,
475 1.2 bouyer chp->channel, xfer->drive, dma_flags);
476 1.2 bouyer }
477 1.2 bouyer
478 1.27 thorpej if ((sc_xfer->xs_control & XS_CTL_POLL) == 0) {
479 1.2 bouyer chp->ch_flags |= WDCF_IRQ_WAIT;
480 1.2 bouyer }
481 1.2 bouyer return 1;
482 1.2 bouyer
483 1.2 bouyer case PHASE_DATAOUT:
484 1.2 bouyer /* write data */
485 1.2 bouyer WDCDEBUG_PRINT(("PHASE_DATAOUT\n"), DEBUG_INTR);
486 1.27 thorpej if ((sc_xfer->xs_control & XS_CTL_DATA_OUT) == 0 ||
487 1.2 bouyer (xfer->c_flags & C_DMA) != 0) {
488 1.15 bouyer printf("wdc_atapi_intr: bad data phase DATAOUT\n");
489 1.2 bouyer if (xfer->c_flags & C_DMA) {
490 1.11 bouyer (*chp->wdc->dma_finish)(chp->wdc->dma_arg,
491 1.11 bouyer chp->channel, xfer->drive, dma_flags);
492 1.30 bouyer ata_dmaerr(drvp);
493 1.2 bouyer }
494 1.3 bouyer sc_xfer->error = XS_TIMEOUT;
495 1.2 bouyer wdc_atapi_reset(chp, xfer);
496 1.2 bouyer return 1;
497 1.2 bouyer }
498 1.2 bouyer if (xfer->c_bcount < len) {
499 1.2 bouyer printf("wdc_atapi_intr: warning: write only "
500 1.2 bouyer "%d of %d requested bytes\n", xfer->c_bcount, len);
501 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM)) {
502 1.2 bouyer bus_space_write_multi_2(chp->cmd_iot,
503 1.2 bouyer chp->cmd_ioh, wd_data,
504 1.14 thorpej (u_int16_t *)((char *)xfer->databuf +
505 1.14 thorpej xfer->c_skip),
506 1.2 bouyer xfer->c_bcount >> 1);
507 1.2 bouyer } else {
508 1.2 bouyer bus_space_write_multi_stream_2(chp->cmd_iot,
509 1.2 bouyer chp->cmd_ioh, wd_data,
510 1.14 thorpej (u_int16_t *)((char *)xfer->databuf +
511 1.14 thorpej xfer->c_skip),
512 1.2 bouyer xfer->c_bcount >> 1);
513 1.2 bouyer }
514 1.2 bouyer for (i = xfer->c_bcount; i < len; i += 2)
515 1.2 bouyer bus_space_write_2(chp->cmd_iot, chp->cmd_ioh,
516 1.2 bouyer wd_data, 0);
517 1.2 bouyer xfer->c_skip += xfer->c_bcount;
518 1.2 bouyer xfer->c_bcount = 0;
519 1.2 bouyer } else {
520 1.2 bouyer if (drvp->drive_flags & DRIVE_CAP32) {
521 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM))
522 1.2 bouyer bus_space_write_multi_4(chp->data32iot,
523 1.2 bouyer chp->data32ioh, 0,
524 1.14 thorpej (u_int32_t *)((char *)xfer->databuf +
525 1.14 thorpej xfer->c_skip),
526 1.13 augustss len >> 2);
527 1.2 bouyer else
528 1.12 bouyer bus_space_write_multi_stream_4(chp->data32iot,
529 1.12 bouyer chp->data32ioh, wd_data,
530 1.14 thorpej (u_int32_t *)((char *)xfer->databuf +
531 1.14 thorpej xfer->c_skip),
532 1.13 augustss len >> 2);
533 1.2 bouyer
534 1.2 bouyer xfer->c_skip += len & 0xfffffffc;
535 1.2 bouyer xfer->c_bcount -= len & 0xfffffffc;
536 1.2 bouyer len = len & 0x03;
537 1.2 bouyer }
538 1.2 bouyer if (len > 0) {
539 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM))
540 1.2 bouyer bus_space_write_multi_2(chp->cmd_iot,
541 1.2 bouyer chp->cmd_ioh, wd_data,
542 1.14 thorpej (u_int16_t *)((char *)xfer->databuf +
543 1.14 thorpej xfer->c_skip),
544 1.13 augustss len >> 1);
545 1.2 bouyer else
546 1.2 bouyer bus_space_write_multi_stream_2(chp->cmd_iot,
547 1.2 bouyer chp->cmd_ioh, wd_data,
548 1.14 thorpej (u_int16_t *)((char *)xfer->databuf +
549 1.14 thorpej xfer->c_skip),
550 1.13 augustss len >> 1);
551 1.2 bouyer xfer->c_skip += len;
552 1.2 bouyer xfer->c_bcount -= len;
553 1.2 bouyer }
554 1.2 bouyer }
555 1.27 thorpej if ((sc_xfer->xs_control & XS_CTL_POLL) == 0) {
556 1.2 bouyer chp->ch_flags |= WDCF_IRQ_WAIT;
557 1.2 bouyer }
558 1.2 bouyer return 1;
559 1.2 bouyer
560 1.2 bouyer case PHASE_DATAIN:
561 1.2 bouyer /* Read data */
562 1.2 bouyer WDCDEBUG_PRINT(("PHASE_DATAIN\n"), DEBUG_INTR);
563 1.27 thorpej if (((sc_xfer->xs_control & XS_CTL_DATA_IN) == 0 &&
564 1.8 bouyer (xfer->c_flags & C_SENSE) == 0) ||
565 1.2 bouyer (xfer->c_flags & C_DMA) != 0) {
566 1.15 bouyer printf("wdc_atapi_intr: bad data phase DATAIN\n");
567 1.2 bouyer if (xfer->c_flags & C_DMA) {
568 1.11 bouyer (*chp->wdc->dma_finish)(chp->wdc->dma_arg,
569 1.11 bouyer chp->channel, xfer->drive, dma_flags);
570 1.30 bouyer ata_dmaerr(drvp);
571 1.2 bouyer }
572 1.3 bouyer sc_xfer->error = XS_TIMEOUT;
573 1.2 bouyer wdc_atapi_reset(chp, xfer);
574 1.2 bouyer return 1;
575 1.2 bouyer }
576 1.2 bouyer if (xfer->c_bcount < len) {
577 1.2 bouyer printf("wdc_atapi_intr: warning: reading only "
578 1.2 bouyer "%d of %d bytes\n", xfer->c_bcount, len);
579 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM)) {
580 1.2 bouyer bus_space_read_multi_2(chp->cmd_iot,
581 1.2 bouyer chp->cmd_ioh, wd_data,
582 1.14 thorpej (u_int16_t *)((char *)xfer->databuf +
583 1.14 thorpej xfer->c_skip),
584 1.13 augustss xfer->c_bcount >> 1);
585 1.2 bouyer } else {
586 1.2 bouyer bus_space_read_multi_stream_2(chp->cmd_iot,
587 1.2 bouyer chp->cmd_ioh, wd_data,
588 1.14 thorpej (u_int16_t *)((char *)xfer->databuf +
589 1.14 thorpej xfer->c_skip),
590 1.13 augustss xfer->c_bcount >> 1);
591 1.2 bouyer }
592 1.2 bouyer wdcbit_bucket(chp, len - xfer->c_bcount);
593 1.2 bouyer xfer->c_skip += xfer->c_bcount;
594 1.2 bouyer xfer->c_bcount = 0;
595 1.2 bouyer } else {
596 1.2 bouyer if (drvp->drive_flags & DRIVE_CAP32) {
597 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM))
598 1.2 bouyer bus_space_read_multi_4(chp->data32iot,
599 1.2 bouyer chp->data32ioh, 0,
600 1.14 thorpej (u_int32_t *)((char *)xfer->databuf +
601 1.14 thorpej xfer->c_skip),
602 1.13 augustss len >> 2);
603 1.2 bouyer else
604 1.12 bouyer bus_space_read_multi_stream_4(chp->data32iot,
605 1.12 bouyer chp->data32ioh, wd_data,
606 1.14 thorpej (u_int32_t *)((char *)xfer->databuf +
607 1.14 thorpej xfer->c_skip),
608 1.13 augustss len >> 2);
609 1.2 bouyer
610 1.2 bouyer xfer->c_skip += len & 0xfffffffc;
611 1.2 bouyer xfer->c_bcount -= len & 0xfffffffc;
612 1.2 bouyer len = len & 0x03;
613 1.2 bouyer }
614 1.2 bouyer if (len > 0) {
615 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM))
616 1.2 bouyer bus_space_read_multi_2(chp->cmd_iot,
617 1.2 bouyer chp->cmd_ioh, wd_data,
618 1.14 thorpej (u_int16_t *)((char *)xfer->databuf +
619 1.14 thorpej xfer->c_skip),
620 1.13 augustss len >> 1);
621 1.2 bouyer else
622 1.2 bouyer bus_space_read_multi_stream_2(chp->cmd_iot,
623 1.2 bouyer chp->cmd_ioh, wd_data,
624 1.14 thorpej (u_int16_t *)((char *)xfer->databuf +
625 1.14 thorpej xfer->c_skip),
626 1.13 augustss len >> 1);
627 1.2 bouyer xfer->c_skip += len;
628 1.2 bouyer xfer->c_bcount -=len;
629 1.2 bouyer }
630 1.2 bouyer }
631 1.27 thorpej if ((sc_xfer->xs_control & XS_CTL_POLL) == 0) {
632 1.2 bouyer chp->ch_flags |= WDCF_IRQ_WAIT;
633 1.2 bouyer }
634 1.2 bouyer return 1;
635 1.2 bouyer
636 1.2 bouyer case PHASE_ABORTED:
637 1.2 bouyer case PHASE_COMPLETED:
638 1.2 bouyer WDCDEBUG_PRINT(("PHASE_COMPLETED\n"), DEBUG_INTR);
639 1.2 bouyer /* turn off DMA channel */
640 1.2 bouyer if (xfer->c_flags & C_DMA) {
641 1.2 bouyer dma_err = (*chp->wdc->dma_finish)(chp->wdc->dma_arg,
642 1.2 bouyer chp->channel, xfer->drive, dma_flags);
643 1.20 bouyer if (xfer->c_flags & C_SENSE)
644 1.20 bouyer xfer->c_bcount -=
645 1.20 bouyer sizeof(sc_xfer->sense.scsi_sense);
646 1.20 bouyer else
647 1.20 bouyer xfer->c_bcount -= sc_xfer->datalen;
648 1.2 bouyer }
649 1.8 bouyer if (xfer->c_flags & C_SENSE) {
650 1.8 bouyer if ((chp->ch_status & WDCS_ERR) || dma_err < 0) {
651 1.8 bouyer /*
652 1.8 bouyer * request sense failed ! it's not suppossed
653 1.8 bouyer * to be possible
654 1.8 bouyer */
655 1.30 bouyer if (xfer->c_flags & C_DMA)
656 1.30 bouyer ata_dmaerr(drvp);
657 1.17 bouyer sc_xfer->error = XS_RESET;
658 1.17 bouyer wdc_atapi_reset(chp, xfer);
659 1.17 bouyer return (1);
660 1.17 bouyer } else if (xfer->c_bcount <
661 1.17 bouyer sizeof(sc_xfer->sense.scsi_sense)) {
662 1.8 bouyer /* use the sense we just read */
663 1.8 bouyer sc_xfer->error = XS_SENSE;
664 1.17 bouyer } else {
665 1.17 bouyer /*
666 1.17 bouyer * command completed, but no data was read.
667 1.17 bouyer * use the short sense we saved previsouly.
668 1.17 bouyer */
669 1.17 bouyer sc_xfer->error = XS_SHORTSENSE;
670 1.8 bouyer }
671 1.8 bouyer } else {
672 1.23 perry sc_xfer->resid = xfer->c_bcount;
673 1.8 bouyer if (chp->ch_status & WDCS_ERR) {
674 1.8 bouyer /* save the short sense */
675 1.8 bouyer sc_xfer->error = XS_SHORTSENSE;
676 1.8 bouyer sc_xfer->sense.atapi_sense = chp->ch_error;
677 1.12 bouyer if ((sc_xfer->sc_link->quirks &
678 1.12 bouyer ADEV_NOSENSE) == 0) {
679 1.12 bouyer /*
680 1.12 bouyer * let the driver issue a
681 1.12 bouyer * 'request sense'
682 1.12 bouyer */
683 1.12 bouyer xfer->databuf = &sc_xfer->sense;
684 1.12 bouyer xfer->c_bcount =
685 1.12 bouyer sizeof(sc_xfer->sense.scsi_sense);
686 1.23 perry xfer->c_skip = 0;
687 1.12 bouyer xfer->c_flags |= C_SENSE;
688 1.24 bouyer untimeout(wdctimeout, chp);
689 1.12 bouyer wdc_atapi_start(chp, xfer);
690 1.12 bouyer return 1;
691 1.12 bouyer }
692 1.8 bouyer } else if (dma_err < 0) {
693 1.30 bouyer ata_dmaerr(drvp);
694 1.16 bouyer sc_xfer->error = XS_RESET;
695 1.16 bouyer wdc_atapi_reset(chp, xfer);
696 1.16 bouyer return (1);
697 1.8 bouyer }
698 1.2 bouyer }
699 1.7 bouyer if (xfer->c_bcount != 0) {
700 1.7 bouyer WDCDEBUG_PRINT(("wdc_atapi_intr: bcount value is "
701 1.7 bouyer "%d after io\n", xfer->c_bcount), DEBUG_XFERS);
702 1.7 bouyer }
703 1.2 bouyer #ifdef DIAGNOSTIC
704 1.7 bouyer if (xfer->c_bcount < 0) {
705 1.2 bouyer printf("wdc_atapi_intr warning: bcount value "
706 1.2 bouyer "is %d after io\n", xfer->c_bcount);
707 1.2 bouyer }
708 1.2 bouyer #endif
709 1.2 bouyer break;
710 1.2 bouyer
711 1.2 bouyer default:
712 1.2 bouyer if (++retries<500) {
713 1.2 bouyer DELAY(100);
714 1.2 bouyer chp->ch_status = bus_space_read_1(chp->cmd_iot,
715 1.2 bouyer chp->cmd_ioh, wd_status);
716 1.2 bouyer chp->ch_error = bus_space_read_1(chp->cmd_iot,
717 1.2 bouyer chp->cmd_ioh, wd_error);
718 1.2 bouyer goto again;
719 1.2 bouyer }
720 1.2 bouyer printf("wdc_atapi_intr: unknown phase 0x%x\n", phase);
721 1.2 bouyer if (chp->ch_status & WDCS_ERR) {
722 1.8 bouyer sc_xfer->error = XS_SHORTSENSE;
723 1.2 bouyer sc_xfer->sense.atapi_sense = chp->ch_error;
724 1.2 bouyer } else {
725 1.30 bouyer if (xfer->c_flags & C_DMA)
726 1.30 bouyer ata_dmaerr(drvp);
727 1.16 bouyer sc_xfer->error = XS_RESET;
728 1.16 bouyer wdc_atapi_reset(chp, xfer);
729 1.16 bouyer return (1);
730 1.2 bouyer }
731 1.2 bouyer }
732 1.2 bouyer WDCDEBUG_PRINT(("wdc_atapi_intr: wdc_atapi_done() (end), error 0x%x "
733 1.2 bouyer "sense 0x%x\n", sc_xfer->error, sc_xfer->sense.atapi_sense),
734 1.2 bouyer DEBUG_INTR);
735 1.2 bouyer wdc_atapi_done(chp, xfer);
736 1.2 bouyer return (1);
737 1.2 bouyer }
738 1.2 bouyer
739 1.2 bouyer int
740 1.20 bouyer wdc_atapi_ctrl(chp, xfer, irq)
741 1.2 bouyer struct channel_softc *chp;
742 1.2 bouyer struct wdc_xfer *xfer;
743 1.20 bouyer int irq;
744 1.2 bouyer {
745 1.2 bouyer struct scsipi_xfer *sc_xfer = xfer->cmd;
746 1.2 bouyer struct ata_drive_datas *drvp = &chp->ch_drive[xfer->drive];
747 1.2 bouyer char *errstring = NULL;
748 1.20 bouyer int delay = (irq == 0) ? ATAPI_DELAY : 0;
749 1.2 bouyer
750 1.2 bouyer /* Ack interrupt done in wait_for_unbusy */
751 1.2 bouyer again:
752 1.5 bouyer WDCDEBUG_PRINT(("wdc_atapi_ctrl %s:%d:%d state %d\n",
753 1.5 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drvp->drive, drvp->state),
754 1.4 bouyer DEBUG_INTR | DEBUG_FUNCS);
755 1.2 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
756 1.2 bouyer WDSD_IBM | (xfer->drive << 4));
757 1.2 bouyer switch (drvp->state) {
758 1.2 bouyer case PIOMODE:
759 1.22 bouyer piomode:
760 1.2 bouyer /* Don't try to set mode if controller can't be adjusted */
761 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_MODE) == 0)
762 1.2 bouyer goto ready;
763 1.6 bouyer /* Also don't try if the drive didn't report its mode */
764 1.6 bouyer if ((drvp->drive_flags & DRIVE_MODE) == 0)
765 1.6 bouyer goto ready;;
766 1.2 bouyer wdccommand(chp, drvp->drive, SET_FEATURES, 0, 0, 0,
767 1.2 bouyer 0x08 | drvp->PIO_mode, WDSF_SET_MODE);
768 1.2 bouyer drvp->state = PIOMODE_WAIT;
769 1.2 bouyer break;
770 1.2 bouyer case PIOMODE_WAIT:
771 1.2 bouyer errstring = "piomode";
772 1.19 bouyer if (wait_for_unbusy(chp, delay))
773 1.2 bouyer goto timeout;
774 1.22 bouyer if (chp->ch_status & WDCS_ERR) {
775 1.22 bouyer if (drvp->PIO_mode < 3) {
776 1.22 bouyer drvp->PIO_mode = 3;
777 1.22 bouyer goto piomode;
778 1.22 bouyer } else {
779 1.22 bouyer goto error;
780 1.22 bouyer }
781 1.22 bouyer }
782 1.2 bouyer /* fall through */
783 1.2 bouyer
784 1.2 bouyer case DMAMODE:
785 1.2 bouyer if (drvp->drive_flags & DRIVE_UDMA) {
786 1.2 bouyer wdccommand(chp, drvp->drive, SET_FEATURES, 0, 0, 0,
787 1.2 bouyer 0x40 | drvp->UDMA_mode, WDSF_SET_MODE);
788 1.2 bouyer } else if (drvp->drive_flags & DRIVE_DMA) {
789 1.2 bouyer wdccommand(chp, drvp->drive, SET_FEATURES, 0, 0, 0,
790 1.2 bouyer 0x20 | drvp->DMA_mode, WDSF_SET_MODE);
791 1.2 bouyer } else {
792 1.2 bouyer goto ready;
793 1.2 bouyer }
794 1.2 bouyer drvp->state = DMAMODE_WAIT;
795 1.2 bouyer break;
796 1.2 bouyer case DMAMODE_WAIT:
797 1.2 bouyer errstring = "dmamode";
798 1.19 bouyer if (wait_for_unbusy(chp, delay))
799 1.2 bouyer goto timeout;
800 1.2 bouyer if (chp->ch_status & WDCS_ERR)
801 1.2 bouyer goto error;
802 1.2 bouyer /* fall through */
803 1.2 bouyer
804 1.2 bouyer case READY:
805 1.2 bouyer ready:
806 1.2 bouyer drvp->state = READY;
807 1.2 bouyer xfer->c_intr = wdc_atapi_intr;
808 1.24 bouyer untimeout(wdctimeout, chp);
809 1.2 bouyer wdc_atapi_start(chp, xfer);
810 1.2 bouyer return 1;
811 1.2 bouyer }
812 1.27 thorpej if ((sc_xfer->xs_control & XS_CTL_POLL) == 0) {
813 1.2 bouyer chp->ch_flags |= WDCF_IRQ_WAIT;
814 1.2 bouyer xfer->c_intr = wdc_atapi_ctrl;
815 1.2 bouyer } else {
816 1.2 bouyer goto again;
817 1.2 bouyer }
818 1.2 bouyer return 1;
819 1.2 bouyer
820 1.2 bouyer timeout:
821 1.20 bouyer if (irq && (xfer->c_flags & C_TIMEOU) == 0) {
822 1.2 bouyer return 0; /* IRQ was not for us */
823 1.2 bouyer }
824 1.2 bouyer printf("%s:%d:%d: %s timed out\n",
825 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, xfer->drive, errstring);
826 1.3 bouyer sc_xfer->error = XS_TIMEOUT;
827 1.2 bouyer wdc_atapi_reset(chp, xfer);
828 1.2 bouyer return 1;
829 1.2 bouyer error:
830 1.2 bouyer printf("%s:%d:%d: %s ",
831 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, xfer->drive,
832 1.2 bouyer errstring);
833 1.3 bouyer printf("error (0x%x)\n", chp->ch_error);
834 1.8 bouyer sc_xfer->error = XS_SHORTSENSE;
835 1.2 bouyer sc_xfer->sense.atapi_sense = chp->ch_error;
836 1.3 bouyer wdc_atapi_reset(chp, xfer);
837 1.2 bouyer return 1;
838 1.2 bouyer }
839 1.2 bouyer
840 1.2 bouyer void
841 1.2 bouyer wdc_atapi_done(chp, xfer)
842 1.2 bouyer struct channel_softc *chp;
843 1.2 bouyer struct wdc_xfer *xfer;
844 1.2 bouyer {
845 1.2 bouyer struct scsipi_xfer *sc_xfer = xfer->cmd;
846 1.2 bouyer
847 1.5 bouyer WDCDEBUG_PRINT(("wdc_atapi_done %s:%d:%d: flags 0x%x\n",
848 1.5 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, xfer->drive,
849 1.5 bouyer (u_int)xfer->c_flags), DEBUG_XFERS);
850 1.24 bouyer untimeout(wdctimeout, chp);
851 1.2 bouyer /* remove this command from xfer queue */
852 1.2 bouyer wdc_free_xfer(chp, xfer);
853 1.27 thorpej sc_xfer->xs_status |= XS_STS_DONE;
854 1.11 bouyer
855 1.25 bouyer WDCDEBUG_PRINT(("wdc_atapi_done: scsipi_done\n"), DEBUG_XFERS);
856 1.25 bouyer scsipi_done(sc_xfer);
857 1.2 bouyer WDCDEBUG_PRINT(("wdcstart from wdc_atapi_done, flags 0x%x\n",
858 1.4 bouyer chp->ch_flags), DEBUG_XFERS);
859 1.10 drochner wdcstart(chp);
860 1.2 bouyer }
861 1.2 bouyer
862 1.2 bouyer void
863 1.2 bouyer wdc_atapi_reset(chp, xfer)
864 1.2 bouyer struct channel_softc *chp;
865 1.2 bouyer struct wdc_xfer *xfer;
866 1.2 bouyer {
867 1.2 bouyer struct ata_drive_datas *drvp = &chp->ch_drive[xfer->drive];
868 1.2 bouyer struct scsipi_xfer *sc_xfer = xfer->cmd;
869 1.2 bouyer
870 1.2 bouyer wdccommandshort(chp, xfer->drive, ATAPI_SOFT_RESET);
871 1.2 bouyer drvp->state = 0;
872 1.2 bouyer if (wait_for_unbusy(chp, WDC_RESET_WAIT) != 0) {
873 1.2 bouyer printf("%s:%d:%d: reset failed\n",
874 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel,
875 1.2 bouyer xfer->drive);
876 1.2 bouyer sc_xfer->error = XS_SELTIMEOUT;
877 1.2 bouyer }
878 1.2 bouyer wdc_atapi_done(chp, xfer);
879 1.2 bouyer return;
880 1.2 bouyer }
881