ata_wdc.c revision 1.64 1 1.64 thorpej /* $NetBSD: ata_wdc.c,v 1.64 2004/08/12 05:02:50 thorpej Exp $ */
2 1.2 bouyer
3 1.2 bouyer /*
4 1.41 bouyer * Copyright (c) 1998, 2001, 2003 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.36 bouyer * This product includes software developed by Manuel Bouyer.
17 1.40 bouyer * 4. The name of the author may not be used to endorse or promote products
18 1.40 bouyer * derived from this software without specific prior written permission.
19 1.2 bouyer *
20 1.27 bouyer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 1.27 bouyer * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22 1.27 bouyer * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23 1.27 bouyer * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 1.27 bouyer * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 1.27 bouyer * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 1.27 bouyer * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27 1.27 bouyer * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 1.27 bouyer * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 1.27 bouyer * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 1.2 bouyer */
31 1.2 bouyer
32 1.2 bouyer /*-
33 1.57 mycroft * Copyright (c) 1998, 2004 The NetBSD Foundation, Inc.
34 1.2 bouyer * All rights reserved.
35 1.2 bouyer *
36 1.2 bouyer * This code is derived from software contributed to The NetBSD Foundation
37 1.2 bouyer * by Charles M. Hannum, by Onno van der Linden and by Manuel Bouyer.
38 1.2 bouyer *
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.2 bouyer * This product includes software developed by the NetBSD
50 1.2 bouyer * Foundation, Inc. and its contributors.
51 1.2 bouyer * 4. Neither the name of The NetBSD Foundation nor the names of its
52 1.2 bouyer * contributors may be used to endorse or promote products derived
53 1.2 bouyer * from this software without specific prior written permission.
54 1.2 bouyer *
55 1.2 bouyer * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
56 1.2 bouyer * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
57 1.2 bouyer * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
58 1.2 bouyer * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
59 1.2 bouyer * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
60 1.2 bouyer * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
61 1.2 bouyer * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
62 1.2 bouyer * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
63 1.2 bouyer * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
64 1.2 bouyer * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
65 1.2 bouyer * POSSIBILITY OF SUCH DAMAGE.
66 1.2 bouyer */
67 1.31 lukem
68 1.31 lukem #include <sys/cdefs.h>
69 1.64 thorpej __KERNEL_RCSID(0, "$NetBSD: ata_wdc.c,v 1.64 2004/08/12 05:02:50 thorpej Exp $");
70 1.2 bouyer
71 1.15 hubertf #ifndef WDCDEBUG
72 1.2 bouyer #define WDCDEBUG
73 1.15 hubertf #endif /* WDCDEBUG */
74 1.2 bouyer
75 1.2 bouyer #include <sys/param.h>
76 1.2 bouyer #include <sys/systm.h>
77 1.2 bouyer #include <sys/kernel.h>
78 1.2 bouyer #include <sys/file.h>
79 1.2 bouyer #include <sys/stat.h>
80 1.2 bouyer #include <sys/buf.h>
81 1.2 bouyer #include <sys/malloc.h>
82 1.2 bouyer #include <sys/device.h>
83 1.2 bouyer #include <sys/disklabel.h>
84 1.2 bouyer #include <sys/syslog.h>
85 1.2 bouyer #include <sys/proc.h>
86 1.2 bouyer
87 1.2 bouyer #include <machine/intr.h>
88 1.2 bouyer #include <machine/bus.h>
89 1.2 bouyer #ifndef __BUS_SPACE_HAS_STREAM_METHODS
90 1.2 bouyer #define bus_space_write_multi_stream_2 bus_space_write_multi_2
91 1.2 bouyer #define bus_space_write_multi_stream_4 bus_space_write_multi_4
92 1.2 bouyer #define bus_space_read_multi_stream_2 bus_space_read_multi_2
93 1.2 bouyer #define bus_space_read_multi_stream_4 bus_space_read_multi_4
94 1.2 bouyer #endif /* __BUS_SPACE_HAS_STREAM_METHODS */
95 1.2 bouyer
96 1.2 bouyer #include <dev/ata/atareg.h>
97 1.2 bouyer #include <dev/ata/atavar.h>
98 1.2 bouyer #include <dev/ic/wdcreg.h>
99 1.2 bouyer #include <dev/ic/wdcvar.h>
100 1.2 bouyer
101 1.2 bouyer #define DEBUG_INTR 0x01
102 1.2 bouyer #define DEBUG_XFERS 0x02
103 1.2 bouyer #define DEBUG_STATUS 0x04
104 1.2 bouyer #define DEBUG_FUNCS 0x08
105 1.2 bouyer #define DEBUG_PROBE 0x10
106 1.2 bouyer #ifdef WDCDEBUG
107 1.41 bouyer extern int wdcdebug_wd_mask; /* inited in wd.c */
108 1.2 bouyer #define WDCDEBUG_PRINT(args, level) \
109 1.2 bouyer if (wdcdebug_wd_mask & (level)) \
110 1.2 bouyer printf args
111 1.2 bouyer #else
112 1.2 bouyer #define WDCDEBUG_PRINT(args, level)
113 1.2 bouyer #endif
114 1.2 bouyer
115 1.17 bouyer #define ATA_DELAY 10000 /* 10s for a drive I/O */
116 1.2 bouyer
117 1.45 thorpej static int wdc_ata_bio(struct ata_drive_datas*, struct ata_bio*);
118 1.50 thorpej static void wdc_ata_bio_start(struct wdc_channel *,struct ata_xfer *);
119 1.50 thorpej static void _wdc_ata_bio_start(struct wdc_channel *,struct ata_xfer *);
120 1.50 thorpej static int wdc_ata_bio_intr(struct wdc_channel *, struct ata_xfer *,
121 1.45 thorpej int);
122 1.58 bouyer static void wdc_ata_bio_kill_xfer(struct wdc_channel *,
123 1.58 bouyer struct ata_xfer *, int);
124 1.50 thorpej static void wdc_ata_bio_done(struct wdc_channel *, struct ata_xfer *);
125 1.45 thorpej static int wdc_ata_err(struct ata_drive_datas *, struct ata_bio *);
126 1.2 bouyer #define WDC_ATA_NOERR 0x00 /* Drive doesn't report an error */
127 1.2 bouyer #define WDC_ATA_RECOV 0x01 /* There was a recovered error */
128 1.2 bouyer #define WDC_ATA_ERR 0x02 /* Drive reports an error */
129 1.45 thorpej static int wdc_ata_addref(struct ata_drive_datas *);
130 1.45 thorpej static void wdc_ata_delref(struct ata_drive_datas *);
131 1.32 bouyer
132 1.32 bouyer const struct ata_bustype wdc_ata_bustype = {
133 1.32 bouyer SCSIPI_BUSTYPE_ATA,
134 1.32 bouyer wdc_ata_bio,
135 1.59 bouyer wdc_reset_drive,
136 1.32 bouyer wdc_exec_command,
137 1.32 bouyer ata_get_params,
138 1.32 bouyer wdc_ata_addref,
139 1.32 bouyer wdc_ata_delref,
140 1.61 bouyer wdc_kill_pending,
141 1.32 bouyer };
142 1.32 bouyer
143 1.2 bouyer /*
144 1.34 christos * Convert a 32 bit command to a 48 bit command.
145 1.34 christos */
146 1.44 thorpej static __inline
147 1.34 christos int to48(int cmd32)
148 1.34 christos {
149 1.34 christos switch (cmd32) {
150 1.34 christos case WDCC_READ:
151 1.34 christos return WDCC_READ_EXT;
152 1.34 christos case WDCC_WRITE:
153 1.34 christos return WDCC_WRITE_EXT;
154 1.34 christos case WDCC_READMULTI:
155 1.34 christos return WDCC_READMULTI_EXT;
156 1.34 christos case WDCC_WRITEMULTI:
157 1.34 christos return WDCC_WRITEMULTI_EXT;
158 1.35 christos case WDCC_READDMA:
159 1.35 christos return WDCC_READDMA_EXT;
160 1.35 christos case WDCC_WRITEDMA:
161 1.35 christos return WDCC_WRITEDMA_EXT;
162 1.34 christos default:
163 1.34 christos panic("ata_wdc: illegal 32 bit command %d", cmd32);
164 1.34 christos /*NOTREACHED*/
165 1.34 christos }
166 1.34 christos }
167 1.34 christos
168 1.34 christos /*
169 1.64 thorpej * Handle block I/O operation. Return ATACMD_COMPLETE, ATACMD_QUEUED, or
170 1.64 thorpej * ATACMD_TRY_AGAIN. Must be called at splbio().
171 1.2 bouyer */
172 1.45 thorpej static int
173 1.44 thorpej wdc_ata_bio(struct ata_drive_datas *drvp, struct ata_bio *ata_bio)
174 1.2 bouyer {
175 1.48 thorpej struct ata_xfer *xfer;
176 1.50 thorpej struct wdc_channel *chp = drvp->chnl_softc;
177 1.51 thorpej struct wdc_softc *wdc = chp->ch_wdc;
178 1.2 bouyer
179 1.2 bouyer xfer = wdc_get_xfer(WDC_NOSLEEP);
180 1.2 bouyer if (xfer == NULL)
181 1.64 thorpej return ATACMD_TRY_AGAIN;
182 1.51 thorpej if (wdc->cap & WDC_CAPABILITY_NOIRQ)
183 1.30 bjh21 ata_bio->flags |= ATA_POLL;
184 1.2 bouyer if (ata_bio->flags & ATA_POLL)
185 1.2 bouyer xfer->c_flags |= C_POLL;
186 1.2 bouyer if ((drvp->drive_flags & (DRIVE_DMA | DRIVE_UDMA)) &&
187 1.2 bouyer (ata_bio->flags & ATA_SINGLE) == 0)
188 1.2 bouyer xfer->c_flags |= C_DMA;
189 1.48 thorpej xfer->c_drive = drvp->drive;
190 1.48 thorpej xfer->c_cmd = ata_bio;
191 1.48 thorpej xfer->c_databuf = ata_bio->databuf;
192 1.2 bouyer xfer->c_bcount = ata_bio->bcount;
193 1.2 bouyer xfer->c_start = wdc_ata_bio_start;
194 1.2 bouyer xfer->c_intr = wdc_ata_bio_intr;
195 1.22 enami xfer->c_kill_xfer = wdc_ata_bio_kill_xfer;
196 1.2 bouyer wdc_exec_xfer(chp, xfer);
197 1.64 thorpej return (ata_bio->flags & ATA_ITSDONE) ? ATACMD_COMPLETE : ATACMD_QUEUED;
198 1.2 bouyer }
199 1.2 bouyer
200 1.45 thorpej static void
201 1.50 thorpej wdc_ata_bio_start(struct wdc_channel *chp, struct ata_xfer *xfer)
202 1.2 bouyer {
203 1.51 thorpej struct wdc_softc *wdc = chp->ch_wdc;
204 1.48 thorpej struct ata_bio *ata_bio = xfer->c_cmd;
205 1.48 thorpej struct ata_drive_datas *drvp = &chp->ch_drive[xfer->c_drive];
206 1.41 bouyer int wait_flags = (xfer->c_flags & C_POLL) ? AT_POLL : 0;
207 1.41 bouyer char *errstring;
208 1.41 bouyer
209 1.20 bouyer WDCDEBUG_PRINT(("wdc_ata_bio_start %s:%d:%d\n",
210 1.51 thorpej wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive),
211 1.20 bouyer DEBUG_XFERS);
212 1.20 bouyer
213 1.41 bouyer /* Do control operations specially. */
214 1.41 bouyer if (__predict_false(drvp->state < READY)) {
215 1.41 bouyer /*
216 1.41 bouyer * Actually, we want to be careful not to mess with the control
217 1.41 bouyer * state if the device is currently busy, but we can assume
218 1.41 bouyer * that we never get to this point if that's the case.
219 1.41 bouyer */
220 1.41 bouyer /* If it's not a polled command, we need the kenrel thread */
221 1.41 bouyer if ((xfer->c_flags & C_POLL) == 0 &&
222 1.41 bouyer (chp->ch_flags & WDCF_TH_RUN) == 0) {
223 1.42 bouyer chp->ch_queue->queue_freeze++;
224 1.52 thorpej wakeup(&chp->ch_thread);
225 1.41 bouyer return;
226 1.41 bouyer }
227 1.41 bouyer /*
228 1.41 bouyer * disable interrupts, all commands here should be quick
229 1.41 bouyer * enouth to be able to poll, and we don't go here that often
230 1.41 bouyer */
231 1.41 bouyer bus_space_write_1(chp->ctl_iot, chp->ctl_ioh, wd_aux_ctlr,
232 1.41 bouyer WDCTL_4BIT | WDCTL_IDS);
233 1.51 thorpej if (wdc->cap & WDC_CAPABILITY_SELECT)
234 1.51 thorpej wdc->select(chp, xfer->c_drive);
235 1.43 fvdl bus_space_write_1(chp->cmd_iot, chp->cmd_iohs[wd_sdh], 0,
236 1.48 thorpej WDSD_IBM | (xfer->c_drive << 4));
237 1.53 fvdl DELAY(10);
238 1.41 bouyer errstring = "wait";
239 1.41 bouyer if (wdcwait(chp, WDCS_DRDY, WDCS_DRDY, ATA_DELAY, wait_flags))
240 1.41 bouyer goto ctrltimeout;
241 1.48 thorpej wdccommandshort(chp, xfer->c_drive, WDCC_RECAL);
242 1.41 bouyer /* Wait for at last 400ns for status bit to be valid */
243 1.41 bouyer DELAY(1);
244 1.41 bouyer errstring = "recal";
245 1.41 bouyer if (wdcwait(chp, WDCS_DRDY, WDCS_DRDY, ATA_DELAY, wait_flags))
246 1.41 bouyer goto ctrltimeout;
247 1.41 bouyer if (chp->ch_status & (WDCS_ERR | WDCS_DWF))
248 1.41 bouyer goto ctrlerror;
249 1.41 bouyer /* Don't try to set modes if controller can't be adjusted */
250 1.51 thorpej if ((wdc->cap & WDC_CAPABILITY_MODE) == 0)
251 1.41 bouyer goto geometry;
252 1.41 bouyer /* Also don't try if the drive didn't report its mode */
253 1.41 bouyer if ((drvp->drive_flags & DRIVE_MODE) == 0)
254 1.41 bouyer goto geometry;
255 1.41 bouyer wdccommand(chp, drvp->drive, SET_FEATURES, 0, 0, 0,
256 1.41 bouyer 0x08 | drvp->PIO_mode, WDSF_SET_MODE);
257 1.41 bouyer errstring = "piomode";
258 1.41 bouyer if (wdcwait(chp, WDCS_DRDY, WDCS_DRDY, ATA_DELAY, wait_flags))
259 1.41 bouyer goto ctrltimeout;
260 1.41 bouyer if (chp->ch_status & (WDCS_ERR | WDCS_DWF))
261 1.41 bouyer goto ctrlerror;
262 1.41 bouyer if (drvp->drive_flags & DRIVE_UDMA) {
263 1.41 bouyer wdccommand(chp, drvp->drive, SET_FEATURES, 0, 0, 0,
264 1.41 bouyer 0x40 | drvp->UDMA_mode, WDSF_SET_MODE);
265 1.41 bouyer } else if (drvp->drive_flags & DRIVE_DMA) {
266 1.41 bouyer wdccommand(chp, drvp->drive, SET_FEATURES, 0, 0, 0,
267 1.41 bouyer 0x20 | drvp->DMA_mode, WDSF_SET_MODE);
268 1.41 bouyer } else {
269 1.41 bouyer goto geometry;
270 1.41 bouyer }
271 1.41 bouyer errstring = "dmamode";
272 1.41 bouyer if (wdcwait(chp, WDCS_DRDY, WDCS_DRDY, ATA_DELAY, wait_flags))
273 1.41 bouyer goto ctrltimeout;
274 1.41 bouyer if (chp->ch_status & (WDCS_ERR | WDCS_DWF))
275 1.41 bouyer goto ctrlerror;
276 1.41 bouyer geometry:
277 1.41 bouyer if (ata_bio->flags & ATA_LBA)
278 1.41 bouyer goto multimode;
279 1.48 thorpej wdccommand(chp, xfer->c_drive, WDCC_IDP,
280 1.41 bouyer ata_bio->lp->d_ncylinders,
281 1.41 bouyer ata_bio->lp->d_ntracks - 1, 0, ata_bio->lp->d_nsectors,
282 1.41 bouyer (ata_bio->lp->d_type == DTYPE_ST506) ?
283 1.41 bouyer ata_bio->lp->d_precompcyl / 4 : 0);
284 1.41 bouyer errstring = "geometry";
285 1.41 bouyer if (wdcwait(chp, WDCS_DRDY, WDCS_DRDY, ATA_DELAY, wait_flags))
286 1.41 bouyer goto ctrltimeout;
287 1.41 bouyer if (chp->ch_status & (WDCS_ERR | WDCS_DWF))
288 1.41 bouyer goto ctrlerror;
289 1.41 bouyer multimode:
290 1.41 bouyer if (ata_bio->multi == 1)
291 1.41 bouyer goto ready;
292 1.48 thorpej wdccommand(chp, xfer->c_drive, WDCC_SETMULTI, 0, 0, 0,
293 1.41 bouyer ata_bio->multi, 0);
294 1.41 bouyer errstring = "setmulti";
295 1.41 bouyer if (wdcwait(chp, WDCS_DRDY, WDCS_DRDY, ATA_DELAY, wait_flags))
296 1.41 bouyer goto ctrltimeout;
297 1.41 bouyer if (chp->ch_status & (WDCS_ERR | WDCS_DWF))
298 1.41 bouyer goto ctrlerror;
299 1.41 bouyer ready:
300 1.41 bouyer drvp->state = READY;
301 1.41 bouyer /*
302 1.41 bouyer * The drive is usable now
303 1.41 bouyer */
304 1.41 bouyer bus_space_write_1(chp->ctl_iot, chp->ctl_ioh, wd_aux_ctlr,
305 1.41 bouyer WDCTL_4BIT);
306 1.54 bouyer delay(10); /* some drives need a little delay here */
307 1.41 bouyer }
308 1.41 bouyer
309 1.20 bouyer _wdc_ata_bio_start(chp, xfer);
310 1.41 bouyer return;
311 1.41 bouyer ctrltimeout:
312 1.41 bouyer printf("%s:%d:%d: %s timed out\n",
313 1.51 thorpej wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive,
314 1.51 thorpej errstring);
315 1.41 bouyer ata_bio->error = TIMEOUT;
316 1.41 bouyer goto ctrldone;
317 1.41 bouyer ctrlerror:
318 1.41 bouyer printf("%s:%d:%d: %s ",
319 1.51 thorpej wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive,
320 1.41 bouyer errstring);
321 1.41 bouyer if (chp->ch_status & WDCS_DWF) {
322 1.41 bouyer printf("drive fault\n");
323 1.41 bouyer ata_bio->error = ERR_DF;
324 1.41 bouyer } else {
325 1.41 bouyer printf("error (%x)\n", chp->ch_error);
326 1.41 bouyer ata_bio->r_error = chp->ch_error;
327 1.41 bouyer ata_bio->error = ERROR;
328 1.41 bouyer }
329 1.41 bouyer ctrldone:
330 1.41 bouyer drvp->state = 0;
331 1.41 bouyer wdc_ata_bio_done(chp, xfer);
332 1.41 bouyer bus_space_write_1(chp->ctl_iot, chp->ctl_ioh, wd_aux_ctlr, WDCTL_4BIT);
333 1.41 bouyer return;
334 1.20 bouyer }
335 1.20 bouyer
336 1.45 thorpej static void
337 1.50 thorpej _wdc_ata_bio_start(struct wdc_channel *chp, struct ata_xfer *xfer)
338 1.20 bouyer {
339 1.51 thorpej struct wdc_softc *wdc = chp->ch_wdc;
340 1.48 thorpej struct ata_bio *ata_bio = xfer->c_cmd;
341 1.48 thorpej struct ata_drive_datas *drvp = &chp->ch_drive[xfer->c_drive];
342 1.51 thorpej int wait_flags = (xfer->c_flags & C_POLL) ? AT_POLL : 0;
343 1.2 bouyer u_int16_t cyl;
344 1.2 bouyer u_int8_t head, sect, cmd = 0;
345 1.2 bouyer int nblks;
346 1.2 bouyer int dma_flags = 0;
347 1.2 bouyer
348 1.20 bouyer WDCDEBUG_PRINT(("_wdc_ata_bio_start %s:%d:%d\n",
349 1.51 thorpej wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive),
350 1.20 bouyer DEBUG_INTR | DEBUG_XFERS);
351 1.2 bouyer
352 1.2 bouyer if (xfer->c_flags & C_DMA) {
353 1.23 bouyer if (drvp->n_xfers <= NXFER)
354 1.23 bouyer drvp->n_xfers++;
355 1.2 bouyer dma_flags = (ata_bio->flags & ATA_READ) ? WDC_DMA_READ : 0;
356 1.39 nakayama if (ata_bio->flags & ATA_LBA48)
357 1.39 nakayama dma_flags |= WDC_DMA_LBA48;
358 1.2 bouyer }
359 1.2 bouyer again:
360 1.2 bouyer /*
361 1.2 bouyer *
362 1.2 bouyer * When starting a multi-sector transfer, or doing single-sector
363 1.2 bouyer * transfers...
364 1.2 bouyer */
365 1.2 bouyer if (xfer->c_skip == 0 || (ata_bio->flags & ATA_SINGLE) != 0) {
366 1.2 bouyer if (ata_bio->flags & ATA_SINGLE)
367 1.2 bouyer nblks = 1;
368 1.2 bouyer else
369 1.2 bouyer nblks = xfer->c_bcount / ata_bio->lp->d_secsize;
370 1.2 bouyer /* Check for bad sectors and adjust transfer, if necessary. */
371 1.2 bouyer if ((ata_bio->lp->d_flags & D_BADSECT) != 0) {
372 1.2 bouyer long blkdiff;
373 1.2 bouyer int i;
374 1.2 bouyer for (i = 0; (blkdiff = ata_bio->badsect[i]) != -1;
375 1.2 bouyer i++) {
376 1.2 bouyer blkdiff -= ata_bio->blkno;
377 1.2 bouyer if (blkdiff < 0)
378 1.2 bouyer continue;
379 1.2 bouyer if (blkdiff == 0) {
380 1.2 bouyer /* Replace current block of transfer. */
381 1.2 bouyer ata_bio->blkno =
382 1.2 bouyer ata_bio->lp->d_secperunit -
383 1.2 bouyer ata_bio->lp->d_nsectors - i - 1;
384 1.2 bouyer }
385 1.2 bouyer if (blkdiff < nblks) {
386 1.2 bouyer /* Bad block inside transfer. */
387 1.2 bouyer ata_bio->flags |= ATA_SINGLE;
388 1.2 bouyer nblks = 1;
389 1.2 bouyer }
390 1.2 bouyer break;
391 1.2 bouyer }
392 1.2 bouyer /* Transfer is okay now. */
393 1.2 bouyer }
394 1.34 christos if (ata_bio->flags & ATA_LBA48) {
395 1.34 christos sect = 0;
396 1.34 christos cyl = 0;
397 1.34 christos head = 0;
398 1.34 christos } else if (ata_bio->flags & ATA_LBA) {
399 1.2 bouyer sect = (ata_bio->blkno >> 0) & 0xff;
400 1.2 bouyer cyl = (ata_bio->blkno >> 8) & 0xffff;
401 1.2 bouyer head = (ata_bio->blkno >> 24) & 0x0f;
402 1.2 bouyer head |= WDSD_LBA;
403 1.2 bouyer } else {
404 1.2 bouyer int blkno = ata_bio->blkno;
405 1.2 bouyer sect = blkno % ata_bio->lp->d_nsectors;
406 1.2 bouyer sect++; /* Sectors begin with 1, not 0. */
407 1.2 bouyer blkno /= ata_bio->lp->d_nsectors;
408 1.2 bouyer head = blkno % ata_bio->lp->d_ntracks;
409 1.2 bouyer blkno /= ata_bio->lp->d_ntracks;
410 1.2 bouyer cyl = blkno;
411 1.2 bouyer head |= WDSD_CHS;
412 1.2 bouyer }
413 1.2 bouyer if (xfer->c_flags & C_DMA) {
414 1.2 bouyer ata_bio->nblks = nblks;
415 1.2 bouyer ata_bio->nbytes = xfer->c_bcount;
416 1.2 bouyer cmd = (ata_bio->flags & ATA_READ) ?
417 1.2 bouyer WDCC_READDMA : WDCC_WRITEDMA;
418 1.2 bouyer /* Init the DMA channel. */
419 1.51 thorpej if ((*wdc->dma_init)(wdc->dma_arg,
420 1.51 thorpej chp->ch_channel, xfer->c_drive,
421 1.48 thorpej (char *)xfer->c_databuf + xfer->c_skip,
422 1.11 augustss ata_bio->nbytes, dma_flags) != 0) {
423 1.2 bouyer ata_bio->error = ERR_DMA;
424 1.2 bouyer ata_bio->r_error = 0;
425 1.2 bouyer wdc_ata_bio_done(chp, xfer);
426 1.2 bouyer return;
427 1.2 bouyer }
428 1.2 bouyer /* Initiate command */
429 1.51 thorpej if (wdc->cap & WDC_CAPABILITY_SELECT)
430 1.51 thorpej wdc->select(chp, xfer->c_drive);
431 1.43 fvdl bus_space_write_1(chp->cmd_iot, chp->cmd_iohs[wd_sdh],
432 1.48 thorpej 0, WDSD_IBM | (xfer->c_drive << 4));
433 1.49 thorpej switch(wdc_wait_for_ready(chp, ATA_DELAY, wait_flags)) {
434 1.41 bouyer case WDCWAIT_OK:
435 1.41 bouyer break;
436 1.41 bouyer case WDCWAIT_TOUT:
437 1.2 bouyer goto timeout;
438 1.41 bouyer case WDCWAIT_THR:
439 1.41 bouyer return;
440 1.41 bouyer }
441 1.34 christos if (ata_bio->flags & ATA_LBA48) {
442 1.48 thorpej wdccommandext(chp, xfer->c_drive, to48(cmd),
443 1.34 christos (u_int64_t)ata_bio->blkno, nblks);
444 1.34 christos } else {
445 1.48 thorpej wdccommand(chp, xfer->c_drive, cmd, cyl,
446 1.34 christos head, sect, nblks, 0);
447 1.34 christos }
448 1.2 bouyer /* start the DMA channel */
449 1.51 thorpej (*wdc->dma_start)(wdc->dma_arg,
450 1.51 thorpej chp->ch_channel, xfer->c_drive);
451 1.26 bouyer chp->ch_flags |= WDCF_DMA_WAIT;
452 1.41 bouyer /* start timeout machinery */
453 1.41 bouyer if ((xfer->c_flags & C_POLL) == 0)
454 1.41 bouyer callout_reset(&chp->ch_callout,
455 1.41 bouyer ATA_DELAY / 1000 * hz, wdctimeout, chp);
456 1.2 bouyer /* wait for irq */
457 1.2 bouyer goto intr;
458 1.2 bouyer } /* else not DMA */
459 1.2 bouyer ata_bio->nblks = min(nblks, ata_bio->multi);
460 1.2 bouyer ata_bio->nbytes = ata_bio->nblks * ata_bio->lp->d_secsize;
461 1.56 mycroft KASSERT(nblks == 1 || (ata_bio->flags & ATA_SINGLE) == 0);
462 1.56 mycroft if (ata_bio->nblks > 1) {
463 1.2 bouyer cmd = (ata_bio->flags & ATA_READ) ?
464 1.2 bouyer WDCC_READMULTI : WDCC_WRITEMULTI;
465 1.2 bouyer } else {
466 1.2 bouyer cmd = (ata_bio->flags & ATA_READ) ?
467 1.2 bouyer WDCC_READ : WDCC_WRITE;
468 1.2 bouyer }
469 1.2 bouyer /* Initiate command! */
470 1.51 thorpej if (wdc->cap & WDC_CAPABILITY_SELECT)
471 1.51 thorpej wdc->select(chp, xfer->c_drive);
472 1.43 fvdl bus_space_write_1(chp->cmd_iot, chp->cmd_iohs[wd_sdh], 0,
473 1.48 thorpej WDSD_IBM | (xfer->c_drive << 4));
474 1.49 thorpej switch(wdc_wait_for_ready(chp, ATA_DELAY, wait_flags)) {
475 1.41 bouyer case WDCWAIT_OK:
476 1.41 bouyer break;
477 1.41 bouyer case WDCWAIT_TOUT:
478 1.2 bouyer goto timeout;
479 1.41 bouyer case WDCWAIT_THR:
480 1.41 bouyer return;
481 1.41 bouyer }
482 1.34 christos if (ata_bio->flags & ATA_LBA48) {
483 1.48 thorpej wdccommandext(chp, xfer->c_drive, to48(cmd),
484 1.34 christos (u_int64_t) ata_bio->blkno, nblks);
485 1.34 christos } else {
486 1.48 thorpej wdccommand(chp, xfer->c_drive, cmd, cyl,
487 1.34 christos head, sect, nblks,
488 1.34 christos (ata_bio->lp->d_type == DTYPE_ST506) ?
489 1.34 christos ata_bio->lp->d_precompcyl / 4 : 0);
490 1.34 christos }
491 1.41 bouyer /* start timeout machinery */
492 1.41 bouyer if ((xfer->c_flags & C_POLL) == 0)
493 1.41 bouyer callout_reset(&chp->ch_callout,
494 1.41 bouyer ATA_DELAY / 1000 * hz, wdctimeout, chp);
495 1.2 bouyer } else if (ata_bio->nblks > 1) {
496 1.2 bouyer /* The number of blocks in the last stretch may be smaller. */
497 1.2 bouyer nblks = xfer->c_bcount / ata_bio->lp->d_secsize;
498 1.2 bouyer if (ata_bio->nblks > nblks) {
499 1.2 bouyer ata_bio->nblks = nblks;
500 1.2 bouyer ata_bio->nbytes = xfer->c_bcount;
501 1.2 bouyer }
502 1.2 bouyer }
503 1.2 bouyer /* If this was a write and not using DMA, push the data. */
504 1.2 bouyer if ((ata_bio->flags & ATA_READ) == 0) {
505 1.41 bouyer /*
506 1.41 bouyer * we have to busy-wait here, we can't rely on running in
507 1.41 bouyer * thread context.
508 1.41 bouyer */
509 1.49 thorpej if (wdc_wait_for_drq(chp, ATA_DELAY, AT_POLL) != 0) {
510 1.2 bouyer printf("%s:%d:%d: timeout waiting for DRQ, "
511 1.2 bouyer "st=0x%02x, err=0x%02x\n",
512 1.51 thorpej wdc->sc_dev.dv_xname, chp->ch_channel,
513 1.48 thorpej xfer->c_drive, chp->ch_status, chp->ch_error);
514 1.16 bouyer if (wdc_ata_err(drvp, ata_bio) != WDC_ATA_ERR)
515 1.2 bouyer ata_bio->error = TIMEOUT;
516 1.2 bouyer wdc_ata_bio_done(chp, xfer);
517 1.2 bouyer return;
518 1.2 bouyer }
519 1.16 bouyer if (wdc_ata_err(drvp, ata_bio) == WDC_ATA_ERR) {
520 1.2 bouyer wdc_ata_bio_done(chp, xfer);
521 1.2 bouyer return;
522 1.2 bouyer }
523 1.63 mycroft wdc->dataout_pio(chp, drvp->drive_flags,
524 1.62 mycroft (char *)xfer->c_databuf + xfer->c_skip, ata_bio->nbytes);
525 1.2 bouyer }
526 1.2 bouyer
527 1.2 bouyer intr: /* Wait for IRQ (either real or polled) */
528 1.2 bouyer if ((ata_bio->flags & ATA_POLL) == 0) {
529 1.2 bouyer chp->ch_flags |= WDCF_IRQ_WAIT;
530 1.2 bouyer } else {
531 1.2 bouyer /* Wait for at last 400ns for status bit to be valid */
532 1.2 bouyer delay(1);
533 1.26 bouyer if (chp->ch_flags & WDCF_DMA_WAIT) {
534 1.26 bouyer wdc_dmawait(chp, xfer, ATA_DELAY);
535 1.26 bouyer chp->ch_flags &= ~WDCF_DMA_WAIT;
536 1.26 bouyer }
537 1.19 bouyer wdc_ata_bio_intr(chp, xfer, 0);
538 1.2 bouyer if ((ata_bio->flags & ATA_ITSDONE) == 0)
539 1.2 bouyer goto again;
540 1.2 bouyer }
541 1.2 bouyer return;
542 1.2 bouyer timeout:
543 1.2 bouyer printf("%s:%d:%d: not ready, st=0x%02x, err=0x%02x\n",
544 1.51 thorpej wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive,
545 1.2 bouyer chp->ch_status, chp->ch_error);
546 1.16 bouyer if (wdc_ata_err(drvp, ata_bio) != WDC_ATA_ERR)
547 1.2 bouyer ata_bio->error = TIMEOUT;
548 1.2 bouyer wdc_ata_bio_done(chp, xfer);
549 1.2 bouyer return;
550 1.2 bouyer }
551 1.2 bouyer
552 1.45 thorpej static int
553 1.50 thorpej wdc_ata_bio_intr(struct wdc_channel *chp, struct ata_xfer *xfer, int irq)
554 1.2 bouyer {
555 1.51 thorpej struct wdc_softc *wdc = chp->ch_wdc;
556 1.48 thorpej struct ata_bio *ata_bio = xfer->c_cmd;
557 1.48 thorpej struct ata_drive_datas *drvp = &chp->ch_drive[xfer->c_drive];
558 1.2 bouyer int drv_err;
559 1.2 bouyer
560 1.2 bouyer WDCDEBUG_PRINT(("wdc_ata_bio_intr %s:%d:%d\n",
561 1.51 thorpej wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive),
562 1.2 bouyer DEBUG_INTR | DEBUG_XFERS);
563 1.2 bouyer
564 1.2 bouyer
565 1.2 bouyer /* Is it not a transfer, but a control operation? */
566 1.2 bouyer if (drvp->state < READY) {
567 1.2 bouyer printf("%s:%d:%d: bad state %d in wdc_ata_bio_intr\n",
568 1.51 thorpej wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive,
569 1.2 bouyer drvp->state);
570 1.38 provos panic("wdc_ata_bio_intr: bad state");
571 1.2 bouyer }
572 1.2 bouyer
573 1.20 bouyer /*
574 1.20 bouyer * if we missed an interrupt in a PIO transfer, reset and restart.
575 1.20 bouyer * Don't try to continue transfer, we may have missed cycles.
576 1.20 bouyer */
577 1.20 bouyer if ((xfer->c_flags & (C_TIMEOU | C_DMA)) == C_TIMEOU) {
578 1.20 bouyer ata_bio->error = TIMEOUT;
579 1.20 bouyer wdc_ata_bio_done(chp, xfer);
580 1.20 bouyer return 1;
581 1.20 bouyer }
582 1.20 bouyer
583 1.49 thorpej /* Ack interrupt done by wdc_wait_for_unbusy */
584 1.49 thorpej if (wdc_wait_for_unbusy(chp, (irq == 0) ? ATA_DELAY : 0, AT_POLL) < 0) {
585 1.19 bouyer if (irq && (xfer->c_flags & C_TIMEOU) == 0)
586 1.18 bouyer return 0; /* IRQ was not for us */
587 1.2 bouyer printf("%s:%d:%d: device timeout, c_bcount=%d, c_skip%d\n",
588 1.51 thorpej wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive,
589 1.2 bouyer xfer->c_bcount, xfer->c_skip);
590 1.2 bouyer ata_bio->error = TIMEOUT;
591 1.2 bouyer wdc_ata_bio_done(chp, xfer);
592 1.2 bouyer return 1;
593 1.2 bouyer }
594 1.51 thorpej if (wdc->cap & WDC_CAPABILITY_IRQACK)
595 1.51 thorpej wdc->irqack(chp);
596 1.2 bouyer
597 1.16 bouyer drv_err = wdc_ata_err(drvp, ata_bio);
598 1.2 bouyer
599 1.2 bouyer /* If we were using DMA, Turn off the DMA channel and check for error */
600 1.2 bouyer if (xfer->c_flags & C_DMA) {
601 1.2 bouyer if (ata_bio->flags & ATA_POLL) {
602 1.2 bouyer /*
603 1.13 bouyer * IDE drives deassert WDCS_BSY before transfer is
604 1.2 bouyer * complete when using DMA. Polling for DRQ to deassert
605 1.37 wiz * is not enough DRQ is not required to be
606 1.7 bouyer * asserted for DMA transfers, so poll for DRDY.
607 1.2 bouyer */
608 1.2 bouyer if (wdcwait(chp, WDCS_DRDY | WDCS_DRQ, WDCS_DRDY,
609 1.41 bouyer ATA_DELAY, ATA_POLL) == WDCWAIT_TOUT) {
610 1.7 bouyer printf("%s:%d:%d: polled transfer timed out "
611 1.51 thorpej "(st=0x%x)\n", wdc->sc_dev.dv_xname,
612 1.51 thorpej chp->ch_channel, xfer->c_drive,
613 1.48 thorpej chp->ch_status);
614 1.2 bouyer ata_bio->error = TIMEOUT;
615 1.10 bouyer drv_err = WDC_ATA_ERR;
616 1.10 bouyer }
617 1.10 bouyer }
618 1.51 thorpej if (wdc->dma_status != 0) {
619 1.10 bouyer if (drv_err != WDC_ATA_ERR) {
620 1.10 bouyer ata_bio->error = ERR_DMA;
621 1.10 bouyer drv_err = WDC_ATA_ERR;
622 1.2 bouyer }
623 1.2 bouyer }
624 1.2 bouyer if (chp->ch_status & WDCS_DRQ) {
625 1.2 bouyer if (drv_err != WDC_ATA_ERR) {
626 1.2 bouyer printf("%s:%d:%d: intr with DRQ (st=0x%x)\n",
627 1.51 thorpej wdc->sc_dev.dv_xname, chp->ch_channel,
628 1.48 thorpej xfer->c_drive, chp->ch_status);
629 1.2 bouyer ata_bio->error = TIMEOUT;
630 1.2 bouyer drv_err = WDC_ATA_ERR;
631 1.2 bouyer }
632 1.2 bouyer }
633 1.55 mycroft if (ata_bio->r_error & WDCE_CRC)
634 1.55 mycroft ata_dmaerr(drvp, (xfer->c_flags & C_POLL) ? AT_POLL : 0);
635 1.2 bouyer if (drv_err != WDC_ATA_ERR)
636 1.2 bouyer goto end;
637 1.2 bouyer }
638 1.2 bouyer
639 1.2 bouyer /* if we had an error, end */
640 1.2 bouyer if (drv_err == WDC_ATA_ERR) {
641 1.2 bouyer wdc_ata_bio_done(chp, xfer);
642 1.2 bouyer return 1;
643 1.2 bouyer }
644 1.2 bouyer
645 1.2 bouyer /* If this was a read and not using DMA, fetch the data. */
646 1.2 bouyer if ((ata_bio->flags & ATA_READ) != 0) {
647 1.14 bouyer if ((chp->ch_status & WDCS_DRQ) != WDCS_DRQ) {
648 1.2 bouyer printf("%s:%d:%d: read intr before drq\n",
649 1.51 thorpej wdc->sc_dev.dv_xname, chp->ch_channel,
650 1.48 thorpej xfer->c_drive);
651 1.2 bouyer ata_bio->error = TIMEOUT;
652 1.2 bouyer wdc_ata_bio_done(chp, xfer);
653 1.2 bouyer return 1;
654 1.2 bouyer }
655 1.63 mycroft wdc->datain_pio(chp, drvp->drive_flags,
656 1.62 mycroft (char *)xfer->c_databuf + xfer->c_skip, ata_bio->nbytes);
657 1.2 bouyer }
658 1.2 bouyer
659 1.2 bouyer end:
660 1.2 bouyer ata_bio->blkno += ata_bio->nblks;
661 1.2 bouyer ata_bio->blkdone += ata_bio->nblks;
662 1.2 bouyer xfer->c_skip += ata_bio->nbytes;
663 1.2 bouyer xfer->c_bcount -= ata_bio->nbytes;
664 1.2 bouyer /* See if this transfer is complete. */
665 1.2 bouyer if (xfer->c_bcount > 0) {
666 1.2 bouyer if ((ata_bio->flags & ATA_POLL) == 0) {
667 1.2 bouyer /* Start the next operation */
668 1.20 bouyer _wdc_ata_bio_start(chp, xfer);
669 1.2 bouyer } else {
670 1.20 bouyer /* Let _wdc_ata_bio_start do the loop */
671 1.2 bouyer return 1;
672 1.2 bouyer }
673 1.2 bouyer } else { /* Done with this transfer */
674 1.2 bouyer ata_bio->error = NOERROR;
675 1.2 bouyer wdc_ata_bio_done(chp, xfer);
676 1.2 bouyer }
677 1.2 bouyer return 1;
678 1.22 enami }
679 1.22 enami
680 1.45 thorpej static void
681 1.58 bouyer wdc_ata_bio_kill_xfer(struct wdc_channel *chp, struct ata_xfer *xfer,
682 1.58 bouyer int reason)
683 1.22 enami {
684 1.48 thorpej struct ata_bio *ata_bio = xfer->c_cmd;
685 1.48 thorpej int drive = xfer->c_drive;
686 1.22 enami
687 1.22 enami wdc_free_xfer(chp, xfer);
688 1.22 enami
689 1.22 enami ata_bio->flags |= ATA_ITSDONE;
690 1.58 bouyer switch (reason) {
691 1.58 bouyer case KILL_GONE:
692 1.58 bouyer ata_bio->error = ERR_NODEV;
693 1.58 bouyer break;
694 1.58 bouyer case KILL_RESET:
695 1.58 bouyer ata_bio->error = ERR_RESET;
696 1.58 bouyer break;
697 1.58 bouyer default:
698 1.58 bouyer printf("wdc_ata_bio_kill_xfer: unknown reason %d\n",
699 1.58 bouyer reason);
700 1.58 bouyer panic("wdc_ata_bio_kill_xfer");
701 1.58 bouyer }
702 1.22 enami ata_bio->r_error = WDCE_ABRT;
703 1.46 thorpej WDCDEBUG_PRINT(("wdc_ata_done: drv_done\n"), DEBUG_XFERS);
704 1.46 thorpej (*chp->ch_drive[drive].drv_done)(chp->ch_drive[drive].drv_softc);
705 1.2 bouyer }
706 1.2 bouyer
707 1.45 thorpej static void
708 1.50 thorpej wdc_ata_bio_done(struct wdc_channel *chp, struct ata_xfer *xfer)
709 1.2 bouyer {
710 1.51 thorpej struct wdc_softc *wdc = chp->ch_wdc;
711 1.48 thorpej struct ata_bio *ata_bio = xfer->c_cmd;
712 1.48 thorpej int drive = xfer->c_drive;
713 1.2 bouyer
714 1.5 bouyer WDCDEBUG_PRINT(("wdc_ata_bio_done %s:%d:%d: flags 0x%x\n",
715 1.51 thorpej wdc->sc_dev.dv_xname, chp->ch_channel, xfer->c_drive,
716 1.5 bouyer (u_int)xfer->c_flags),
717 1.4 bouyer DEBUG_XFERS);
718 1.10 bouyer
719 1.24 thorpej callout_stop(&chp->ch_callout);
720 1.2 bouyer
721 1.2 bouyer /* feed back residual bcount to our caller */
722 1.2 bouyer ata_bio->bcount = xfer->c_bcount;
723 1.2 bouyer
724 1.60 bouyer /* mark controller inactive and free xfer */
725 1.60 bouyer chp->ch_queue->active_xfer = NULL;
726 1.2 bouyer wdc_free_xfer(chp, xfer);
727 1.2 bouyer
728 1.61 bouyer if (chp->ch_drive[drive].drive_flags & DRIVE_WAITDRAIN) {
729 1.61 bouyer ata_bio->error = ERR_NODEV;
730 1.61 bouyer chp->ch_drive[drive].drive_flags &= ~DRIVE_WAITDRAIN;
731 1.61 bouyer wakeup(&chp->ch_queue->active_xfer);
732 1.61 bouyer }
733 1.2 bouyer ata_bio->flags |= ATA_ITSDONE;
734 1.46 thorpej WDCDEBUG_PRINT(("wdc_ata_done: drv_done\n"), DEBUG_XFERS);
735 1.46 thorpej (*chp->ch_drive[drive].drv_done)(chp->ch_drive[drive].drv_softc);
736 1.2 bouyer WDCDEBUG_PRINT(("wdcstart from wdc_ata_done, flags 0x%x\n",
737 1.4 bouyer chp->ch_flags), DEBUG_XFERS);
738 1.9 drochner wdcstart(chp);
739 1.2 bouyer }
740 1.2 bouyer
741 1.45 thorpej static int
742 1.44 thorpej wdc_ata_err(struct ata_drive_datas *drvp, struct ata_bio *ata_bio)
743 1.2 bouyer {
744 1.50 thorpej struct wdc_channel *chp = drvp->chnl_softc;
745 1.2 bouyer ata_bio->error = 0;
746 1.2 bouyer if (chp->ch_status & WDCS_BSY) {
747 1.2 bouyer ata_bio->error = TIMEOUT;
748 1.2 bouyer return WDC_ATA_ERR;
749 1.2 bouyer }
750 1.2 bouyer
751 1.2 bouyer if (chp->ch_status & WDCS_DWF) {
752 1.2 bouyer ata_bio->error = ERR_DF;
753 1.2 bouyer return WDC_ATA_ERR;
754 1.2 bouyer }
755 1.2 bouyer
756 1.2 bouyer if (chp->ch_status & WDCS_ERR) {
757 1.2 bouyer ata_bio->error = ERROR;
758 1.2 bouyer ata_bio->r_error = chp->ch_error;
759 1.2 bouyer if (ata_bio->r_error & (WDCE_BBK | WDCE_UNC | WDCE_IDNF |
760 1.2 bouyer WDCE_ABRT | WDCE_TK0NF | WDCE_AMNF))
761 1.2 bouyer return WDC_ATA_ERR;
762 1.2 bouyer return WDC_ATA_NOERR;
763 1.2 bouyer }
764 1.2 bouyer
765 1.2 bouyer if (chp->ch_status & WDCS_CORR)
766 1.2 bouyer ata_bio->flags |= ATA_CORR;
767 1.2 bouyer return WDC_ATA_NOERR;
768 1.8 thorpej }
769 1.8 thorpej
770 1.45 thorpej static int
771 1.44 thorpej wdc_ata_addref(struct ata_drive_datas *drvp)
772 1.8 thorpej {
773 1.50 thorpej struct wdc_channel *chp = drvp->chnl_softc;
774 1.8 thorpej
775 1.8 thorpej return (wdc_addref(chp));
776 1.8 thorpej }
777 1.8 thorpej
778 1.45 thorpej static void
779 1.44 thorpej wdc_ata_delref(struct ata_drive_datas *drvp)
780 1.8 thorpej {
781 1.50 thorpej struct wdc_channel *chp = drvp->chnl_softc;
782 1.8 thorpej
783 1.8 thorpej wdc_delref(chp);
784 1.2 bouyer }
785