atapi_wdc.c revision 1.7 1 1.7 bouyer /* $NetBSD: atapi_wdc.c,v 1.7 1998/10/19 12:28:03 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.2 bouyer #define WDCDEBUG
37 1.2 bouyer
38 1.2 bouyer #include <sys/param.h>
39 1.2 bouyer #include <sys/systm.h>
40 1.2 bouyer #include <sys/kernel.h>
41 1.2 bouyer #include <sys/file.h>
42 1.2 bouyer #include <sys/stat.h>
43 1.2 bouyer #include <sys/buf.h>
44 1.2 bouyer #include <sys/malloc.h>
45 1.2 bouyer #include <sys/device.h>
46 1.2 bouyer #include <sys/syslog.h>
47 1.2 bouyer #include <sys/proc.h>
48 1.2 bouyer
49 1.2 bouyer #include <vm/vm.h>
50 1.2 bouyer
51 1.2 bouyer #include <machine/intr.h>
52 1.2 bouyer #include <machine/bus.h>
53 1.2 bouyer
54 1.2 bouyer #ifndef __BUS_SPACE_HAS_STREAM_METHODS
55 1.2 bouyer #define bus_space_write_multi_stream_2 bus_space_write_multi_2
56 1.2 bouyer #define bus_space_write_multi_stream_4 bus_space_write_multi_4
57 1.2 bouyer #define bus_space_read_multi_stream_2 bus_space_read_multi_2
58 1.2 bouyer #define bus_space_read_multi_stream_4 bus_space_read_multi_4
59 1.2 bouyer #endif /* __BUS_SPACE_HAS_STREAM_METHODS */
60 1.2 bouyer
61 1.2 bouyer #include <dev/ata/atareg.h>
62 1.2 bouyer #include <dev/ata/atavar.h>
63 1.2 bouyer #include <dev/ic/wdcreg.h>
64 1.2 bouyer #include <dev/ic/wdcvar.h>
65 1.2 bouyer #include <dev/scsipi/scsipi_all.h>
66 1.2 bouyer #include <dev/scsipi/scsipiconf.h>
67 1.2 bouyer #include <dev/scsipi/atapiconf.h>
68 1.2 bouyer
69 1.2 bouyer #define DEBUG_INTR 0x01
70 1.2 bouyer #define DEBUG_XFERS 0x02
71 1.2 bouyer #define DEBUG_STATUS 0x04
72 1.2 bouyer #define DEBUG_FUNCS 0x08
73 1.2 bouyer #define DEBUG_PROBE 0x10
74 1.2 bouyer #ifdef WDCDEBUG
75 1.3 bouyer int wdcdebug_atapi_mask = 0;
76 1.2 bouyer #define WDCDEBUG_PRINT(args, level) \
77 1.2 bouyer if (wdcdebug_atapi_mask & (level)) \
78 1.2 bouyer printf args
79 1.2 bouyer #else
80 1.2 bouyer #define WDCDEBUG_PRINT(args, level)
81 1.2 bouyer #endif
82 1.2 bouyer
83 1.2 bouyer #define ATAPI_DELAY 10 /* 10 ms, this is used only before sending a cmd */
84 1.2 bouyer
85 1.2 bouyer void wdc_atapi_minphys __P((struct buf *bp));
86 1.2 bouyer void wdc_atapi_start __P((struct channel_softc *,struct wdc_xfer *));
87 1.2 bouyer int wdc_atapi_intr __P((struct channel_softc *, struct wdc_xfer *));
88 1.2 bouyer int wdc_atapi_ctrl __P((struct channel_softc *, struct wdc_xfer *));
89 1.2 bouyer void wdc_atapi_done __P((struct channel_softc *, struct wdc_xfer *));
90 1.2 bouyer void wdc_atapi_reset __P((struct channel_softc *, struct wdc_xfer *));
91 1.2 bouyer int wdc_atapi_send_cmd __P((struct scsipi_xfer *sc_xfer));
92 1.2 bouyer
93 1.2 bouyer #define MAX_SIZE MAXPHYS
94 1.2 bouyer
95 1.2 bouyer static struct scsipi_adapter wdc_switch = {
96 1.2 bouyer wdc_atapi_send_cmd,
97 1.2 bouyer wdc_atapi_minphys,
98 1.2 bouyer NULL, /* scsipi_ioctl */
99 1.2 bouyer };
100 1.2 bouyer
101 1.2 bouyer void
102 1.2 bouyer wdc_atapibus_attach(chp)
103 1.2 bouyer struct channel_softc *chp;
104 1.2 bouyer {
105 1.2 bouyer struct wdc_softc *wdc = chp->wdc;
106 1.2 bouyer int channel = chp->channel;
107 1.2 bouyer struct ata_atapi_attach aa_link;
108 1.2 bouyer
109 1.2 bouyer memset(&aa_link, 0, sizeof(struct ata_atapi_attach));
110 1.2 bouyer aa_link.aa_type = T_ATAPI;
111 1.2 bouyer aa_link.aa_channel = channel;
112 1.2 bouyer aa_link.aa_openings = 1;
113 1.2 bouyer aa_link.aa_drv_data = chp->ch_drive; /* pass the whole array */
114 1.2 bouyer aa_link.aa_bus_private = &wdc_switch;
115 1.2 bouyer (void)config_found(&wdc->sc_dev, (void *)&aa_link, atapi_print);
116 1.2 bouyer }
117 1.2 bouyer
118 1.2 bouyer void
119 1.2 bouyer wdc_atapi_minphys (struct buf *bp)
120 1.2 bouyer {
121 1.2 bouyer if(bp->b_bcount > MAX_SIZE)
122 1.2 bouyer bp->b_bcount = MAX_SIZE;
123 1.2 bouyer minphys(bp);
124 1.2 bouyer }
125 1.2 bouyer
126 1.2 bouyer int
127 1.2 bouyer wdc_atapi_get_params(ab_link, drive, flags, id)
128 1.2 bouyer struct scsipi_link *ab_link;
129 1.2 bouyer u_int8_t drive;
130 1.2 bouyer int flags;
131 1.2 bouyer struct ataparams *id;
132 1.2 bouyer {
133 1.2 bouyer struct wdc_softc *wdc = (void*)ab_link->adapter_softc;
134 1.2 bouyer struct channel_softc *chp =
135 1.2 bouyer &wdc->channels[ab_link->scsipi_atapi.channel];
136 1.2 bouyer struct wdc_command wdc_c;
137 1.2 bouyer
138 1.2 bouyer /* if no ATAPI device detected at wdc attach time, skip */
139 1.2 bouyer /*
140 1.2 bouyer * XXX this will break scsireprobe if this is of any interest for
141 1.2 bouyer * ATAPI devices one day.
142 1.2 bouyer */
143 1.2 bouyer if ((chp->ch_drive[drive].drive_flags & DRIVE_ATAPI) == 0) {
144 1.2 bouyer WDCDEBUG_PRINT(("wdc_atapi_get_params: drive %d not present\n",
145 1.2 bouyer drive), DEBUG_PROBE);
146 1.2 bouyer return -1;
147 1.2 bouyer }
148 1.2 bouyer memset(&wdc_c, 0, sizeof(struct wdc_command));
149 1.2 bouyer wdc_c.r_command = ATAPI_SOFT_RESET;
150 1.2 bouyer wdc_c.r_st_bmask = 0;
151 1.2 bouyer wdc_c.r_st_pmask = 0;
152 1.2 bouyer wdc_c.flags = AT_POLL;
153 1.2 bouyer wdc_c.timeout = WDC_RESET_WAIT;
154 1.2 bouyer if (wdc_exec_command(&chp->ch_drive[drive], &wdc_c) != WDC_COMPLETE) {
155 1.2 bouyer printf("wdc_atapi_get_params: ATAPI_SOFT_RESET failed for"
156 1.2 bouyer " drive %s:%d:%d: driver failed\n",
157 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drive);
158 1.2 bouyer panic("wdc_atapi_get_params");
159 1.2 bouyer }
160 1.2 bouyer if (wdc_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
161 1.2 bouyer WDCDEBUG_PRINT(("wdc_atapi_get_params: ATAPI_SOFT_RESET "
162 1.2 bouyer "failed for drive %s:%d:%d: error 0x%x\n",
163 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drive,
164 1.2 bouyer wdc_c.r_error), DEBUG_PROBE);
165 1.2 bouyer return -1;
166 1.2 bouyer }
167 1.2 bouyer chp->ch_drive[drive].state = 0;
168 1.2 bouyer
169 1.2 bouyer bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_status);
170 1.2 bouyer
171 1.2 bouyer /* Some ATAPI devices need a bit more time after software reset. */
172 1.2 bouyer delay(5000);
173 1.2 bouyer if (ata_get_params(&chp->ch_drive[drive], AT_POLL, id) != 0) {
174 1.2 bouyer WDCDEBUG_PRINT(("wdc_atapi_get_params: ATAPI_IDENTIFY_DEVICE "
175 1.2 bouyer "failed for drive %s:%d:%d: error 0x%x\n",
176 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drive,
177 1.2 bouyer wdc_c.r_error), DEBUG_PROBE);
178 1.2 bouyer return -1;
179 1.2 bouyer }
180 1.2 bouyer return COMPLETE;
181 1.2 bouyer }
182 1.2 bouyer
183 1.2 bouyer int
184 1.2 bouyer wdc_atapi_send_cmd(sc_xfer)
185 1.2 bouyer struct scsipi_xfer *sc_xfer;
186 1.2 bouyer {
187 1.2 bouyer struct scsipi_link *sc_link = sc_xfer->sc_link;
188 1.2 bouyer struct wdc_softc *wdc = (void*)sc_link->adapter_softc;
189 1.2 bouyer struct wdc_xfer *xfer;
190 1.2 bouyer struct ata_drive_datas *drvp;
191 1.2 bouyer int flags = sc_xfer->flags;
192 1.2 bouyer int channel = sc_xfer->sc_link->scsipi_atapi.channel;
193 1.2 bouyer int drive = sc_xfer->sc_link->scsipi_atapi.drive;
194 1.2 bouyer int s, ret;
195 1.2 bouyer
196 1.5 bouyer WDCDEBUG_PRINT(("wdc_atapi_send_cmd %s:%d:%d\n",
197 1.5 bouyer wdc->sc_dev.dv_xname, channel, drive), DEBUG_XFERS);
198 1.2 bouyer
199 1.2 bouyer xfer = wdc_get_xfer(flags & SCSI_NOSLEEP ? WDC_NOSLEEP : WDC_CANSLEEP);
200 1.2 bouyer if (xfer == NULL) {
201 1.2 bouyer return TRY_AGAIN_LATER;
202 1.2 bouyer }
203 1.2 bouyer if (sc_xfer->flags & SCSI_POLL)
204 1.2 bouyer xfer->c_flags |= C_POLL;
205 1.2 bouyer drvp = &wdc->channels[channel].ch_drive[drive];
206 1.2 bouyer if ((drvp->drive_flags & (DRIVE_DMA | DRIVE_UDMA)) &&
207 1.2 bouyer sc_xfer->datalen > 0)
208 1.2 bouyer xfer->c_flags |= C_DMA;
209 1.2 bouyer xfer->drive = drive;
210 1.2 bouyer xfer->c_flags |= C_ATAPI;
211 1.2 bouyer xfer->cmd = sc_xfer;
212 1.2 bouyer xfer->databuf = sc_xfer->data;
213 1.2 bouyer xfer->c_bcount = sc_xfer->datalen;
214 1.2 bouyer xfer->c_start = wdc_atapi_start;
215 1.2 bouyer xfer->c_intr = wdc_atapi_intr;
216 1.2 bouyer s = splbio();
217 1.2 bouyer wdc_exec_xfer(&wdc->channels[channel], xfer);
218 1.2 bouyer #ifdef DIAGNOSTIC
219 1.2 bouyer if ((sc_xfer->flags & SCSI_POLL) != 0 &&
220 1.2 bouyer (sc_xfer->flags & ITSDONE) == 0)
221 1.2 bouyer panic("wdc_atapi_send_cmd: polled command not done");
222 1.2 bouyer #endif
223 1.2 bouyer ret = (sc_xfer->flags & ITSDONE) ? COMPLETE : SUCCESSFULLY_QUEUED;
224 1.2 bouyer splx(s);
225 1.2 bouyer return ret;
226 1.2 bouyer }
227 1.2 bouyer
228 1.2 bouyer void
229 1.2 bouyer wdc_atapi_start(chp, xfer)
230 1.2 bouyer struct channel_softc *chp;
231 1.2 bouyer struct wdc_xfer *xfer;
232 1.2 bouyer {
233 1.2 bouyer struct scsipi_xfer *sc_xfer = xfer->cmd;
234 1.2 bouyer struct ata_drive_datas *drvp = &chp->ch_drive[xfer->drive];
235 1.2 bouyer
236 1.5 bouyer WDCDEBUG_PRINT(("wdc_atapi_start %s:%d:%d, scsi flags 0x%x \n",
237 1.5 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drvp->drive,
238 1.5 bouyer sc_xfer->flags), DEBUG_XFERS);
239 1.2 bouyer /* Do control operations specially. */
240 1.2 bouyer if (drvp->state < READY) {
241 1.2 bouyer if (drvp->state != PIOMODE) {
242 1.2 bouyer printf("%s:%d:%d: bad state %d in wdc_atapi_start\n",
243 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel,
244 1.2 bouyer xfer->drive, drvp->state);
245 1.2 bouyer panic("wdc_atapi_start: bad state");
246 1.2 bouyer }
247 1.2 bouyer wdc_atapi_ctrl(chp, xfer);
248 1.2 bouyer return;
249 1.2 bouyer }
250 1.2 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
251 1.2 bouyer WDSD_IBM | (xfer->drive << 4));
252 1.2 bouyer if (wait_for_unbusy(chp, ATAPI_DELAY) < 0) {
253 1.2 bouyer printf("wdc_atapi_start: not ready, st = %02x\n",
254 1.2 bouyer chp->ch_status);
255 1.3 bouyer sc_xfer->error = XS_TIMEOUT;
256 1.2 bouyer wdc_atapi_reset(chp, xfer);
257 1.2 bouyer return;
258 1.2 bouyer }
259 1.2 bouyer
260 1.2 bouyer /*
261 1.2 bouyer * Even with WDCS_ERR, the device should accept a command packet
262 1.2 bouyer * Limit length to what can be stuffed into the cylinder register
263 1.2 bouyer * (16 bits). Some CD-ROMs seem to interpret '0' as 65536,
264 1.2 bouyer * but not all devices do that and it's not obvious from the
265 1.2 bouyer * ATAPI spec that that behaviour should be expected. If more
266 1.2 bouyer * data is necessary, multiple data transfer phases will be done.
267 1.2 bouyer */
268 1.5 bouyer
269 1.2 bouyer wdccommand(chp, xfer->drive, ATAPI_PKT_CMD,
270 1.2 bouyer sc_xfer->datalen <= 0xffff ? sc_xfer->datalen : 0xffff,
271 1.2 bouyer 0, 0, 0,
272 1.2 bouyer (xfer->c_flags & C_DMA) ? ATAPI_PKT_CMD_FTRE_DMA : 0);
273 1.2 bouyer
274 1.2 bouyer /*
275 1.2 bouyer * If there is no interrupt for CMD input, busy-wait for it (done in
276 1.2 bouyer * the interrupt routine. If it is a polled command, call the interrupt
277 1.2 bouyer * routine until command is done.
278 1.2 bouyer */
279 1.2 bouyer if ((sc_xfer->sc_link->scsipi_atapi.cap & 0x0300) != ACAP_DRQ_INTR ||
280 1.2 bouyer sc_xfer->flags & SCSI_POLL) {
281 1.2 bouyer /* Wait for at last 400ns for status bit to be valid */
282 1.2 bouyer delay(1);
283 1.2 bouyer if (wdc_atapi_intr(chp, xfer) == 0) {
284 1.3 bouyer sc_xfer->error = XS_TIMEOUT;
285 1.2 bouyer wdc_atapi_reset(chp, xfer);
286 1.2 bouyer return;
287 1.2 bouyer }
288 1.2 bouyer }
289 1.2 bouyer if (sc_xfer->flags & SCSI_POLL) {
290 1.2 bouyer while ((sc_xfer->flags & ITSDONE) == 0) {
291 1.2 bouyer /* Wait for at last 400ns for status bit to be valid */
292 1.2 bouyer delay(1);
293 1.2 bouyer if (wdc_atapi_intr(chp, xfer) == 0) {
294 1.2 bouyer sc_xfer->error = XS_SELTIMEOUT;
295 1.2 bouyer /* do we know more ? */
296 1.2 bouyer wdc_atapi_done(chp, xfer);
297 1.2 bouyer return;
298 1.2 bouyer }
299 1.2 bouyer }
300 1.2 bouyer }
301 1.2 bouyer }
302 1.2 bouyer
303 1.2 bouyer int
304 1.2 bouyer wdc_atapi_intr(chp, xfer)
305 1.2 bouyer struct channel_softc *chp;
306 1.2 bouyer struct wdc_xfer *xfer;
307 1.2 bouyer {
308 1.2 bouyer struct scsipi_xfer *sc_xfer = xfer->cmd;
309 1.2 bouyer struct ata_drive_datas *drvp = &chp->ch_drive[xfer->drive];
310 1.2 bouyer int len, phase, i, retries=0;
311 1.2 bouyer int ire, dma_err = 0;
312 1.2 bouyer int dma_flags = 0;
313 1.2 bouyer
314 1.5 bouyer WDCDEBUG_PRINT(("wdc_atapi_intr %s:%d:%d\n",
315 1.5 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drvp->drive), DEBUG_INTR);
316 1.2 bouyer
317 1.2 bouyer /* Is it not a transfer, but a control operation? */
318 1.2 bouyer if (drvp->state < READY) {
319 1.2 bouyer printf("%s:%d:%d: bad state %d in wdc_atapi_intr\n",
320 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, xfer->drive,
321 1.2 bouyer drvp->state);
322 1.2 bouyer panic("wdc_atapi_intr: bad state\n");
323 1.2 bouyer }
324 1.2 bouyer /* Ack interrupt done in wait_for_unbusy */
325 1.2 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
326 1.2 bouyer WDSD_IBM | (xfer->drive << 4));
327 1.2 bouyer if (wait_for_unbusy(chp, sc_xfer->timeout) != 0) {
328 1.2 bouyer printf("%s:%d:%d: device timeout, c_bcount=%d, c_skip%d\n",
329 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, xfer->drive,
330 1.2 bouyer xfer->c_bcount, xfer->c_skip);
331 1.3 bouyer sc_xfer->error = XS_TIMEOUT;
332 1.2 bouyer wdc_atapi_reset(chp, xfer);
333 1.2 bouyer return 1;
334 1.2 bouyer }
335 1.2 bouyer /* Error here only if the command is aborted */
336 1.2 bouyer if ((chp->ch_status & WDCS_ERR) != 0 &&
337 1.2 bouyer (chp->ch_error & WDCE_ABRT) != 0) {
338 1.2 bouyer sc_xfer->error = XS_SENSE;
339 1.2 bouyer sc_xfer->sense.atapi_sense = chp->ch_error;
340 1.2 bouyer WDCDEBUG_PRINT(("wdc_atapi_intr: wdc_atapi_done(), "
341 1.2 bouyer "sense 0x%x\n", sc_xfer->sense.atapi_sense), DEBUG_INTR);
342 1.2 bouyer wdc_atapi_done(chp, xfer);
343 1.2 bouyer return 1;
344 1.2 bouyer }
345 1.2 bouyer
346 1.2 bouyer if (xfer->c_flags & C_DMA) {
347 1.2 bouyer dma_flags = (sc_xfer->flags & SCSI_DATA_IN) ?
348 1.2 bouyer WDC_DMA_READ : 0;
349 1.2 bouyer dma_flags |= sc_xfer->flags & SCSI_POLL ? WDC_DMA_POLL : 0;
350 1.2 bouyer }
351 1.2 bouyer again:
352 1.2 bouyer len = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_lo) +
353 1.2 bouyer 256 * bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_hi);
354 1.2 bouyer ire = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_ireason);
355 1.2 bouyer phase = (ire & (WDCI_CMD | WDCI_IN)) | (chp->ch_status & WDCS_DRQ);
356 1.2 bouyer WDCDEBUG_PRINT(("wdc_atapi_intr: c_bcount %d len %d st 0x%x err 0x%x "
357 1.2 bouyer "ire 0x%x :", xfer->c_bcount,
358 1.2 bouyer len, chp->ch_status, chp->ch_error, ire), DEBUG_INTR);
359 1.2 bouyer
360 1.2 bouyer switch (phase) {
361 1.2 bouyer case PHASE_CMDOUT:
362 1.2 bouyer WDCDEBUG_PRINT(("PHASE_CMDOUT\n"), DEBUG_INTR);
363 1.2 bouyer /* Init the DMA channel if necessary */
364 1.2 bouyer if (xfer->c_flags & C_DMA) {
365 1.2 bouyer if ((*chp->wdc->dma_init)(chp->wdc->dma_arg,
366 1.2 bouyer chp->channel, xfer->drive,
367 1.2 bouyer xfer->databuf, sc_xfer->datalen, dma_flags) != 0) {
368 1.2 bouyer sc_xfer->error = XS_DRIVER_STUFFUP;
369 1.2 bouyer break;
370 1.2 bouyer }
371 1.2 bouyer }
372 1.2 bouyer /* send packet command */
373 1.2 bouyer /* Commands are 12 or 16 bytes long. It's 32-bit aligned */
374 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM)) {
375 1.2 bouyer if (drvp->drive_flags & DRIVE_CAP32) {
376 1.2 bouyer bus_space_write_multi_4(chp->data32iot,
377 1.2 bouyer chp->data32ioh, 0,
378 1.2 bouyer (u_int32_t *)sc_xfer->cmd,
379 1.2 bouyer sc_xfer->cmdlen >> 2);
380 1.2 bouyer } else {
381 1.2 bouyer bus_space_write_multi_2(chp->cmd_iot,
382 1.2 bouyer chp->cmd_ioh, wd_data,
383 1.2 bouyer (u_int16_t *)sc_xfer->cmd,
384 1.2 bouyer sc_xfer->cmdlen >> 1);
385 1.2 bouyer }
386 1.2 bouyer } else {
387 1.2 bouyer if (drvp->drive_flags & DRIVE_CAP32) {
388 1.2 bouyer bus_space_write_multi_stream_4(chp->data32iot,
389 1.2 bouyer chp->data32ioh, 0,
390 1.2 bouyer (u_int32_t *)sc_xfer->cmd,
391 1.2 bouyer sc_xfer->cmdlen >> 2);
392 1.2 bouyer } else {
393 1.2 bouyer bus_space_write_multi_stream_2(chp->cmd_iot,
394 1.2 bouyer chp->cmd_ioh, wd_data,
395 1.2 bouyer (u_int16_t *)sc_xfer->cmd,
396 1.2 bouyer sc_xfer->cmdlen >> 1);
397 1.2 bouyer }
398 1.2 bouyer }
399 1.2 bouyer /* Start the DMA channel if necessary */
400 1.2 bouyer if (xfer->c_flags & C_DMA) {
401 1.2 bouyer (*chp->wdc->dma_start)(chp->wdc->dma_arg,
402 1.2 bouyer chp->channel, xfer->drive, dma_flags);
403 1.2 bouyer }
404 1.2 bouyer
405 1.2 bouyer if ((sc_xfer->flags & SCSI_POLL) == 0) {
406 1.2 bouyer chp->ch_flags |= WDCF_IRQ_WAIT;
407 1.2 bouyer timeout(wdctimeout, chp, sc_xfer->timeout * hz / 1000);
408 1.2 bouyer }
409 1.2 bouyer return 1;
410 1.2 bouyer
411 1.2 bouyer case PHASE_DATAOUT:
412 1.2 bouyer /* write data */
413 1.2 bouyer WDCDEBUG_PRINT(("PHASE_DATAOUT\n"), DEBUG_INTR);
414 1.2 bouyer if ((sc_xfer->flags & SCSI_DATA_OUT) == 0 ||
415 1.2 bouyer (xfer->c_flags & C_DMA) != 0) {
416 1.2 bouyer printf("wdc_atapi_intr: bad data phase DATAOUT");
417 1.2 bouyer if (xfer->c_flags & C_DMA) {
418 1.2 bouyer printf(", falling back to PIO\n");
419 1.2 bouyer drvp->drive_flags &= ~(DRIVE_DMA | DRIVE_UDMA);
420 1.2 bouyer }
421 1.3 bouyer sc_xfer->error = XS_TIMEOUT;
422 1.2 bouyer wdc_atapi_reset(chp, xfer);
423 1.2 bouyer return 1;
424 1.2 bouyer }
425 1.2 bouyer if (xfer->c_bcount < len) {
426 1.2 bouyer printf("wdc_atapi_intr: warning: write only "
427 1.2 bouyer "%d of %d requested bytes\n", xfer->c_bcount, len);
428 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM)) {
429 1.2 bouyer bus_space_write_multi_2(chp->cmd_iot,
430 1.2 bouyer chp->cmd_ioh, wd_data,
431 1.2 bouyer xfer->databuf + xfer->c_skip,
432 1.2 bouyer xfer->c_bcount >> 1);
433 1.2 bouyer } else {
434 1.2 bouyer bus_space_write_multi_stream_2(chp->cmd_iot,
435 1.2 bouyer chp->cmd_ioh, wd_data,
436 1.2 bouyer xfer->databuf + xfer->c_skip,
437 1.2 bouyer xfer->c_bcount >> 1);
438 1.2 bouyer }
439 1.2 bouyer for (i = xfer->c_bcount; i < len; i += 2)
440 1.2 bouyer bus_space_write_2(chp->cmd_iot, chp->cmd_ioh,
441 1.2 bouyer wd_data, 0);
442 1.2 bouyer xfer->c_skip += xfer->c_bcount;
443 1.2 bouyer xfer->c_bcount = 0;
444 1.2 bouyer } else {
445 1.2 bouyer if (drvp->drive_flags & DRIVE_CAP32) {
446 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM))
447 1.2 bouyer bus_space_write_multi_4(chp->data32iot,
448 1.2 bouyer chp->data32ioh, 0,
449 1.2 bouyer xfer->databuf + xfer->c_skip, len >> 2);
450 1.2 bouyer else
451 1.2 bouyer bus_space_write_multi_stream_4(chp->cmd_iot,
452 1.2 bouyer chp->cmd_ioh, wd_data,
453 1.2 bouyer xfer->databuf + xfer->c_skip, len >> 2);
454 1.2 bouyer
455 1.2 bouyer xfer->c_skip += len & 0xfffffffc;
456 1.2 bouyer xfer->c_bcount -= len & 0xfffffffc;
457 1.2 bouyer len = len & 0x03;
458 1.2 bouyer }
459 1.2 bouyer if (len > 0) {
460 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM))
461 1.2 bouyer bus_space_write_multi_2(chp->cmd_iot,
462 1.2 bouyer chp->cmd_ioh, wd_data,
463 1.2 bouyer xfer->databuf + xfer->c_skip, len >> 1);
464 1.2 bouyer else
465 1.2 bouyer bus_space_write_multi_stream_2(chp->cmd_iot,
466 1.2 bouyer chp->cmd_ioh, wd_data,
467 1.2 bouyer xfer->databuf + xfer->c_skip, len >> 1);
468 1.2 bouyer xfer->c_skip += len;
469 1.2 bouyer xfer->c_bcount -= len;
470 1.2 bouyer }
471 1.2 bouyer }
472 1.2 bouyer if ((sc_xfer->flags & SCSI_POLL) == 0) {
473 1.2 bouyer chp->ch_flags |= WDCF_IRQ_WAIT;
474 1.2 bouyer timeout(wdctimeout, chp, sc_xfer->timeout * hz / 1000);
475 1.2 bouyer }
476 1.2 bouyer return 1;
477 1.2 bouyer
478 1.2 bouyer case PHASE_DATAIN:
479 1.2 bouyer /* Read data */
480 1.2 bouyer WDCDEBUG_PRINT(("PHASE_DATAIN\n"), DEBUG_INTR);
481 1.2 bouyer if ((sc_xfer->flags & SCSI_DATA_IN) == 0 ||
482 1.2 bouyer (xfer->c_flags & C_DMA) != 0) {
483 1.2 bouyer printf("wdc_atapi_intr: bad data phase DATAIN");
484 1.2 bouyer if (xfer->c_flags & C_DMA) {
485 1.2 bouyer printf(", falling back to PIO\n");
486 1.2 bouyer drvp->drive_flags &= ~(DRIVE_DMA | DRIVE_UDMA);
487 1.2 bouyer }
488 1.3 bouyer sc_xfer->error = XS_TIMEOUT;
489 1.2 bouyer wdc_atapi_reset(chp, xfer);
490 1.2 bouyer return 1;
491 1.2 bouyer }
492 1.2 bouyer if (xfer->c_bcount < len) {
493 1.2 bouyer printf("wdc_atapi_intr: warning: reading only "
494 1.2 bouyer "%d of %d bytes\n", xfer->c_bcount, len);
495 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM)) {
496 1.2 bouyer bus_space_read_multi_2(chp->cmd_iot,
497 1.2 bouyer chp->cmd_ioh, wd_data,
498 1.2 bouyer xfer->databuf + xfer->c_skip, xfer->c_bcount >> 1);
499 1.2 bouyer } else {
500 1.2 bouyer bus_space_read_multi_stream_2(chp->cmd_iot,
501 1.2 bouyer chp->cmd_ioh, wd_data,
502 1.2 bouyer xfer->databuf + xfer->c_skip, xfer->c_bcount >> 1);
503 1.2 bouyer }
504 1.2 bouyer wdcbit_bucket(chp, len - xfer->c_bcount);
505 1.2 bouyer xfer->c_skip += xfer->c_bcount;
506 1.2 bouyer xfer->c_bcount = 0;
507 1.2 bouyer } else {
508 1.2 bouyer if (drvp->drive_flags & DRIVE_CAP32) {
509 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM))
510 1.2 bouyer bus_space_read_multi_4(chp->data32iot,
511 1.2 bouyer chp->data32ioh, 0,
512 1.2 bouyer xfer->databuf + xfer->c_skip, len >> 2);
513 1.2 bouyer else
514 1.2 bouyer bus_space_read_multi_stream_4(chp->cmd_iot,
515 1.2 bouyer chp->cmd_ioh, wd_data,
516 1.2 bouyer xfer->databuf + xfer->c_skip, len >> 2);
517 1.2 bouyer
518 1.2 bouyer xfer->c_skip += len & 0xfffffffc;
519 1.2 bouyer xfer->c_bcount -= len & 0xfffffffc;
520 1.2 bouyer len = len & 0x03;
521 1.2 bouyer }
522 1.2 bouyer if (len > 0) {
523 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_ATAPI_NOSTREAM))
524 1.2 bouyer bus_space_read_multi_2(chp->cmd_iot,
525 1.2 bouyer chp->cmd_ioh, wd_data,
526 1.2 bouyer xfer->databuf + xfer->c_skip, len >> 1);
527 1.2 bouyer else
528 1.2 bouyer bus_space_read_multi_stream_2(chp->cmd_iot,
529 1.2 bouyer chp->cmd_ioh, wd_data,
530 1.2 bouyer xfer->databuf + xfer->c_skip, len >> 1);
531 1.2 bouyer xfer->c_skip += len;
532 1.2 bouyer xfer->c_bcount -=len;
533 1.2 bouyer }
534 1.2 bouyer }
535 1.2 bouyer if ((sc_xfer->flags & SCSI_POLL) == 0) {
536 1.2 bouyer chp->ch_flags |= WDCF_IRQ_WAIT;
537 1.2 bouyer timeout(wdctimeout, chp, sc_xfer->timeout * hz / 1000);
538 1.2 bouyer }
539 1.2 bouyer return 1;
540 1.2 bouyer
541 1.2 bouyer case PHASE_ABORTED:
542 1.2 bouyer case PHASE_COMPLETED:
543 1.2 bouyer WDCDEBUG_PRINT(("PHASE_COMPLETED\n"), DEBUG_INTR);
544 1.2 bouyer /* turn off DMA channel */
545 1.2 bouyer if (xfer->c_flags & C_DMA) {
546 1.2 bouyer dma_err = (*chp->wdc->dma_finish)(chp->wdc->dma_arg,
547 1.2 bouyer chp->channel, xfer->drive, dma_flags);
548 1.2 bouyer xfer->c_bcount -= sc_xfer->datalen;
549 1.2 bouyer }
550 1.2 bouyer
551 1.2 bouyer if (chp->ch_status & WDCS_ERR) {
552 1.2 bouyer sc_xfer->error = XS_SENSE;
553 1.2 bouyer sc_xfer->sense.atapi_sense = chp->ch_error;
554 1.2 bouyer } else if (dma_err < 0) {
555 1.2 bouyer sc_xfer->error = XS_DRIVER_STUFFUP;
556 1.2 bouyer }
557 1.7 bouyer if (xfer->c_bcount != 0) {
558 1.7 bouyer WDCDEBUG_PRINT(("wdc_atapi_intr: bcount value is "
559 1.7 bouyer "%d after io\n", xfer->c_bcount), DEBUG_XFERS);
560 1.7 bouyer }
561 1.2 bouyer #ifdef DIAGNOSTIC
562 1.7 bouyer if (xfer->c_bcount < 0) {
563 1.2 bouyer printf("wdc_atapi_intr warning: bcount value "
564 1.2 bouyer "is %d after io\n", xfer->c_bcount);
565 1.2 bouyer }
566 1.2 bouyer #endif
567 1.2 bouyer break;
568 1.2 bouyer
569 1.2 bouyer default:
570 1.2 bouyer if (++retries<500) {
571 1.2 bouyer DELAY(100);
572 1.2 bouyer chp->ch_status = bus_space_read_1(chp->cmd_iot,
573 1.2 bouyer chp->cmd_ioh, wd_status);
574 1.2 bouyer chp->ch_error = bus_space_read_1(chp->cmd_iot,
575 1.2 bouyer chp->cmd_ioh, wd_error);
576 1.2 bouyer goto again;
577 1.2 bouyer }
578 1.2 bouyer printf("wdc_atapi_intr: unknown phase 0x%x\n", phase);
579 1.2 bouyer if (chp->ch_status & WDCS_ERR) {
580 1.2 bouyer sc_xfer->error = XS_SENSE;
581 1.2 bouyer sc_xfer->sense.atapi_sense = chp->ch_error;
582 1.2 bouyer } else {
583 1.2 bouyer sc_xfer->error = XS_DRIVER_STUFFUP;
584 1.2 bouyer }
585 1.2 bouyer }
586 1.2 bouyer WDCDEBUG_PRINT(("wdc_atapi_intr: wdc_atapi_done() (end), error 0x%x "
587 1.2 bouyer "sense 0x%x\n", sc_xfer->error, sc_xfer->sense.atapi_sense),
588 1.2 bouyer DEBUG_INTR);
589 1.2 bouyer wdc_atapi_done(chp, xfer);
590 1.2 bouyer return (1);
591 1.2 bouyer }
592 1.2 bouyer
593 1.2 bouyer int
594 1.2 bouyer wdc_atapi_ctrl(chp, xfer)
595 1.2 bouyer struct channel_softc *chp;
596 1.2 bouyer struct wdc_xfer *xfer;
597 1.2 bouyer {
598 1.2 bouyer struct scsipi_xfer *sc_xfer = xfer->cmd;
599 1.2 bouyer struct ata_drive_datas *drvp = &chp->ch_drive[xfer->drive];
600 1.2 bouyer char *errstring = NULL;
601 1.2 bouyer
602 1.2 bouyer /* Ack interrupt done in wait_for_unbusy */
603 1.2 bouyer again:
604 1.5 bouyer WDCDEBUG_PRINT(("wdc_atapi_ctrl %s:%d:%d state %d\n",
605 1.5 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drvp->drive, drvp->state),
606 1.4 bouyer DEBUG_INTR | DEBUG_FUNCS);
607 1.2 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
608 1.2 bouyer WDSD_IBM | (xfer->drive << 4));
609 1.2 bouyer switch (drvp->state) {
610 1.2 bouyer case PIOMODE:
611 1.2 bouyer /* Don't try to set mode if controller can't be adjusted */
612 1.2 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_MODE) == 0)
613 1.2 bouyer goto ready;
614 1.6 bouyer /* Also don't try if the drive didn't report its mode */
615 1.6 bouyer if ((drvp->drive_flags & DRIVE_MODE) == 0)
616 1.6 bouyer goto ready;;
617 1.2 bouyer wdccommand(chp, drvp->drive, SET_FEATURES, 0, 0, 0,
618 1.2 bouyer 0x08 | drvp->PIO_mode, WDSF_SET_MODE);
619 1.2 bouyer drvp->state = PIOMODE_WAIT;
620 1.2 bouyer break;
621 1.2 bouyer case PIOMODE_WAIT:
622 1.2 bouyer errstring = "piomode";
623 1.2 bouyer if (wait_for_unbusy(chp, ATAPI_DELAY))
624 1.2 bouyer goto timeout;
625 1.2 bouyer if (chp->ch_status & WDCS_ERR)
626 1.2 bouyer goto error;
627 1.2 bouyer /* fall through */
628 1.2 bouyer
629 1.2 bouyer case DMAMODE:
630 1.2 bouyer if (drvp->drive_flags & DRIVE_UDMA) {
631 1.2 bouyer wdccommand(chp, drvp->drive, SET_FEATURES, 0, 0, 0,
632 1.2 bouyer 0x40 | drvp->UDMA_mode, WDSF_SET_MODE);
633 1.2 bouyer } else if (drvp->drive_flags & DRIVE_DMA) {
634 1.2 bouyer wdccommand(chp, drvp->drive, SET_FEATURES, 0, 0, 0,
635 1.2 bouyer 0x20 | drvp->DMA_mode, WDSF_SET_MODE);
636 1.2 bouyer } else {
637 1.2 bouyer goto ready;
638 1.2 bouyer }
639 1.2 bouyer drvp->state = DMAMODE_WAIT;
640 1.2 bouyer break;
641 1.2 bouyer case DMAMODE_WAIT:
642 1.2 bouyer errstring = "dmamode";
643 1.2 bouyer if (wait_for_unbusy(chp, ATAPI_DELAY))
644 1.2 bouyer goto timeout;
645 1.2 bouyer if (chp->ch_status & WDCS_ERR)
646 1.2 bouyer goto error;
647 1.2 bouyer /* fall through */
648 1.2 bouyer
649 1.2 bouyer case READY:
650 1.2 bouyer ready:
651 1.2 bouyer drvp->state = READY;
652 1.2 bouyer xfer->c_intr = wdc_atapi_intr;
653 1.2 bouyer wdc_atapi_start(chp, xfer);
654 1.2 bouyer return 1;
655 1.2 bouyer }
656 1.2 bouyer if ((sc_xfer->flags & SCSI_POLL) == 0) {
657 1.2 bouyer chp->ch_flags |= WDCF_IRQ_WAIT;
658 1.2 bouyer xfer->c_intr = wdc_atapi_ctrl;
659 1.2 bouyer timeout(wdctimeout, chp, sc_xfer->timeout * hz / 1000);
660 1.2 bouyer } else {
661 1.2 bouyer goto again;
662 1.2 bouyer }
663 1.2 bouyer return 1;
664 1.2 bouyer
665 1.2 bouyer timeout:
666 1.2 bouyer if ((xfer->c_flags & C_TIMEOU) == 0 ) {
667 1.2 bouyer return 0; /* IRQ was not for us */
668 1.2 bouyer }
669 1.2 bouyer printf("%s:%d:%d: %s timed out\n",
670 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, xfer->drive, errstring);
671 1.3 bouyer sc_xfer->error = XS_TIMEOUT;
672 1.2 bouyer wdc_atapi_reset(chp, xfer);
673 1.2 bouyer return 1;
674 1.2 bouyer error:
675 1.2 bouyer printf("%s:%d:%d: %s ",
676 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, xfer->drive,
677 1.2 bouyer errstring);
678 1.3 bouyer printf("error (0x%x)\n", chp->ch_error);
679 1.2 bouyer sc_xfer->error = XS_SENSE;
680 1.2 bouyer sc_xfer->sense.atapi_sense = chp->ch_error;
681 1.3 bouyer wdc_atapi_reset(chp, xfer);
682 1.2 bouyer return 1;
683 1.2 bouyer }
684 1.2 bouyer
685 1.2 bouyer void
686 1.2 bouyer wdc_atapi_done(chp, xfer)
687 1.2 bouyer struct channel_softc *chp;
688 1.2 bouyer struct wdc_xfer *xfer;
689 1.2 bouyer {
690 1.2 bouyer struct scsipi_xfer *sc_xfer = xfer->cmd;
691 1.2 bouyer struct wdc_softc *wdc = chp->wdc;
692 1.2 bouyer int need_done = xfer->c_flags & C_NEEDDONE;
693 1.2 bouyer
694 1.5 bouyer WDCDEBUG_PRINT(("wdc_atapi_done %s:%d:%d: flags 0x%x\n",
695 1.5 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, xfer->drive,
696 1.5 bouyer (u_int)xfer->c_flags), DEBUG_XFERS);
697 1.2 bouyer sc_xfer->resid = xfer->c_bcount;
698 1.2 bouyer /* remove this command from xfer queue */
699 1.2 bouyer xfer->c_skip = 0;
700 1.2 bouyer wdc_free_xfer(chp, xfer);
701 1.2 bouyer sc_xfer->flags |= ITSDONE;
702 1.2 bouyer if (need_done) {
703 1.4 bouyer WDCDEBUG_PRINT(("wdc_atapi_done: scsipi_done\n"), DEBUG_XFERS);
704 1.2 bouyer scsipi_done(sc_xfer);
705 1.2 bouyer }
706 1.2 bouyer WDCDEBUG_PRINT(("wdcstart from wdc_atapi_done, flags 0x%x\n",
707 1.4 bouyer chp->ch_flags), DEBUG_XFERS);
708 1.2 bouyer wdcstart(wdc, chp->channel);
709 1.2 bouyer }
710 1.2 bouyer
711 1.2 bouyer void
712 1.2 bouyer wdc_atapi_reset(chp, xfer)
713 1.2 bouyer struct channel_softc *chp;
714 1.2 bouyer struct wdc_xfer *xfer;
715 1.2 bouyer {
716 1.2 bouyer struct ata_drive_datas *drvp = &chp->ch_drive[xfer->drive];
717 1.2 bouyer struct scsipi_xfer *sc_xfer = xfer->cmd;
718 1.2 bouyer
719 1.2 bouyer wdccommandshort(chp, xfer->drive, ATAPI_SOFT_RESET);
720 1.2 bouyer drvp->state = 0;
721 1.2 bouyer if (wait_for_unbusy(chp, WDC_RESET_WAIT) != 0) {
722 1.2 bouyer printf("%s:%d:%d: reset failed\n",
723 1.2 bouyer chp->wdc->sc_dev.dv_xname, chp->channel,
724 1.2 bouyer xfer->drive);
725 1.2 bouyer sc_xfer->error = XS_SELTIMEOUT;
726 1.2 bouyer wdc_atapi_done(chp, xfer);
727 1.2 bouyer return;
728 1.2 bouyer }
729 1.2 bouyer wdc_atapi_done(chp, xfer);
730 1.2 bouyer return;
731 1.2 bouyer }
732