wdc.c revision 1.125 1 1.125 mycroft /* $NetBSD: wdc.c,v 1.125 2003/09/19 21:36:02 mycroft Exp $ */
2 1.31 bouyer
3 1.31 bouyer /*
4 1.104 bouyer * Copyright (c) 1998, 2001 Manuel Bouyer. All rights reserved.
5 1.31 bouyer *
6 1.31 bouyer * Redistribution and use in source and binary forms, with or without
7 1.31 bouyer * modification, are permitted provided that the following conditions
8 1.31 bouyer * are met:
9 1.31 bouyer * 1. Redistributions of source code must retain the above copyright
10 1.31 bouyer * notice, this list of conditions and the following disclaimer.
11 1.31 bouyer * 2. Redistributions in binary form must reproduce the above copyright
12 1.31 bouyer * notice, this list of conditions and the following disclaimer in the
13 1.31 bouyer * documentation and/or other materials provided with the distribution.
14 1.31 bouyer * 3. All advertising materials mentioning features or use of this software
15 1.31 bouyer * must display the following acknowledgement:
16 1.31 bouyer * This product includes software developed by Manuel Bouyer.
17 1.31 bouyer * 4. The name of the author may not be used to endorse or promote products
18 1.31 bouyer * derived from this software without specific prior written permission.
19 1.31 bouyer *
20 1.31 bouyer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 1.31 bouyer * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22 1.31 bouyer * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23 1.31 bouyer * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 1.31 bouyer * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 1.31 bouyer * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 1.31 bouyer * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27 1.31 bouyer * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 1.31 bouyer * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 1.31 bouyer * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 1.31 bouyer */
31 1.2 bouyer
32 1.27 mycroft /*-
33 1.125 mycroft * Copyright (c) 1998, 2003 The NetBSD Foundation, Inc.
34 1.27 mycroft * All rights reserved.
35 1.2 bouyer *
36 1.27 mycroft * This code is derived from software contributed to The NetBSD Foundation
37 1.27 mycroft * by Charles M. Hannum, by Onno van der Linden and by Manuel Bouyer.
38 1.12 cgd *
39 1.2 bouyer * Redistribution and use in source and binary forms, with or without
40 1.2 bouyer * modification, are permitted provided that the following conditions
41 1.2 bouyer * are met:
42 1.2 bouyer * 1. Redistributions of source code must retain the above copyright
43 1.2 bouyer * notice, this list of conditions and the following disclaimer.
44 1.2 bouyer * 2. Redistributions in binary form must reproduce the above copyright
45 1.2 bouyer * notice, this list of conditions and the following disclaimer in the
46 1.2 bouyer * documentation and/or other materials provided with the distribution.
47 1.2 bouyer * 3. All advertising materials mentioning features or use of this software
48 1.2 bouyer * must display the following acknowledgement:
49 1.27 mycroft * This product includes software developed by the NetBSD
50 1.27 mycroft * Foundation, Inc. and its contributors.
51 1.27 mycroft * 4. Neither the name of The NetBSD Foundation nor the names of its
52 1.27 mycroft * contributors may be used to endorse or promote products derived
53 1.27 mycroft * from this software without specific prior written permission.
54 1.2 bouyer *
55 1.27 mycroft * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
56 1.27 mycroft * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
57 1.27 mycroft * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
58 1.27 mycroft * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
59 1.27 mycroft * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
60 1.27 mycroft * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
61 1.27 mycroft * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
62 1.27 mycroft * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
63 1.27 mycroft * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
64 1.27 mycroft * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
65 1.27 mycroft * POSSIBILITY OF SUCH DAMAGE.
66 1.2 bouyer */
67 1.2 bouyer
68 1.12 cgd /*
69 1.12 cgd * CODE UNTESTED IN THE CURRENT REVISION:
70 1.12 cgd */
71 1.100 lukem
72 1.100 lukem #include <sys/cdefs.h>
73 1.125 mycroft __KERNEL_RCSID(0, "$NetBSD: wdc.c,v 1.125 2003/09/19 21:36:02 mycroft Exp $");
74 1.12 cgd
75 1.59 hubertf #ifndef WDCDEBUG
76 1.31 bouyer #define WDCDEBUG
77 1.59 hubertf #endif /* WDCDEBUG */
78 1.31 bouyer
79 1.2 bouyer #include <sys/param.h>
80 1.2 bouyer #include <sys/systm.h>
81 1.2 bouyer #include <sys/kernel.h>
82 1.2 bouyer #include <sys/conf.h>
83 1.2 bouyer #include <sys/buf.h>
84 1.31 bouyer #include <sys/device.h>
85 1.2 bouyer #include <sys/malloc.h>
86 1.71 bouyer #include <sys/pool.h>
87 1.2 bouyer #include <sys/syslog.h>
88 1.2 bouyer #include <sys/proc.h>
89 1.2 bouyer
90 1.2 bouyer #include <machine/intr.h>
91 1.2 bouyer #include <machine/bus.h>
92 1.2 bouyer
93 1.17 sakamoto #ifndef __BUS_SPACE_HAS_STREAM_METHODS
94 1.31 bouyer #define bus_space_write_multi_stream_2 bus_space_write_multi_2
95 1.31 bouyer #define bus_space_write_multi_stream_4 bus_space_write_multi_4
96 1.31 bouyer #define bus_space_read_multi_stream_2 bus_space_read_multi_2
97 1.31 bouyer #define bus_space_read_multi_stream_4 bus_space_read_multi_4
98 1.17 sakamoto #endif /* __BUS_SPACE_HAS_STREAM_METHODS */
99 1.16 sakamoto
100 1.103 bouyer #include <dev/ata/atavar.h>
101 1.102 bouyer #include <dev/ata/wdvar.h>
102 1.31 bouyer #include <dev/ata/atareg.h>
103 1.12 cgd #include <dev/ic/wdcreg.h>
104 1.12 cgd #include <dev/ic/wdcvar.h>
105 1.31 bouyer
106 1.122 thorpej #include "ataraid.h"
107 1.2 bouyer #include "atapibus.h"
108 1.106 bouyer #include "wd.h"
109 1.2 bouyer
110 1.122 thorpej #if NATARAID > 0
111 1.122 thorpej #include <dev/ata/ata_raidvar.h>
112 1.122 thorpej #endif
113 1.122 thorpej
114 1.31 bouyer #define WDCDELAY 100 /* 100 microseconds */
115 1.31 bouyer #define WDCNDELAY_RST (WDC_RESET_WAIT * 1000 / WDCDELAY)
116 1.2 bouyer #if 0
117 1.31 bouyer /* If you enable this, it will report any delays more than WDCDELAY * N long. */
118 1.2 bouyer #define WDCNDELAY_DEBUG 50
119 1.2 bouyer #endif
120 1.2 bouyer
121 1.71 bouyer struct pool wdc_xfer_pool;
122 1.2 bouyer
123 1.106 bouyer #if NWD > 0
124 1.103 bouyer extern const struct ata_bustype wdc_ata_bustype; /* in ata_wdc.c */
125 1.106 bouyer #else
126 1.106 bouyer /* A fake one, the autoconfig will print "wd at foo ... not configured */
127 1.106 bouyer const struct ata_bustype wdc_ata_bustype = {
128 1.106 bouyer SCSIPI_BUSTYPE_ATA,
129 1.106 bouyer NULL,
130 1.106 bouyer NULL,
131 1.106 bouyer NULL,
132 1.106 bouyer NULL,
133 1.106 bouyer NULL,
134 1.106 bouyer NULL,
135 1.106 bouyer NULL
136 1.106 bouyer };
137 1.106 bouyer #endif
138 1.102 bouyer
139 1.31 bouyer static void __wdcerror __P((struct channel_softc*, char *));
140 1.31 bouyer static int __wdcwait_reset __P((struct channel_softc *, int));
141 1.31 bouyer void __wdccommand_done __P((struct channel_softc *, struct wdc_xfer *));
142 1.31 bouyer void __wdccommand_start __P((struct channel_softc *, struct wdc_xfer *));
143 1.66 bouyer int __wdccommand_intr __P((struct channel_softc *, struct wdc_xfer *, int));
144 1.31 bouyer int wdprint __P((void *, const char *));
145 1.125 mycroft void wdc_channel_attach __P((struct channel_softc *));
146 1.31 bouyer
147 1.31 bouyer #define DEBUG_INTR 0x01
148 1.31 bouyer #define DEBUG_XFERS 0x02
149 1.31 bouyer #define DEBUG_STATUS 0x04
150 1.31 bouyer #define DEBUG_FUNCS 0x08
151 1.31 bouyer #define DEBUG_PROBE 0x10
152 1.74 enami #define DEBUG_DETACH 0x20
153 1.87 bouyer #define DEBUG_DELAY 0x40
154 1.31 bouyer #ifdef WDCDEBUG
155 1.32 bouyer int wdcdebug_mask = 0;
156 1.31 bouyer int wdc_nxfer = 0;
157 1.31 bouyer #define WDCDEBUG_PRINT(args, level) if (wdcdebug_mask & (level)) printf args
158 1.2 bouyer #else
159 1.31 bouyer #define WDCDEBUG_PRINT(args, level)
160 1.2 bouyer #endif
161 1.2 bouyer
162 1.31 bouyer int
163 1.31 bouyer wdprint(aux, pnp)
164 1.31 bouyer void *aux;
165 1.31 bouyer const char *pnp;
166 1.31 bouyer {
167 1.102 bouyer struct ata_device *adev = aux;
168 1.31 bouyer if (pnp)
169 1.120 thorpej aprint_normal("wd at %s", pnp);
170 1.120 thorpej aprint_normal(" channel %d drive %d", adev->adev_channel,
171 1.102 bouyer adev->adev_drv_data->drive);
172 1.31 bouyer return (UNCONF);
173 1.31 bouyer }
174 1.31 bouyer
175 1.31 bouyer /* Test to see controller with at last one attached drive is there.
176 1.31 bouyer * Returns a bit for each possible drive found (0x01 for drive 0,
177 1.31 bouyer * 0x02 for drive 1).
178 1.31 bouyer * Logic:
179 1.31 bouyer * - If a status register is at 0xff, assume there is no drive here
180 1.97 bjh21 * (ISA has pull-up resistors). Similarly if the status register has
181 1.97 bjh21 * the value we last wrote to the bus (for IDE interfaces without pullups).
182 1.97 bjh21 * If no drive at all -> return.
183 1.31 bouyer * - reset the controller, wait for it to complete (may take up to 31s !).
184 1.31 bouyer * If timeout -> return.
185 1.31 bouyer * - test ATA/ATAPI signatures. If at last one drive found -> return.
186 1.31 bouyer * - try an ATA command on the master.
187 1.12 cgd */
188 1.31 bouyer
189 1.2 bouyer int
190 1.31 bouyer wdcprobe(chp)
191 1.31 bouyer struct channel_softc *chp;
192 1.12 cgd {
193 1.31 bouyer u_int8_t st0, st1, sc, sn, cl, ch;
194 1.31 bouyer u_int8_t ret_value = 0x03;
195 1.31 bouyer u_int8_t drive;
196 1.31 bouyer
197 1.31 bouyer /*
198 1.31 bouyer * Sanity check to see if the wdc channel responds at all.
199 1.31 bouyer */
200 1.31 bouyer
201 1.43 kenh if (chp->wdc == NULL ||
202 1.43 kenh (chp->wdc->cap & WDC_CAPABILITY_NO_EXTRA_RESETS) == 0) {
203 1.107 dbj
204 1.107 dbj if (chp->wdc && (chp->wdc->cap & WDC_CAPABILITY_SELECT))
205 1.107 dbj chp->wdc->select(chp,0);
206 1.43 kenh bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
207 1.43 kenh WDSD_IBM);
208 1.65 bouyer delay(10);
209 1.43 kenh st0 = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_status);
210 1.107 dbj
211 1.107 dbj if (chp->wdc && (chp->wdc->cap & WDC_CAPABILITY_SELECT))
212 1.107 dbj chp->wdc->select(chp,1);
213 1.43 kenh bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
214 1.43 kenh WDSD_IBM | 0x10);
215 1.65 bouyer delay(10);
216 1.43 kenh st1 = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_status);
217 1.43 kenh
218 1.43 kenh WDCDEBUG_PRINT(("%s:%d: before reset, st0=0x%x, st1=0x%x\n",
219 1.43 kenh chp->wdc ? chp->wdc->sc_dev.dv_xname : "wdcprobe",
220 1.43 kenh chp->channel, st0, st1), DEBUG_PROBE);
221 1.43 kenh
222 1.125 mycroft if ((st0 & 0x7f) == 0x7f || st0 == WDSD_IBM)
223 1.43 kenh ret_value &= ~0x01;
224 1.125 mycroft if ((st1 & 0x7f) == 0x7f || st1 == (WDSD_IBM | 0x10))
225 1.43 kenh ret_value &= ~0x02;
226 1.125 mycroft
227 1.125 mycroft /* Register writability test, drive 0. */
228 1.125 mycroft if (ret_value & 0x01) {
229 1.125 mycroft if (chp->wdc && (chp->wdc->cap & WDC_CAPABILITY_SELECT))
230 1.125 mycroft chp->wdc->select(chp,0);
231 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
232 1.125 mycroft WDSD_IBM);
233 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_lo,
234 1.125 mycroft 0x01);
235 1.125 mycroft if (bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
236 1.125 mycroft wd_cyl_lo) != 0x01)
237 1.125 mycroft ret_value &= ~0x01;
238 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_lo,
239 1.125 mycroft 0x02);
240 1.125 mycroft if (bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
241 1.125 mycroft wd_cyl_lo) != 0x02)
242 1.125 mycroft ret_value &= ~0x01;
243 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sector,
244 1.125 mycroft 0x01);
245 1.125 mycroft if (bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
246 1.125 mycroft wd_sector) != 0x01)
247 1.125 mycroft ret_value &= ~0x01;
248 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sector,
249 1.125 mycroft 0x02);
250 1.125 mycroft if (bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
251 1.125 mycroft wd_sector) != 0x02)
252 1.125 mycroft ret_value &= ~0x01;
253 1.125 mycroft }
254 1.125 mycroft
255 1.125 mycroft /* Register writability test, drive 1. */
256 1.125 mycroft if (ret_value & 0x02) {
257 1.125 mycroft if (chp->wdc && (chp->wdc->cap & WDC_CAPABILITY_SELECT))
258 1.125 mycroft chp->wdc->select(chp,1);
259 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
260 1.125 mycroft WDSD_IBM | 0x10);
261 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_lo,
262 1.125 mycroft 0x01);
263 1.125 mycroft if (bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
264 1.125 mycroft wd_cyl_lo) != 0x01)
265 1.125 mycroft ret_value &= ~0x02;
266 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_lo,
267 1.125 mycroft 0x02);
268 1.125 mycroft if (bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
269 1.125 mycroft wd_cyl_lo) != 0x02)
270 1.125 mycroft ret_value &= ~0x02;
271 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sector,
272 1.125 mycroft 0x01);
273 1.125 mycroft if (bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
274 1.125 mycroft wd_sector) != 0x01)
275 1.125 mycroft ret_value &= ~0x02;
276 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sector,
277 1.125 mycroft 0x02);
278 1.125 mycroft if (bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
279 1.125 mycroft wd_sector) != 0x02)
280 1.125 mycroft ret_value &= ~0x02;
281 1.125 mycroft }
282 1.125 mycroft
283 1.125 mycroft /* Register ghost test. */
284 1.125 mycroft if (ret_value == 0x03) {
285 1.125 mycroft if (chp->wdc && (chp->wdc->cap & WDC_CAPABILITY_SELECT))
286 1.125 mycroft chp->wdc->select(chp,1);
287 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
288 1.125 mycroft WDSD_IBM | 0x10);
289 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sector, 0x01);
290 1.125 mycroft if (chp->wdc && (chp->wdc->cap & WDC_CAPABILITY_SELECT))
291 1.125 mycroft chp->wdc->select(chp,0);
292 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
293 1.125 mycroft WDSD_IBM);
294 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sector, 0x02);
295 1.125 mycroft if (chp->wdc && (chp->wdc->cap & WDC_CAPABILITY_SELECT))
296 1.125 mycroft chp->wdc->select(chp,1);
297 1.125 mycroft bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
298 1.125 mycroft WDSD_IBM | 0x10);
299 1.125 mycroft if (bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_sector) == 0x02) {
300 1.125 mycroft printf("ghost detected\n");
301 1.125 mycroft ret_value = 0x01;
302 1.125 mycroft }
303 1.125 mycroft }
304 1.125 mycroft
305 1.43 kenh if (ret_value == 0)
306 1.43 kenh return 0;
307 1.125 mycroft
308 1.43 kenh }
309 1.42 thorpej
310 1.107 dbj if (chp->wdc && (chp->wdc->cap & WDC_CAPABILITY_SELECT))
311 1.107 dbj chp->wdc->select(chp,0);
312 1.31 bouyer /* assert SRST, wait for reset to complete */
313 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
314 1.31 bouyer WDSD_IBM);
315 1.65 bouyer delay(10);
316 1.31 bouyer bus_space_write_1(chp->ctl_iot, chp->ctl_ioh, wd_aux_ctlr,
317 1.31 bouyer WDCTL_RST | WDCTL_IDS);
318 1.31 bouyer DELAY(1000);
319 1.31 bouyer bus_space_write_1(chp->ctl_iot, chp->ctl_ioh, wd_aux_ctlr,
320 1.31 bouyer WDCTL_IDS);
321 1.31 bouyer delay(1000);
322 1.31 bouyer (void) bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_error);
323 1.31 bouyer bus_space_write_1(chp->ctl_iot, chp->ctl_ioh, wd_aux_ctlr, WDCTL_4BIT);
324 1.65 bouyer delay(10);
325 1.31 bouyer
326 1.31 bouyer ret_value = __wdcwait_reset(chp, ret_value);
327 1.31 bouyer WDCDEBUG_PRINT(("%s:%d: after reset, ret_value=0x%d\n",
328 1.31 bouyer chp->wdc ? chp->wdc->sc_dev.dv_xname : "wdcprobe", chp->channel,
329 1.31 bouyer ret_value), DEBUG_PROBE);
330 1.26 drochner
331 1.31 bouyer /* if reset failed, there's nothing here */
332 1.31 bouyer if (ret_value == 0)
333 1.31 bouyer return 0;
334 1.2 bouyer
335 1.31 bouyer /*
336 1.31 bouyer * Test presence of drives. First test register signatures looking for
337 1.67 bouyer * ATAPI devices. If it's not an ATAPI and reset said there may be
338 1.67 bouyer * something here assume it's ATA or OLD. Ghost will be killed later in
339 1.67 bouyer * attach routine.
340 1.31 bouyer */
341 1.31 bouyer for (drive = 0; drive < 2; drive++) {
342 1.31 bouyer if ((ret_value & (0x01 << drive)) == 0)
343 1.31 bouyer continue;
344 1.109 bouyer if (chp->wdc && chp->wdc->cap & WDC_CAPABILITY_SELECT)
345 1.107 dbj chp->wdc->select(chp,drive);
346 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
347 1.31 bouyer WDSD_IBM | (drive << 4));
348 1.65 bouyer delay(10);
349 1.31 bouyer /* Save registers contents */
350 1.31 bouyer sc = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_seccnt);
351 1.31 bouyer sn = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_sector);
352 1.31 bouyer cl = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_lo);
353 1.31 bouyer ch = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_hi);
354 1.31 bouyer
355 1.31 bouyer WDCDEBUG_PRINT(("%s:%d:%d: after reset, sc=0x%x sn=0x%x "
356 1.31 bouyer "cl=0x%x ch=0x%x\n",
357 1.31 bouyer chp->wdc ? chp->wdc->sc_dev.dv_xname : "wdcprobe",
358 1.31 bouyer chp->channel, drive, sc, sn, cl, ch), DEBUG_PROBE);
359 1.57 bouyer /*
360 1.90 bouyer * sc & sn are supposted to be 0x1 for ATAPI but in some cases
361 1.90 bouyer * we get wrong values here, so ignore it.
362 1.57 bouyer */
363 1.90 bouyer if (cl == 0x14 && ch == 0xeb) {
364 1.31 bouyer chp->ch_drive[drive].drive_flags |= DRIVE_ATAPI;
365 1.67 bouyer } else {
366 1.62 bouyer chp->ch_drive[drive].drive_flags |= DRIVE_ATA;
367 1.67 bouyer if (chp->wdc == NULL ||
368 1.67 bouyer (chp->wdc->cap & WDC_CAPABILITY_PREATA) != 0)
369 1.67 bouyer chp->ch_drive[drive].drive_flags |= DRIVE_OLD;
370 1.2 bouyer }
371 1.7 bouyer }
372 1.31 bouyer return (ret_value);
373 1.31 bouyer }
374 1.31 bouyer
375 1.31 bouyer void
376 1.125 mycroft wdcattach(self)
377 1.125 mycroft struct device *self;
378 1.125 mycroft {
379 1.125 mycroft struct wdc_softc *wdc = (void *)self;
380 1.125 mycroft int i;
381 1.125 mycroft
382 1.125 mycroft for (i = 0; i < wdc->nchannels; i++)
383 1.125 mycroft wdc_channel_attach(wdc->channels[i]);
384 1.125 mycroft }
385 1.125 mycroft
386 1.125 mycroft void
387 1.125 mycroft wdc_channel_attach(chp)
388 1.31 bouyer struct channel_softc *chp;
389 1.31 bouyer {
390 1.121 simonb int ctrl_flags, i, error;
391 1.62 bouyer struct ataparams params;
392 1.62 bouyer static int inited = 0;
393 1.31 bouyer
394 1.125 mycroft if (chp->ch_flags & WDCF_DISABLED)
395 1.125 mycroft return;
396 1.125 mycroft
397 1.81 thorpej callout_init(&chp->ch_callout);
398 1.81 thorpej
399 1.44 thorpej if ((error = wdc_addref(chp)) != 0) {
400 1.123 thorpej aprint_error("%s: unable to enable controller\n",
401 1.44 thorpej chp->wdc->sc_dev.dv_xname);
402 1.44 thorpej return;
403 1.44 thorpej }
404 1.44 thorpej
405 1.74 enami if (wdcprobe(chp) == 0)
406 1.44 thorpej /* If no drives, abort attach here. */
407 1.74 enami goto out;
408 1.31 bouyer
409 1.71 bouyer /* initialise global data */
410 1.62 bouyer if (inited == 0) {
411 1.71 bouyer /* Initialize the wdc_xfer pool. */
412 1.71 bouyer pool_init(&wdc_xfer_pool, sizeof(struct wdc_xfer), 0,
413 1.112 thorpej 0, 0, "wdcspl", NULL);
414 1.62 bouyer inited++;
415 1.62 bouyer }
416 1.31 bouyer TAILQ_INIT(&chp->ch_queue->sc_xfer);
417 1.62 bouyer
418 1.62 bouyer for (i = 0; i < 2; i++) {
419 1.62 bouyer chp->ch_drive[i].chnl_softc = chp;
420 1.62 bouyer chp->ch_drive[i].drive = i;
421 1.78 bouyer /*
422 1.78 bouyer * Init error counter so that an error withing the first xfers
423 1.78 bouyer * will trigger a downgrade
424 1.78 bouyer */
425 1.78 bouyer chp->ch_drive[i].n_dmaerrs = NERRS_MAX-1;
426 1.78 bouyer
427 1.62 bouyer /* If controller can't do 16bit flag the drives as 32bit */
428 1.62 bouyer if ((chp->wdc->cap &
429 1.62 bouyer (WDC_CAPABILITY_DATA16 | WDC_CAPABILITY_DATA32)) ==
430 1.62 bouyer WDC_CAPABILITY_DATA32)
431 1.62 bouyer chp->ch_drive[i].drive_flags |= DRIVE_CAP32;
432 1.67 bouyer if ((chp->ch_drive[i].drive_flags & DRIVE) == 0)
433 1.67 bouyer continue;
434 1.62 bouyer
435 1.79 bouyer /*
436 1.79 bouyer * Wait a bit, some devices are weird just after a reset.
437 1.79 bouyer * Then issue a IDENTIFY command, to try to detect slave ghost
438 1.79 bouyer */
439 1.115 bouyer delay(5000);
440 1.125 mycroft error = ata_get_params(&chp->ch_drive[i], AT_WAIT, ¶ms);
441 1.86 bouyer if (error != CMD_OK) {
442 1.86 bouyer delay(1000000);
443 1.125 mycroft error = ata_get_params(&chp->ch_drive[i], AT_WAIT,
444 1.86 bouyer ¶ms);
445 1.86 bouyer }
446 1.77 bouyer if (error == CMD_OK) {
447 1.67 bouyer /* If IDENTIFY succeded, this is not an OLD ctrl */
448 1.67 bouyer chp->ch_drive[0].drive_flags &= ~DRIVE_OLD;
449 1.67 bouyer chp->ch_drive[1].drive_flags &= ~DRIVE_OLD;
450 1.67 bouyer } else {
451 1.62 bouyer chp->ch_drive[i].drive_flags &=
452 1.62 bouyer ~(DRIVE_ATA | DRIVE_ATAPI);
453 1.77 bouyer WDCDEBUG_PRINT(("%s:%d:%d: IDENTIFY failed (%d)\n",
454 1.67 bouyer chp->wdc->sc_dev.dv_xname,
455 1.77 bouyer chp->channel, i, error), DEBUG_PROBE);
456 1.67 bouyer if ((chp->ch_drive[i].drive_flags & DRIVE_OLD) == 0)
457 1.67 bouyer continue;
458 1.68 bouyer /*
459 1.68 bouyer * Pre-ATA drive ?
460 1.68 bouyer * Test registers writability (Error register not
461 1.68 bouyer * writable, but cyllo is), then try an ATA command.
462 1.68 bouyer */
463 1.107 dbj if (chp->wdc->cap & WDC_CAPABILITY_SELECT)
464 1.107 dbj chp->wdc->select(chp,i);
465 1.68 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
466 1.68 bouyer WDSD_IBM | (i << 4));
467 1.68 bouyer delay(10);
468 1.68 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh,
469 1.68 bouyer wd_error, 0x58);
470 1.68 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh,
471 1.68 bouyer wd_cyl_lo, 0xa5);
472 1.68 bouyer if (bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
473 1.68 bouyer wd_error == 0x58) ||
474 1.68 bouyer bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
475 1.68 bouyer wd_cyl_lo) != 0xa5) {
476 1.68 bouyer WDCDEBUG_PRINT(("%s:%d:%d: register "
477 1.68 bouyer "writability failed\n",
478 1.68 bouyer chp->wdc->sc_dev.dv_xname,
479 1.68 bouyer chp->channel, i), DEBUG_PROBE);
480 1.68 bouyer chp->ch_drive[i].drive_flags &= ~DRIVE_OLD;
481 1.68 bouyer }
482 1.107 dbj if (chp->wdc->cap & WDC_CAPABILITY_SELECT)
483 1.107 dbj chp->wdc->select(chp,i);
484 1.67 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
485 1.67 bouyer WDSD_IBM | (i << 4));
486 1.67 bouyer delay(100);
487 1.67 bouyer if (wait_for_ready(chp, 10000) != 0) {
488 1.67 bouyer WDCDEBUG_PRINT(("%s:%d:%d: not ready\n",
489 1.67 bouyer chp->wdc->sc_dev.dv_xname,
490 1.67 bouyer chp->channel, i), DEBUG_PROBE);
491 1.67 bouyer chp->ch_drive[i].drive_flags &= ~DRIVE_OLD;
492 1.67 bouyer continue;
493 1.67 bouyer }
494 1.67 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh,
495 1.67 bouyer wd_command, WDCC_RECAL);
496 1.67 bouyer if (wait_for_ready(chp, 10000) != 0) {
497 1.67 bouyer WDCDEBUG_PRINT(("%s:%d:%d: WDCC_RECAL failed\n",
498 1.67 bouyer chp->wdc->sc_dev.dv_xname,
499 1.67 bouyer chp->channel, i), DEBUG_PROBE);
500 1.67 bouyer chp->ch_drive[i].drive_flags &= ~DRIVE_OLD;
501 1.67 bouyer }
502 1.62 bouyer }
503 1.62 bouyer }
504 1.31 bouyer ctrl_flags = chp->wdc->sc_dev.dv_cfdata->cf_flags;
505 1.31 bouyer
506 1.31 bouyer WDCDEBUG_PRINT(("wdcattach: ch_drive_flags 0x%x 0x%x\n",
507 1.31 bouyer chp->ch_drive[0].drive_flags, chp->ch_drive[1].drive_flags),
508 1.31 bouyer DEBUG_PROBE);
509 1.12 cgd
510 1.67 bouyer /* If no drives, abort here */
511 1.67 bouyer if ((chp->ch_drive[0].drive_flags & DRIVE) == 0 &&
512 1.67 bouyer (chp->ch_drive[1].drive_flags & DRIVE) == 0)
513 1.74 enami goto out;
514 1.67 bouyer
515 1.12 cgd /*
516 1.31 bouyer * Attach an ATAPI bus, if needed.
517 1.12 cgd */
518 1.31 bouyer if ((chp->ch_drive[0].drive_flags & DRIVE_ATAPI) ||
519 1.31 bouyer (chp->ch_drive[1].drive_flags & DRIVE_ATAPI)) {
520 1.31 bouyer #if NATAPIBUS > 0
521 1.31 bouyer wdc_atapibus_attach(chp);
522 1.31 bouyer #else
523 1.31 bouyer /*
524 1.102 bouyer * Fake the autoconfig "not configured" message
525 1.31 bouyer */
526 1.123 thorpej aprint_normal("atapibus at %s channel %d not configured\n",
527 1.102 bouyer chp->wdc->sc_dev.dv_xname, chp->channel);
528 1.102 bouyer chp->atapibus = NULL;
529 1.31 bouyer #endif
530 1.31 bouyer }
531 1.31 bouyer
532 1.31 bouyer for (i = 0; i < 2; i++) {
533 1.102 bouyer struct ata_device adev;
534 1.67 bouyer if ((chp->ch_drive[i].drive_flags &
535 1.67 bouyer (DRIVE_ATA | DRIVE_OLD)) == 0) {
536 1.31 bouyer continue;
537 1.31 bouyer }
538 1.102 bouyer memset(&adev, 0, sizeof(struct ata_device));
539 1.102 bouyer adev.adev_bustype = &wdc_ata_bustype;
540 1.102 bouyer adev.adev_channel = chp->channel;
541 1.102 bouyer adev.adev_openings = 1;
542 1.102 bouyer adev.adev_drv_data = &chp->ch_drive[i];
543 1.122 thorpej chp->ata_drives[i] = config_found(&chp->wdc->sc_dev,
544 1.122 thorpej &adev, wdprint);
545 1.122 thorpej if (chp->ata_drives[i] != NULL) {
546 1.31 bouyer wdc_probe_caps(&chp->ch_drive[i]);
547 1.122 thorpej #if NATARAID > 0
548 1.122 thorpej if (chp->wdc->cap & WDC_CAPABILITY_RAID)
549 1.122 thorpej config_interrupts(chp->ata_drives[i],
550 1.122 thorpej ata_raid_check_component);
551 1.122 thorpej #endif /* NATARAID > 0 */
552 1.122 thorpej }
553 1.32 bouyer }
554 1.32 bouyer
555 1.32 bouyer /*
556 1.32 bouyer * reset drive_flags for unnatached devices, reset state for attached
557 1.32 bouyer * ones
558 1.32 bouyer */
559 1.32 bouyer for (i = 0; i < 2; i++) {
560 1.32 bouyer if (chp->ch_drive[i].drv_softc == NULL)
561 1.32 bouyer chp->ch_drive[i].drive_flags = 0;
562 1.32 bouyer else
563 1.32 bouyer chp->ch_drive[i].state = 0;
564 1.2 bouyer }
565 1.12 cgd
566 1.12 cgd /*
567 1.31 bouyer * Reset channel. The probe, with some combinations of ATA/ATAPI
568 1.31 bouyer * devices keep it in a mostly working, but strange state (with busy
569 1.31 bouyer * led on)
570 1.12 cgd */
571 1.31 bouyer if ((chp->wdc->cap & WDC_CAPABILITY_NO_EXTRA_RESETS) == 0) {
572 1.95 bouyer delay(50);
573 1.31 bouyer wdcreset(chp, VERBOSE);
574 1.31 bouyer /*
575 1.31 bouyer * Read status registers to avoid spurious interrupts.
576 1.31 bouyer */
577 1.31 bouyer for (i = 1; i >= 0; i--) {
578 1.31 bouyer if (chp->ch_drive[i].drive_flags & DRIVE) {
579 1.107 dbj if (chp->wdc->cap & WDC_CAPABILITY_SELECT)
580 1.107 dbj chp->wdc->select(chp,i);
581 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh,
582 1.31 bouyer wd_sdh, WDSD_IBM | (i << 4));
583 1.31 bouyer if (wait_for_unbusy(chp, 10000) < 0)
584 1.123 thorpej aprint_error("%s:%d:%d: device busy\n",
585 1.31 bouyer chp->wdc->sc_dev.dv_xname,
586 1.31 bouyer chp->channel, i);
587 1.31 bouyer }
588 1.31 bouyer }
589 1.31 bouyer }
590 1.74 enami
591 1.125 mycroft if (chp->wdc->cap & WDC_CAPABILITY_MODE)
592 1.125 mycroft chp->wdc->set_modes(chp);
593 1.125 mycroft wdc_print_modes(chp);
594 1.125 mycroft
595 1.74 enami out:
596 1.44 thorpej wdc_delref(chp);
597 1.74 enami }
598 1.74 enami
599 1.74 enami /*
600 1.74 enami * Call activate routine of underlying devices.
601 1.74 enami */
602 1.74 enami int
603 1.74 enami wdcactivate(self, act)
604 1.74 enami struct device *self;
605 1.74 enami enum devact act;
606 1.74 enami {
607 1.74 enami struct wdc_softc *wdc = (struct wdc_softc *)self;
608 1.74 enami struct channel_softc *chp;
609 1.88 mrg struct device *sc = 0;
610 1.74 enami int s, i, j, error = 0;
611 1.74 enami
612 1.74 enami s = splbio();
613 1.74 enami switch (act) {
614 1.74 enami case DVACT_ACTIVATE:
615 1.74 enami error = EOPNOTSUPP;
616 1.74 enami break;
617 1.74 enami
618 1.74 enami case DVACT_DEACTIVATE:
619 1.74 enami for (i = 0; i < wdc->nchannels; i++) {
620 1.74 enami chp = wdc->channels[i];
621 1.74 enami
622 1.74 enami /*
623 1.74 enami * We might call deactivate routine for
624 1.74 enami * the children of atapibus twice (once via
625 1.74 enami * atapibus, once directly), but since
626 1.74 enami * config_deactivate maintains DVF_ACTIVE flag,
627 1.74 enami * it's safe.
628 1.74 enami */
629 1.74 enami sc = chp->atapibus;
630 1.74 enami if (sc != NULL) {
631 1.74 enami error = config_deactivate(sc);
632 1.74 enami if (error != 0)
633 1.74 enami goto out;
634 1.74 enami }
635 1.74 enami
636 1.74 enami for (j = 0; j < 2; j++) {
637 1.74 enami sc = chp->ch_drive[j].drv_softc;
638 1.74 enami WDCDEBUG_PRINT(("wdcactivate: %s:"
639 1.74 enami " deactivating %s\n", wdc->sc_dev.dv_xname,
640 1.74 enami sc == NULL ? "nodrv" : sc->dv_xname),
641 1.74 enami DEBUG_DETACH);
642 1.74 enami if (sc != NULL) {
643 1.74 enami error = config_deactivate(sc);
644 1.74 enami if (error != 0)
645 1.74 enami goto out;
646 1.74 enami }
647 1.74 enami }
648 1.74 enami }
649 1.74 enami break;
650 1.74 enami }
651 1.74 enami
652 1.74 enami out:
653 1.74 enami splx(s);
654 1.74 enami
655 1.74 enami #ifdef WDCDEBUG
656 1.88 mrg if (sc && error != 0)
657 1.74 enami WDCDEBUG_PRINT(("wdcactivate: %s: error %d deactivating %s\n",
658 1.74 enami wdc->sc_dev.dv_xname, error, sc->dv_xname), DEBUG_DETACH);
659 1.74 enami #endif
660 1.74 enami return (error);
661 1.74 enami }
662 1.74 enami
663 1.74 enami int
664 1.74 enami wdcdetach(self, flags)
665 1.74 enami struct device *self;
666 1.74 enami int flags;
667 1.74 enami {
668 1.74 enami struct wdc_softc *wdc = (struct wdc_softc *)self;
669 1.74 enami struct channel_softc *chp;
670 1.88 mrg struct device *sc = 0;
671 1.74 enami int i, j, error = 0;
672 1.74 enami
673 1.74 enami for (i = 0; i < wdc->nchannels; i++) {
674 1.74 enami chp = wdc->channels[i];
675 1.74 enami
676 1.74 enami /*
677 1.74 enami * Detach atapibus and its children.
678 1.74 enami */
679 1.74 enami sc = chp->atapibus;
680 1.74 enami if (sc != NULL) {
681 1.74 enami WDCDEBUG_PRINT(("wdcdetach: %s: detaching %s\n",
682 1.74 enami wdc->sc_dev.dv_xname, sc->dv_xname), DEBUG_DETACH);
683 1.74 enami error = config_detach(sc, flags);
684 1.74 enami if (error != 0)
685 1.74 enami goto out;
686 1.74 enami }
687 1.74 enami
688 1.74 enami /*
689 1.74 enami * Detach our other children.
690 1.74 enami */
691 1.74 enami for (j = 0; j < 2; j++) {
692 1.102 bouyer if (chp->ch_drive[j].drive_flags & DRIVE_ATAPI)
693 1.102 bouyer continue;
694 1.74 enami sc = chp->ch_drive[j].drv_softc;
695 1.74 enami WDCDEBUG_PRINT(("wdcdetach: %s: detaching %s\n",
696 1.74 enami wdc->sc_dev.dv_xname,
697 1.74 enami sc == NULL ? "nodrv" : sc->dv_xname),
698 1.74 enami DEBUG_DETACH);
699 1.74 enami if (sc != NULL) {
700 1.74 enami error = config_detach(sc, flags);
701 1.74 enami if (error != 0)
702 1.74 enami goto out;
703 1.74 enami }
704 1.74 enami }
705 1.75 enami
706 1.75 enami wdc_kill_pending(chp);
707 1.74 enami }
708 1.74 enami
709 1.74 enami out:
710 1.74 enami #ifdef WDCDEBUG
711 1.88 mrg if (sc && error != 0)
712 1.74 enami WDCDEBUG_PRINT(("wdcdetach: %s: error %d detaching %s\n",
713 1.74 enami wdc->sc_dev.dv_xname, error, sc->dv_xname), DEBUG_DETACH);
714 1.74 enami #endif
715 1.74 enami return (error);
716 1.31 bouyer }
717 1.31 bouyer
718 1.31 bouyer /*
719 1.31 bouyer * Start I/O on a controller, for the given channel.
720 1.31 bouyer * The first xfer may be not for our channel if the channel queues
721 1.31 bouyer * are shared.
722 1.31 bouyer */
723 1.31 bouyer void
724 1.45 drochner wdcstart(chp)
725 1.45 drochner struct channel_softc *chp;
726 1.31 bouyer {
727 1.31 bouyer struct wdc_xfer *xfer;
728 1.38 bouyer
729 1.38 bouyer #ifdef WDC_DIAGNOSTIC
730 1.38 bouyer int spl1, spl2;
731 1.38 bouyer
732 1.38 bouyer spl1 = splbio();
733 1.38 bouyer spl2 = splbio();
734 1.38 bouyer if (spl2 != spl1) {
735 1.38 bouyer printf("wdcstart: not at splbio()\n");
736 1.38 bouyer panic("wdcstart");
737 1.38 bouyer }
738 1.38 bouyer splx(spl2);
739 1.38 bouyer splx(spl1);
740 1.38 bouyer #endif /* WDC_DIAGNOSTIC */
741 1.12 cgd
742 1.31 bouyer /* is there a xfer ? */
743 1.45 drochner if ((xfer = chp->ch_queue->sc_xfer.tqh_first) == NULL)
744 1.31 bouyer return;
745 1.47 bouyer
746 1.47 bouyer /* adjust chp, in case we have a shared queue */
747 1.49 bouyer chp = xfer->chp;
748 1.47 bouyer
749 1.31 bouyer if ((chp->ch_flags & WDCF_ACTIVE) != 0 ) {
750 1.31 bouyer return; /* channel aleady active */
751 1.31 bouyer }
752 1.31 bouyer #ifdef DIAGNOSTIC
753 1.31 bouyer if ((chp->ch_flags & WDCF_IRQ_WAIT) != 0)
754 1.118 provos panic("wdcstart: channel waiting for irq");
755 1.31 bouyer #endif
756 1.45 drochner if (chp->wdc->cap & WDC_CAPABILITY_HWLOCK)
757 1.45 drochner if (!(*chp->wdc->claim_hw)(chp, 0))
758 1.31 bouyer return;
759 1.12 cgd
760 1.31 bouyer WDCDEBUG_PRINT(("wdcstart: xfer %p channel %d drive %d\n", xfer,
761 1.49 bouyer chp->channel, xfer->drive), DEBUG_XFERS);
762 1.31 bouyer chp->ch_flags |= WDCF_ACTIVE;
763 1.37 bouyer if (chp->ch_drive[xfer->drive].drive_flags & DRIVE_RESET) {
764 1.37 bouyer chp->ch_drive[xfer->drive].drive_flags &= ~DRIVE_RESET;
765 1.37 bouyer chp->ch_drive[xfer->drive].state = 0;
766 1.37 bouyer }
767 1.98 bjh21 if (chp->wdc->cap & WDC_CAPABILITY_NOIRQ)
768 1.98 bjh21 KASSERT(xfer->c_flags & C_POLL);
769 1.31 bouyer xfer->c_start(chp, xfer);
770 1.31 bouyer }
771 1.2 bouyer
772 1.31 bouyer /* restart an interrupted I/O */
773 1.31 bouyer void
774 1.31 bouyer wdcrestart(v)
775 1.31 bouyer void *v;
776 1.31 bouyer {
777 1.31 bouyer struct channel_softc *chp = v;
778 1.31 bouyer int s;
779 1.2 bouyer
780 1.31 bouyer s = splbio();
781 1.45 drochner wdcstart(chp);
782 1.31 bouyer splx(s);
783 1.2 bouyer }
784 1.31 bouyer
785 1.2 bouyer
786 1.31 bouyer /*
787 1.31 bouyer * Interrupt routine for the controller. Acknowledge the interrupt, check for
788 1.31 bouyer * errors on the current operation, mark it done if necessary, and start the
789 1.31 bouyer * next request. Also check for a partially done transfer, and continue with
790 1.31 bouyer * the next chunk if so.
791 1.31 bouyer */
792 1.12 cgd int
793 1.31 bouyer wdcintr(arg)
794 1.31 bouyer void *arg;
795 1.12 cgd {
796 1.31 bouyer struct channel_softc *chp = arg;
797 1.31 bouyer struct wdc_xfer *xfer;
798 1.76 bouyer int ret;
799 1.12 cgd
800 1.80 enami if ((chp->wdc->sc_dev.dv_flags & DVF_ACTIVE) == 0) {
801 1.80 enami WDCDEBUG_PRINT(("wdcintr: deactivated controller\n"),
802 1.80 enami DEBUG_INTR);
803 1.80 enami return (0);
804 1.80 enami }
805 1.31 bouyer if ((chp->ch_flags & WDCF_IRQ_WAIT) == 0) {
806 1.31 bouyer WDCDEBUG_PRINT(("wdcintr: inactive controller\n"), DEBUG_INTR);
807 1.113 bouyer /* try to clear the pending interrupt anyway */
808 1.113 bouyer (void)bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_status);
809 1.80 enami return (0);
810 1.31 bouyer }
811 1.12 cgd
812 1.31 bouyer WDCDEBUG_PRINT(("wdcintr\n"), DEBUG_INTR);
813 1.84 bouyer xfer = chp->ch_queue->sc_xfer.tqh_first;
814 1.84 bouyer if (chp->ch_flags & WDCF_DMA_WAIT) {
815 1.84 bouyer chp->wdc->dma_status =
816 1.84 bouyer (*chp->wdc->dma_finish)(chp->wdc->dma_arg, chp->channel,
817 1.84 bouyer xfer->drive, 0);
818 1.84 bouyer if (chp->wdc->dma_status & WDC_DMAST_NOIRQ) {
819 1.84 bouyer /* IRQ not for us, not detected by DMA engine */
820 1.84 bouyer return 0;
821 1.84 bouyer }
822 1.84 bouyer chp->ch_flags &= ~WDCF_DMA_WAIT;
823 1.84 bouyer }
824 1.31 bouyer chp->ch_flags &= ~WDCF_IRQ_WAIT;
825 1.76 bouyer ret = xfer->c_intr(chp, xfer, 1);
826 1.76 bouyer if (ret == 0) /* irq was not for us, still waiting for irq */
827 1.76 bouyer chp->ch_flags |= WDCF_IRQ_WAIT;
828 1.76 bouyer return (ret);
829 1.12 cgd }
830 1.12 cgd
831 1.31 bouyer /* Put all disk in RESET state */
832 1.125 mycroft void
833 1.125 mycroft wdc_reset_channel(drvp)
834 1.31 bouyer struct ata_drive_datas *drvp;
835 1.2 bouyer {
836 1.31 bouyer struct channel_softc *chp = drvp->chnl_softc;
837 1.2 bouyer int drive;
838 1.34 bouyer WDCDEBUG_PRINT(("ata_reset_channel %s:%d for drive %d\n",
839 1.34 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drvp->drive),
840 1.34 bouyer DEBUG_FUNCS);
841 1.31 bouyer (void) wdcreset(chp, VERBOSE);
842 1.31 bouyer for (drive = 0; drive < 2; drive++) {
843 1.31 bouyer chp->ch_drive[drive].state = 0;
844 1.12 cgd }
845 1.31 bouyer }
846 1.12 cgd
847 1.31 bouyer int
848 1.31 bouyer wdcreset(chp, verb)
849 1.31 bouyer struct channel_softc *chp;
850 1.31 bouyer int verb;
851 1.31 bouyer {
852 1.31 bouyer int drv_mask1, drv_mask2;
853 1.2 bouyer
854 1.107 dbj if (chp->wdc->cap & WDC_CAPABILITY_SELECT)
855 1.107 dbj chp->wdc->select(chp,0);
856 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
857 1.31 bouyer WDSD_IBM); /* master */
858 1.31 bouyer bus_space_write_1(chp->ctl_iot, chp->ctl_ioh, wd_aux_ctlr,
859 1.31 bouyer WDCTL_RST | WDCTL_IDS);
860 1.31 bouyer delay(1000);
861 1.31 bouyer bus_space_write_1(chp->ctl_iot, chp->ctl_ioh, wd_aux_ctlr,
862 1.31 bouyer WDCTL_IDS);
863 1.31 bouyer delay(1000);
864 1.31 bouyer (void) bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_error);
865 1.31 bouyer bus_space_write_1(chp->ctl_iot, chp->ctl_ioh, wd_aux_ctlr,
866 1.31 bouyer WDCTL_4BIT);
867 1.2 bouyer
868 1.31 bouyer drv_mask1 = (chp->ch_drive[0].drive_flags & DRIVE) ? 0x01:0x00;
869 1.31 bouyer drv_mask1 |= (chp->ch_drive[1].drive_flags & DRIVE) ? 0x02:0x00;
870 1.31 bouyer drv_mask2 = __wdcwait_reset(chp, drv_mask1);
871 1.31 bouyer if (verb && drv_mask2 != drv_mask1) {
872 1.31 bouyer printf("%s channel %d: reset failed for",
873 1.31 bouyer chp->wdc->sc_dev.dv_xname, chp->channel);
874 1.31 bouyer if ((drv_mask1 & 0x01) != 0 && (drv_mask2 & 0x01) == 0)
875 1.31 bouyer printf(" drive 0");
876 1.31 bouyer if ((drv_mask1 & 0x02) != 0 && (drv_mask2 & 0x02) == 0)
877 1.31 bouyer printf(" drive 1");
878 1.31 bouyer printf("\n");
879 1.31 bouyer }
880 1.31 bouyer return (drv_mask1 != drv_mask2) ? 1 : 0;
881 1.31 bouyer }
882 1.31 bouyer
883 1.31 bouyer static int
884 1.31 bouyer __wdcwait_reset(chp, drv_mask)
885 1.31 bouyer struct channel_softc *chp;
886 1.31 bouyer int drv_mask;
887 1.31 bouyer {
888 1.31 bouyer int timeout;
889 1.31 bouyer u_int8_t st0, st1;
890 1.70 bouyer #ifdef WDCDEBUG
891 1.70 bouyer u_int8_t sc0, sn0, cl0, ch0;
892 1.70 bouyer u_int8_t sc1, sn1, cl1, ch1;
893 1.70 bouyer #endif
894 1.31 bouyer /* wait for BSY to deassert */
895 1.110 simonb for (timeout = 0; timeout < WDCNDELAY_RST; timeout++) {
896 1.109 bouyer if (chp->wdc && chp->wdc->cap & WDC_CAPABILITY_SELECT)
897 1.107 dbj chp->wdc->select(chp,0);
898 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
899 1.31 bouyer WDSD_IBM); /* master */
900 1.65 bouyer delay(10);
901 1.31 bouyer st0 = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_status);
902 1.70 bouyer #ifdef WDCDEBUG
903 1.70 bouyer sc0 = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_seccnt);
904 1.70 bouyer sn0 = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_sector);
905 1.70 bouyer cl0 = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_lo);
906 1.70 bouyer ch0 = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_hi);
907 1.70 bouyer #endif
908 1.109 bouyer if (chp->wdc && chp->wdc->cap & WDC_CAPABILITY_SELECT)
909 1.107 dbj chp->wdc->select(chp,1);
910 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
911 1.31 bouyer WDSD_IBM | 0x10); /* slave */
912 1.65 bouyer delay(10);
913 1.31 bouyer st1 = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_status);
914 1.70 bouyer #ifdef WDCDEBUG
915 1.70 bouyer sc1 = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_seccnt);
916 1.70 bouyer sn1 = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_sector);
917 1.70 bouyer cl1 = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_lo);
918 1.70 bouyer ch1 = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_hi);
919 1.70 bouyer #endif
920 1.31 bouyer
921 1.31 bouyer if ((drv_mask & 0x01) == 0) {
922 1.31 bouyer /* no master */
923 1.31 bouyer if ((drv_mask & 0x02) != 0 && (st1 & WDCS_BSY) == 0) {
924 1.31 bouyer /* No master, slave is ready, it's done */
925 1.65 bouyer goto end;
926 1.31 bouyer }
927 1.31 bouyer } else if ((drv_mask & 0x02) == 0) {
928 1.31 bouyer /* no slave */
929 1.31 bouyer if ((drv_mask & 0x01) != 0 && (st0 & WDCS_BSY) == 0) {
930 1.31 bouyer /* No slave, master is ready, it's done */
931 1.65 bouyer goto end;
932 1.31 bouyer }
933 1.2 bouyer } else {
934 1.31 bouyer /* Wait for both master and slave to be ready */
935 1.31 bouyer if ((st0 & WDCS_BSY) == 0 && (st1 & WDCS_BSY) == 0) {
936 1.65 bouyer goto end;
937 1.2 bouyer }
938 1.2 bouyer }
939 1.31 bouyer delay(WDCDELAY);
940 1.2 bouyer }
941 1.116 wiz /* Reset timed out. Maybe it's because drv_mask was not right */
942 1.31 bouyer if (st0 & WDCS_BSY)
943 1.31 bouyer drv_mask &= ~0x01;
944 1.31 bouyer if (st1 & WDCS_BSY)
945 1.31 bouyer drv_mask &= ~0x02;
946 1.65 bouyer end:
947 1.70 bouyer WDCDEBUG_PRINT(("%s:%d:0: after reset, sc=0x%x sn=0x%x "
948 1.70 bouyer "cl=0x%x ch=0x%x\n",
949 1.70 bouyer chp->wdc ? chp->wdc->sc_dev.dv_xname : "wdcprobe",
950 1.70 bouyer chp->channel, sc0, sn0, cl0, ch0), DEBUG_PROBE);
951 1.70 bouyer WDCDEBUG_PRINT(("%s:%d:1: after reset, sc=0x%x sn=0x%x "
952 1.70 bouyer "cl=0x%x ch=0x%x\n",
953 1.70 bouyer chp->wdc ? chp->wdc->sc_dev.dv_xname : "wdcprobe",
954 1.70 bouyer chp->channel, sc1, sn1, cl1, ch1), DEBUG_PROBE);
955 1.70 bouyer
956 1.65 bouyer WDCDEBUG_PRINT(("%s:%d: wdcwait_reset() end, st0=0x%x, st1=0x%x\n",
957 1.65 bouyer chp->wdc ? chp->wdc->sc_dev.dv_xname : "wdcprobe", chp->channel,
958 1.65 bouyer st0, st1), DEBUG_PROBE);
959 1.65 bouyer
960 1.31 bouyer return drv_mask;
961 1.2 bouyer }
962 1.2 bouyer
963 1.2 bouyer /*
964 1.31 bouyer * Wait for a drive to be !BSY, and have mask in its status register.
965 1.31 bouyer * return -1 for a timeout after "timeout" ms.
966 1.2 bouyer */
967 1.31 bouyer int
968 1.31 bouyer wdcwait(chp, mask, bits, timeout)
969 1.31 bouyer struct channel_softc *chp;
970 1.31 bouyer int mask, bits, timeout;
971 1.2 bouyer {
972 1.31 bouyer u_char status;
973 1.31 bouyer int time = 0;
974 1.60 abs
975 1.60 abs WDCDEBUG_PRINT(("wdcwait %s:%d\n", chp->wdc ?chp->wdc->sc_dev.dv_xname
976 1.60 abs :"none", chp->channel), DEBUG_STATUS);
977 1.31 bouyer chp->ch_error = 0;
978 1.31 bouyer
979 1.31 bouyer timeout = timeout * 1000 / WDCDELAY; /* delay uses microseconds */
980 1.2 bouyer
981 1.31 bouyer for (;;) {
982 1.31 bouyer chp->ch_status = status =
983 1.31 bouyer bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_status);
984 1.31 bouyer if ((status & WDCS_BSY) == 0 && (status & mask) == bits)
985 1.31 bouyer break;
986 1.31 bouyer if (++time > timeout) {
987 1.87 bouyer WDCDEBUG_PRINT(("wdcwait: timeout (time=%d), "
988 1.87 bouyer "status %x error %x (mask 0x%x bits 0x%x)\n",
989 1.87 bouyer time, status,
990 1.31 bouyer bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
991 1.77 bouyer wd_error), mask, bits),
992 1.87 bouyer DEBUG_STATUS | DEBUG_PROBE | DEBUG_DELAY);
993 1.31 bouyer return -1;
994 1.31 bouyer }
995 1.31 bouyer delay(WDCDELAY);
996 1.2 bouyer }
997 1.87 bouyer #ifdef WDCDEBUG
998 1.87 bouyer if (time > 0 && (wdcdebug_mask & DEBUG_DELAY))
999 1.87 bouyer printf("wdcwait: did busy-wait, time=%d\n", time);
1000 1.87 bouyer #endif
1001 1.31 bouyer if (status & WDCS_ERR)
1002 1.31 bouyer chp->ch_error = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
1003 1.31 bouyer wd_error);
1004 1.31 bouyer #ifdef WDCNDELAY_DEBUG
1005 1.31 bouyer /* After autoconfig, there should be no long delays. */
1006 1.31 bouyer if (!cold && time > WDCNDELAY_DEBUG) {
1007 1.31 bouyer struct wdc_xfer *xfer = chp->ch_queue->sc_xfer.tqh_first;
1008 1.31 bouyer if (xfer == NULL)
1009 1.31 bouyer printf("%s channel %d: warning: busy-wait took %dus\n",
1010 1.31 bouyer chp->wdc->sc_dev.dv_xname, chp->channel,
1011 1.31 bouyer WDCDELAY * time);
1012 1.31 bouyer else
1013 1.31 bouyer printf("%s:%d:%d: warning: busy-wait took %dus\n",
1014 1.49 bouyer chp->wdc->sc_dev.dv_xname, chp->channel,
1015 1.31 bouyer xfer->drive,
1016 1.31 bouyer WDCDELAY * time);
1017 1.2 bouyer }
1018 1.2 bouyer #endif
1019 1.31 bouyer return 0;
1020 1.2 bouyer }
1021 1.2 bouyer
1022 1.84 bouyer /*
1023 1.84 bouyer * Busy-wait for DMA to complete
1024 1.84 bouyer */
1025 1.84 bouyer int
1026 1.84 bouyer wdc_dmawait(chp, xfer, timeout)
1027 1.84 bouyer struct channel_softc *chp;
1028 1.84 bouyer struct wdc_xfer *xfer;
1029 1.84 bouyer int timeout;
1030 1.84 bouyer {
1031 1.84 bouyer int time;
1032 1.84 bouyer for (time = 0; time < timeout * 1000 / WDCDELAY; time++) {
1033 1.84 bouyer chp->wdc->dma_status =
1034 1.84 bouyer (*chp->wdc->dma_finish)(chp->wdc->dma_arg,
1035 1.84 bouyer chp->channel, xfer->drive, 0);
1036 1.84 bouyer if ((chp->wdc->dma_status & WDC_DMAST_NOIRQ) == 0)
1037 1.84 bouyer return 0;
1038 1.84 bouyer delay(WDCDELAY);
1039 1.84 bouyer }
1040 1.84 bouyer /* timeout, force a DMA halt */
1041 1.84 bouyer chp->wdc->dma_status = (*chp->wdc->dma_finish)(chp->wdc->dma_arg,
1042 1.84 bouyer chp->channel, xfer->drive, 1);
1043 1.84 bouyer return 1;
1044 1.84 bouyer }
1045 1.84 bouyer
1046 1.31 bouyer void
1047 1.31 bouyer wdctimeout(arg)
1048 1.31 bouyer void *arg;
1049 1.2 bouyer {
1050 1.31 bouyer struct channel_softc *chp = (struct channel_softc *)arg;
1051 1.31 bouyer struct wdc_xfer *xfer = chp->ch_queue->sc_xfer.tqh_first;
1052 1.31 bouyer int s;
1053 1.2 bouyer
1054 1.31 bouyer WDCDEBUG_PRINT(("wdctimeout\n"), DEBUG_FUNCS);
1055 1.31 bouyer
1056 1.31 bouyer s = splbio();
1057 1.31 bouyer if ((chp->ch_flags & WDCF_IRQ_WAIT) != 0) {
1058 1.31 bouyer __wdcerror(chp, "lost interrupt");
1059 1.88 mrg printf("\ttype: %s tc_bcount: %d tc_skip: %d\n",
1060 1.88 mrg (xfer->c_flags & C_ATAPI) ? "atapi" : "ata",
1061 1.88 mrg xfer->c_bcount,
1062 1.88 mrg xfer->c_skip);
1063 1.84 bouyer if (chp->ch_flags & WDCF_DMA_WAIT) {
1064 1.84 bouyer chp->wdc->dma_status =
1065 1.84 bouyer (*chp->wdc->dma_finish)(chp->wdc->dma_arg,
1066 1.84 bouyer chp->channel, xfer->drive, 1);
1067 1.84 bouyer chp->ch_flags &= ~WDCF_DMA_WAIT;
1068 1.84 bouyer }
1069 1.31 bouyer /*
1070 1.119 drochner * Call the interrupt routine. If we just missed an interrupt,
1071 1.31 bouyer * it will do what's needed. Else, it will take the needed
1072 1.31 bouyer * action (reset the device).
1073 1.70 bouyer * Before that we need to reinstall the timeout callback,
1074 1.70 bouyer * in case it will miss another irq while in this transfer
1075 1.70 bouyer * We arbitray chose it to be 1s
1076 1.31 bouyer */
1077 1.81 thorpej callout_reset(&chp->ch_callout, hz, wdctimeout, chp);
1078 1.31 bouyer xfer->c_flags |= C_TIMEOU;
1079 1.31 bouyer chp->ch_flags &= ~WDCF_IRQ_WAIT;
1080 1.66 bouyer xfer->c_intr(chp, xfer, 1);
1081 1.31 bouyer } else
1082 1.31 bouyer __wdcerror(chp, "missing untimeout");
1083 1.31 bouyer splx(s);
1084 1.2 bouyer }
1085 1.2 bouyer
1086 1.31 bouyer /*
1087 1.31 bouyer * Probe drive's capabilites, for use by the controller later
1088 1.31 bouyer * Assumes drvp points to an existing drive.
1089 1.31 bouyer * XXX this should be a controller-indep function
1090 1.31 bouyer */
1091 1.2 bouyer void
1092 1.31 bouyer wdc_probe_caps(drvp)
1093 1.31 bouyer struct ata_drive_datas *drvp;
1094 1.2 bouyer {
1095 1.31 bouyer struct ataparams params, params2;
1096 1.31 bouyer struct channel_softc *chp = drvp->chnl_softc;
1097 1.31 bouyer struct device *drv_dev = drvp->drv_softc;
1098 1.31 bouyer struct wdc_softc *wdc = chp->wdc;
1099 1.31 bouyer int i, printed;
1100 1.31 bouyer char *sep = "";
1101 1.48 bouyer int cf_flags;
1102 1.31 bouyer
1103 1.125 mycroft if (ata_get_params(drvp, AT_WAIT, ¶ms) != CMD_OK) {
1104 1.31 bouyer /* IDENTIFY failed. Can't tell more about the device */
1105 1.2 bouyer return;
1106 1.2 bouyer }
1107 1.31 bouyer if ((wdc->cap & (WDC_CAPABILITY_DATA16 | WDC_CAPABILITY_DATA32)) ==
1108 1.31 bouyer (WDC_CAPABILITY_DATA16 | WDC_CAPABILITY_DATA32)) {
1109 1.2 bouyer /*
1110 1.39 bouyer * Controller claims 16 and 32 bit transfers.
1111 1.39 bouyer * Re-do an IDENTIFY with 32-bit transfers,
1112 1.31 bouyer * and compare results.
1113 1.2 bouyer */
1114 1.31 bouyer drvp->drive_flags |= DRIVE_CAP32;
1115 1.125 mycroft ata_get_params(drvp, AT_WAIT, ¶ms2);
1116 1.31 bouyer if (memcmp(¶ms, ¶ms2, sizeof(struct ataparams)) != 0) {
1117 1.31 bouyer /* Not good. fall back to 16bits */
1118 1.31 bouyer drvp->drive_flags &= ~DRIVE_CAP32;
1119 1.31 bouyer } else {
1120 1.125 mycroft aprint_normal("%s: 32-bit data port\n",
1121 1.123 thorpej drv_dev->dv_xname);
1122 1.2 bouyer }
1123 1.2 bouyer }
1124 1.55 bouyer #if 0 /* Some ultra-DMA drives claims to only support ATA-3. sigh */
1125 1.55 bouyer if (params.atap_ata_major > 0x01 &&
1126 1.55 bouyer params.atap_ata_major != 0xffff) {
1127 1.55 bouyer for (i = 14; i > 0; i--) {
1128 1.55 bouyer if (params.atap_ata_major & (1 << i)) {
1129 1.125 mycroft aprint_normal("%s: ATA version %d\n",
1130 1.125 mycroft drv_dev->dv_xname, i);
1131 1.55 bouyer drvp->ata_vers = i;
1132 1.55 bouyer break;
1133 1.55 bouyer }
1134 1.55 bouyer }
1135 1.125 mycroft }
1136 1.55 bouyer #endif
1137 1.2 bouyer
1138 1.31 bouyer /* An ATAPI device is at last PIO mode 3 */
1139 1.31 bouyer if (drvp->drive_flags & DRIVE_ATAPI)
1140 1.31 bouyer drvp->PIO_mode = 3;
1141 1.2 bouyer
1142 1.2 bouyer /*
1143 1.31 bouyer * It's not in the specs, but it seems that some drive
1144 1.31 bouyer * returns 0xffff in atap_extensions when this field is invalid
1145 1.2 bouyer */
1146 1.31 bouyer if (params.atap_extensions != 0xffff &&
1147 1.31 bouyer (params.atap_extensions & WDC_EXT_MODES)) {
1148 1.31 bouyer printed = 0;
1149 1.31 bouyer /*
1150 1.31 bouyer * XXX some drives report something wrong here (they claim to
1151 1.31 bouyer * support PIO mode 8 !). As mode is coded on 3 bits in
1152 1.31 bouyer * SET FEATURE, limit it to 7 (so limit i to 4).
1153 1.116 wiz * If higher mode than 7 is found, abort.
1154 1.31 bouyer */
1155 1.39 bouyer for (i = 7; i >= 0; i--) {
1156 1.31 bouyer if ((params.atap_piomode_supp & (1 << i)) == 0)
1157 1.31 bouyer continue;
1158 1.39 bouyer if (i > 4)
1159 1.39 bouyer return;
1160 1.31 bouyer /*
1161 1.31 bouyer * See if mode is accepted.
1162 1.31 bouyer * If the controller can't set its PIO mode,
1163 1.31 bouyer * assume the defaults are good, so don't try
1164 1.31 bouyer * to set it
1165 1.31 bouyer */
1166 1.31 bouyer if ((wdc->cap & WDC_CAPABILITY_MODE) != 0)
1167 1.31 bouyer if (ata_set_mode(drvp, 0x08 | (i + 3),
1168 1.125 mycroft AT_WAIT) != CMD_OK)
1169 1.2 bouyer continue;
1170 1.31 bouyer if (!printed) {
1171 1.123 thorpej aprint_normal("%s: drive supports PIO mode %d",
1172 1.39 bouyer drv_dev->dv_xname, i + 3);
1173 1.31 bouyer sep = ",";
1174 1.31 bouyer printed = 1;
1175 1.31 bouyer }
1176 1.31 bouyer /*
1177 1.31 bouyer * If controller's driver can't set its PIO mode,
1178 1.31 bouyer * get the highter one for the drive.
1179 1.31 bouyer */
1180 1.31 bouyer if ((wdc->cap & WDC_CAPABILITY_MODE) == 0 ||
1181 1.52 bouyer wdc->PIO_cap >= i + 3) {
1182 1.31 bouyer drvp->PIO_mode = i + 3;
1183 1.48 bouyer drvp->PIO_cap = i + 3;
1184 1.2 bouyer break;
1185 1.2 bouyer }
1186 1.2 bouyer }
1187 1.31 bouyer if (!printed) {
1188 1.31 bouyer /*
1189 1.31 bouyer * We didn't find a valid PIO mode.
1190 1.31 bouyer * Assume the values returned for DMA are buggy too
1191 1.31 bouyer */
1192 1.31 bouyer return;
1193 1.2 bouyer }
1194 1.35 bouyer drvp->drive_flags |= DRIVE_MODE;
1195 1.31 bouyer printed = 0;
1196 1.31 bouyer for (i = 7; i >= 0; i--) {
1197 1.31 bouyer if ((params.atap_dmamode_supp & (1 << i)) == 0)
1198 1.31 bouyer continue;
1199 1.31 bouyer if ((wdc->cap & WDC_CAPABILITY_DMA) &&
1200 1.31 bouyer (wdc->cap & WDC_CAPABILITY_MODE))
1201 1.125 mycroft if (ata_set_mode(drvp, 0x20 | i, AT_WAIT)
1202 1.31 bouyer != CMD_OK)
1203 1.31 bouyer continue;
1204 1.31 bouyer if (!printed) {
1205 1.123 thorpej aprint_normal("%s DMA mode %d", sep, i);
1206 1.31 bouyer sep = ",";
1207 1.31 bouyer printed = 1;
1208 1.31 bouyer }
1209 1.31 bouyer if (wdc->cap & WDC_CAPABILITY_DMA) {
1210 1.31 bouyer if ((wdc->cap & WDC_CAPABILITY_MODE) &&
1211 1.52 bouyer wdc->DMA_cap < i)
1212 1.31 bouyer continue;
1213 1.31 bouyer drvp->DMA_mode = i;
1214 1.48 bouyer drvp->DMA_cap = i;
1215 1.31 bouyer drvp->drive_flags |= DRIVE_DMA;
1216 1.31 bouyer }
1217 1.2 bouyer break;
1218 1.2 bouyer }
1219 1.31 bouyer if (params.atap_extensions & WDC_EXT_UDMA_MODES) {
1220 1.71 bouyer printed = 0;
1221 1.31 bouyer for (i = 7; i >= 0; i--) {
1222 1.31 bouyer if ((params.atap_udmamode_supp & (1 << i))
1223 1.31 bouyer == 0)
1224 1.31 bouyer continue;
1225 1.31 bouyer if ((wdc->cap & WDC_CAPABILITY_MODE) &&
1226 1.31 bouyer (wdc->cap & WDC_CAPABILITY_UDMA))
1227 1.31 bouyer if (ata_set_mode(drvp, 0x40 | i,
1228 1.125 mycroft AT_WAIT) != CMD_OK)
1229 1.31 bouyer continue;
1230 1.71 bouyer if (!printed) {
1231 1.123 thorpej aprint_normal("%s Ultra-DMA mode %d",
1232 1.123 thorpej sep, i);
1233 1.93 wrstuden if (i == 2)
1234 1.123 thorpej aprint_normal(" (Ultra/33)");
1235 1.93 wrstuden else if (i == 4)
1236 1.123 thorpej aprint_normal(" (Ultra/66)");
1237 1.93 wrstuden else if (i == 5)
1238 1.123 thorpej aprint_normal(" (Ultra/100)");
1239 1.117 bouyer else if (i == 6)
1240 1.123 thorpej aprint_normal(" (Ultra/133)");
1241 1.71 bouyer sep = ",";
1242 1.71 bouyer printed = 1;
1243 1.71 bouyer }
1244 1.31 bouyer if (wdc->cap & WDC_CAPABILITY_UDMA) {
1245 1.50 bouyer if ((wdc->cap & WDC_CAPABILITY_MODE) &&
1246 1.52 bouyer wdc->UDMA_cap < i)
1247 1.50 bouyer continue;
1248 1.31 bouyer drvp->UDMA_mode = i;
1249 1.48 bouyer drvp->UDMA_cap = i;
1250 1.31 bouyer drvp->drive_flags |= DRIVE_UDMA;
1251 1.31 bouyer }
1252 1.31 bouyer break;
1253 1.31 bouyer }
1254 1.31 bouyer }
1255 1.123 thorpej aprint_normal("\n");
1256 1.55 bouyer }
1257 1.55 bouyer
1258 1.55 bouyer /* Try to guess ATA version here, if it didn't get reported */
1259 1.55 bouyer if (drvp->ata_vers == 0) {
1260 1.55 bouyer if (drvp->drive_flags & DRIVE_UDMA)
1261 1.55 bouyer drvp->ata_vers = 4; /* should be at last ATA-4 */
1262 1.55 bouyer else if (drvp->PIO_cap > 2)
1263 1.55 bouyer drvp->ata_vers = 2; /* should be at last ATA-2 */
1264 1.48 bouyer }
1265 1.48 bouyer cf_flags = drv_dev->dv_cfdata->cf_flags;
1266 1.48 bouyer if (cf_flags & ATA_CONFIG_PIO_SET) {
1267 1.48 bouyer drvp->PIO_mode =
1268 1.48 bouyer (cf_flags & ATA_CONFIG_PIO_MODES) >> ATA_CONFIG_PIO_OFF;
1269 1.48 bouyer drvp->drive_flags |= DRIVE_MODE;
1270 1.48 bouyer }
1271 1.48 bouyer if ((wdc->cap & WDC_CAPABILITY_DMA) == 0) {
1272 1.48 bouyer /* don't care about DMA modes */
1273 1.48 bouyer return;
1274 1.48 bouyer }
1275 1.48 bouyer if (cf_flags & ATA_CONFIG_DMA_SET) {
1276 1.48 bouyer if ((cf_flags & ATA_CONFIG_DMA_MODES) ==
1277 1.48 bouyer ATA_CONFIG_DMA_DISABLE) {
1278 1.48 bouyer drvp->drive_flags &= ~DRIVE_DMA;
1279 1.48 bouyer } else {
1280 1.48 bouyer drvp->DMA_mode = (cf_flags & ATA_CONFIG_DMA_MODES) >>
1281 1.48 bouyer ATA_CONFIG_DMA_OFF;
1282 1.48 bouyer drvp->drive_flags |= DRIVE_DMA | DRIVE_MODE;
1283 1.48 bouyer }
1284 1.101 bouyer }
1285 1.101 bouyer if ((wdc->cap & WDC_CAPABILITY_UDMA) == 0) {
1286 1.101 bouyer /* don't care about UDMA modes */
1287 1.101 bouyer return;
1288 1.48 bouyer }
1289 1.48 bouyer if (cf_flags & ATA_CONFIG_UDMA_SET) {
1290 1.48 bouyer if ((cf_flags & ATA_CONFIG_UDMA_MODES) ==
1291 1.48 bouyer ATA_CONFIG_UDMA_DISABLE) {
1292 1.48 bouyer drvp->drive_flags &= ~DRIVE_UDMA;
1293 1.48 bouyer } else {
1294 1.48 bouyer drvp->UDMA_mode = (cf_flags & ATA_CONFIG_UDMA_MODES) >>
1295 1.48 bouyer ATA_CONFIG_UDMA_OFF;
1296 1.48 bouyer drvp->drive_flags |= DRIVE_UDMA | DRIVE_MODE;
1297 1.48 bouyer }
1298 1.2 bouyer }
1299 1.54 bouyer }
1300 1.54 bouyer
1301 1.54 bouyer /*
1302 1.56 bouyer * downgrade the transfer mode of a drive after an error. return 1 if
1303 1.54 bouyer * downgrade was possible, 0 otherwise.
1304 1.54 bouyer */
1305 1.54 bouyer int
1306 1.54 bouyer wdc_downgrade_mode(drvp)
1307 1.54 bouyer struct ata_drive_datas *drvp;
1308 1.54 bouyer {
1309 1.54 bouyer struct channel_softc *chp = drvp->chnl_softc;
1310 1.54 bouyer struct device *drv_dev = drvp->drv_softc;
1311 1.54 bouyer struct wdc_softc *wdc = chp->wdc;
1312 1.54 bouyer int cf_flags = drv_dev->dv_cfdata->cf_flags;
1313 1.54 bouyer
1314 1.54 bouyer /* if drive or controller don't know its mode, we can't do much */
1315 1.54 bouyer if ((drvp->drive_flags & DRIVE_MODE) == 0 ||
1316 1.54 bouyer (wdc->cap & WDC_CAPABILITY_MODE) == 0)
1317 1.54 bouyer return 0;
1318 1.54 bouyer /* current drive mode was set by a config flag, let it this way */
1319 1.54 bouyer if ((cf_flags & ATA_CONFIG_PIO_SET) ||
1320 1.54 bouyer (cf_flags & ATA_CONFIG_DMA_SET) ||
1321 1.54 bouyer (cf_flags & ATA_CONFIG_UDMA_SET))
1322 1.54 bouyer return 0;
1323 1.54 bouyer
1324 1.61 bouyer /*
1325 1.73 bouyer * If we were using Ultra-DMA mode > 2, downgrade to mode 2 first.
1326 1.73 bouyer * Maybe we didn't properly notice the cable type
1327 1.78 bouyer * If we were using Ultra-DMA mode 2, downgrade to mode 1 first.
1328 1.78 bouyer * It helps in some cases.
1329 1.73 bouyer */
1330 1.78 bouyer if ((drvp->drive_flags & DRIVE_UDMA) && drvp->UDMA_mode >= 2) {
1331 1.78 bouyer drvp->UDMA_mode = (drvp->UDMA_mode == 2) ? 1 : 2;
1332 1.78 bouyer printf("%s: transfer error, downgrading to Ultra-DMA mode %d\n",
1333 1.73 bouyer drv_dev->dv_xname, drvp->UDMA_mode);
1334 1.73 bouyer }
1335 1.73 bouyer
1336 1.73 bouyer /*
1337 1.61 bouyer * If we were using ultra-DMA, don't downgrade to multiword DMA
1338 1.61 bouyer * if we noticed a CRC error. It has been noticed that CRC errors
1339 1.61 bouyer * in ultra-DMA lead to silent data corruption in multiword DMA.
1340 1.61 bouyer * Data corruption is less likely to occur in PIO mode.
1341 1.61 bouyer */
1342 1.73 bouyer else if ((drvp->drive_flags & DRIVE_UDMA) &&
1343 1.61 bouyer (drvp->drive_flags & DRIVE_DMAERR) == 0) {
1344 1.54 bouyer drvp->drive_flags &= ~DRIVE_UDMA;
1345 1.54 bouyer drvp->drive_flags |= DRIVE_DMA;
1346 1.54 bouyer drvp->DMA_mode = drvp->DMA_cap;
1347 1.56 bouyer printf("%s: transfer error, downgrading to DMA mode %d\n",
1348 1.54 bouyer drv_dev->dv_xname, drvp->DMA_mode);
1349 1.61 bouyer } else if (drvp->drive_flags & (DRIVE_DMA | DRIVE_UDMA)) {
1350 1.61 bouyer drvp->drive_flags &= ~(DRIVE_DMA | DRIVE_UDMA);
1351 1.54 bouyer drvp->PIO_mode = drvp->PIO_cap;
1352 1.56 bouyer printf("%s: transfer error, downgrading to PIO mode %d\n",
1353 1.54 bouyer drv_dev->dv_xname, drvp->PIO_mode);
1354 1.54 bouyer } else /* already using PIO, can't downgrade */
1355 1.54 bouyer return 0;
1356 1.54 bouyer
1357 1.54 bouyer wdc->set_modes(chp);
1358 1.124 drochner /* reset the channel, which will schedule all drives for setup */
1359 1.54 bouyer wdc_reset_channel(drvp);
1360 1.54 bouyer return 1;
1361 1.2 bouyer }
1362 1.2 bouyer
1363 1.2 bouyer int
1364 1.31 bouyer wdc_exec_command(drvp, wdc_c)
1365 1.31 bouyer struct ata_drive_datas *drvp;
1366 1.31 bouyer struct wdc_command *wdc_c;
1367 1.31 bouyer {
1368 1.31 bouyer struct channel_softc *chp = drvp->chnl_softc;
1369 1.2 bouyer struct wdc_xfer *xfer;
1370 1.31 bouyer int s, ret;
1371 1.2 bouyer
1372 1.34 bouyer WDCDEBUG_PRINT(("wdc_exec_command %s:%d:%d\n",
1373 1.34 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drvp->drive),
1374 1.34 bouyer DEBUG_FUNCS);
1375 1.2 bouyer
1376 1.31 bouyer /* set up an xfer and queue. Wait for completion */
1377 1.31 bouyer xfer = wdc_get_xfer(wdc_c->flags & AT_WAIT ? WDC_CANSLEEP :
1378 1.31 bouyer WDC_NOSLEEP);
1379 1.31 bouyer if (xfer == NULL) {
1380 1.31 bouyer return WDC_TRY_AGAIN;
1381 1.31 bouyer }
1382 1.2 bouyer
1383 1.98 bjh21 if (chp->wdc->cap & WDC_CAPABILITY_NOIRQ)
1384 1.98 bjh21 wdc_c->flags |= AT_POLL;
1385 1.31 bouyer if (wdc_c->flags & AT_POLL)
1386 1.31 bouyer xfer->c_flags |= C_POLL;
1387 1.31 bouyer xfer->drive = drvp->drive;
1388 1.31 bouyer xfer->databuf = wdc_c->data;
1389 1.31 bouyer xfer->c_bcount = wdc_c->bcount;
1390 1.31 bouyer xfer->cmd = wdc_c;
1391 1.31 bouyer xfer->c_start = __wdccommand_start;
1392 1.31 bouyer xfer->c_intr = __wdccommand_intr;
1393 1.75 enami xfer->c_kill_xfer = __wdccommand_done;
1394 1.2 bouyer
1395 1.31 bouyer s = splbio();
1396 1.31 bouyer wdc_exec_xfer(chp, xfer);
1397 1.31 bouyer #ifdef DIAGNOSTIC
1398 1.31 bouyer if ((wdc_c->flags & AT_POLL) != 0 &&
1399 1.31 bouyer (wdc_c->flags & AT_DONE) == 0)
1400 1.118 provos panic("wdc_exec_command: polled command not done");
1401 1.2 bouyer #endif
1402 1.31 bouyer if (wdc_c->flags & AT_DONE) {
1403 1.31 bouyer ret = WDC_COMPLETE;
1404 1.31 bouyer } else {
1405 1.31 bouyer if (wdc_c->flags & AT_WAIT) {
1406 1.69 bouyer while ((wdc_c->flags & AT_DONE) == 0) {
1407 1.69 bouyer tsleep(wdc_c, PRIBIO, "wdccmd", 0);
1408 1.69 bouyer }
1409 1.31 bouyer ret = WDC_COMPLETE;
1410 1.31 bouyer } else {
1411 1.31 bouyer ret = WDC_QUEUED;
1412 1.2 bouyer }
1413 1.2 bouyer }
1414 1.31 bouyer splx(s);
1415 1.31 bouyer return ret;
1416 1.2 bouyer }
1417 1.2 bouyer
1418 1.2 bouyer void
1419 1.31 bouyer __wdccommand_start(chp, xfer)
1420 1.31 bouyer struct channel_softc *chp;
1421 1.2 bouyer struct wdc_xfer *xfer;
1422 1.31 bouyer {
1423 1.31 bouyer int drive = xfer->drive;
1424 1.31 bouyer struct wdc_command *wdc_c = xfer->cmd;
1425 1.31 bouyer
1426 1.34 bouyer WDCDEBUG_PRINT(("__wdccommand_start %s:%d:%d\n",
1427 1.34 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, xfer->drive),
1428 1.34 bouyer DEBUG_FUNCS);
1429 1.31 bouyer
1430 1.107 dbj if (chp->wdc->cap & WDC_CAPABILITY_SELECT)
1431 1.107 dbj chp->wdc->select(chp,drive);
1432 1.107 dbj
1433 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
1434 1.31 bouyer WDSD_IBM | (drive << 4));
1435 1.79 bouyer if (wdcwait(chp, wdc_c->r_st_bmask | WDCS_DRQ, wdc_c->r_st_bmask,
1436 1.31 bouyer wdc_c->timeout) != 0) {
1437 1.31 bouyer wdc_c->flags |= AT_TIMEOU;
1438 1.31 bouyer __wdccommand_done(chp, xfer);
1439 1.53 bouyer return;
1440 1.31 bouyer }
1441 1.31 bouyer wdccommand(chp, drive, wdc_c->r_command, wdc_c->r_cyl, wdc_c->r_head,
1442 1.31 bouyer wdc_c->r_sector, wdc_c->r_count, wdc_c->r_precomp);
1443 1.31 bouyer if ((wdc_c->flags & AT_POLL) == 0) {
1444 1.31 bouyer chp->ch_flags |= WDCF_IRQ_WAIT; /* wait for interrupt */
1445 1.81 thorpej callout_reset(&chp->ch_callout, wdc_c->timeout / 1000 * hz,
1446 1.81 thorpej wdctimeout, chp);
1447 1.31 bouyer return;
1448 1.2 bouyer }
1449 1.2 bouyer /*
1450 1.31 bouyer * Polled command. Wait for drive ready or drq. Done in intr().
1451 1.31 bouyer * Wait for at last 400ns for status bit to be valid.
1452 1.2 bouyer */
1453 1.31 bouyer delay(10);
1454 1.66 bouyer __wdccommand_intr(chp, xfer, 0);
1455 1.2 bouyer }
1456 1.2 bouyer
1457 1.2 bouyer int
1458 1.66 bouyer __wdccommand_intr(chp, xfer, irq)
1459 1.31 bouyer struct channel_softc *chp;
1460 1.31 bouyer struct wdc_xfer *xfer;
1461 1.66 bouyer int irq;
1462 1.2 bouyer {
1463 1.31 bouyer struct wdc_command *wdc_c = xfer->cmd;
1464 1.31 bouyer int bcount = wdc_c->bcount;
1465 1.31 bouyer char *data = wdc_c->data;
1466 1.31 bouyer
1467 1.114 bouyer again:
1468 1.34 bouyer WDCDEBUG_PRINT(("__wdccommand_intr %s:%d:%d\n",
1469 1.34 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, xfer->drive), DEBUG_INTR);
1470 1.114 bouyer if ((wdc_c->flags & AT_XFDONE) != 0) {
1471 1.114 bouyer /*
1472 1.114 bouyer * We have completed a data xfer. The drive should now be
1473 1.114 bouyer * in its initial state
1474 1.114 bouyer */
1475 1.114 bouyer if (wdcwait(chp, wdc_c->r_st_bmask | WDCS_DRQ,
1476 1.114 bouyer wdc_c->r_st_bmask, (irq == 0) ? wdc_c->timeout : 0) != 0) {
1477 1.114 bouyer if (irq && (xfer->c_flags & C_TIMEOU) == 0)
1478 1.114 bouyer return 0; /* IRQ was not for us */
1479 1.114 bouyer wdc_c->flags |= AT_TIMEOU;
1480 1.114 bouyer __wdccommand_done(chp, xfer);
1481 1.114 bouyer return 1;
1482 1.114 bouyer }
1483 1.114 bouyer wdc_c->flags |= AT_DONE;
1484 1.114 bouyer __wdccommand_done(chp, xfer);
1485 1.114 bouyer return 1;
1486 1.114 bouyer }
1487 1.31 bouyer if (wdcwait(chp, wdc_c->r_st_pmask, wdc_c->r_st_pmask,
1488 1.66 bouyer (irq == 0) ? wdc_c->timeout : 0)) {
1489 1.66 bouyer if (irq && (xfer->c_flags & C_TIMEOU) == 0)
1490 1.63 bouyer return 0; /* IRQ was not for us */
1491 1.63 bouyer wdc_c->flags |= AT_TIMEOU;
1492 1.31 bouyer __wdccommand_done(chp, xfer);
1493 1.2 bouyer return 1;
1494 1.2 bouyer }
1495 1.91 bouyer if (chp->wdc->cap & WDC_CAPABILITY_IRQACK)
1496 1.91 bouyer chp->wdc->irqack(chp);
1497 1.31 bouyer if (wdc_c->flags & AT_READ) {
1498 1.31 bouyer if (chp->ch_drive[xfer->drive].drive_flags & DRIVE_CAP32) {
1499 1.31 bouyer bus_space_read_multi_4(chp->data32iot, chp->data32ioh,
1500 1.31 bouyer 0, (u_int32_t*)data, bcount >> 2);
1501 1.31 bouyer data += bcount & 0xfffffffc;
1502 1.31 bouyer bcount = bcount & 0x03;
1503 1.31 bouyer }
1504 1.31 bouyer if (bcount > 0)
1505 1.31 bouyer bus_space_read_multi_2(chp->cmd_iot, chp->cmd_ioh,
1506 1.31 bouyer wd_data, (u_int16_t *)data, bcount >> 1);
1507 1.114 bouyer /* at this point the drive should be in its initial state */
1508 1.114 bouyer wdc_c->flags |= AT_XFDONE;
1509 1.114 bouyer if (wdcwait(chp, wdc_c->r_st_bmask | WDCS_DRQ,
1510 1.114 bouyer wdc_c->r_st_bmask, 100) != 0)
1511 1.114 bouyer wdc_c->flags |= AT_TIMEOU;
1512 1.31 bouyer } else if (wdc_c->flags & AT_WRITE) {
1513 1.31 bouyer if (chp->ch_drive[xfer->drive].drive_flags & DRIVE_CAP32) {
1514 1.31 bouyer bus_space_write_multi_4(chp->data32iot, chp->data32ioh,
1515 1.31 bouyer 0, (u_int32_t*)data, bcount >> 2);
1516 1.31 bouyer data += bcount & 0xfffffffc;
1517 1.31 bouyer bcount = bcount & 0x03;
1518 1.31 bouyer }
1519 1.31 bouyer if (bcount > 0)
1520 1.31 bouyer bus_space_write_multi_2(chp->cmd_iot, chp->cmd_ioh,
1521 1.31 bouyer wd_data, (u_int16_t *)data, bcount >> 1);
1522 1.114 bouyer wdc_c->flags |= AT_XFDONE;
1523 1.114 bouyer if ((wdc_c->flags & AT_POLL) == 0) {
1524 1.114 bouyer chp->ch_flags |= WDCF_IRQ_WAIT; /* wait for interrupt */
1525 1.114 bouyer callout_reset(&chp->ch_callout,
1526 1.114 bouyer wdc_c->timeout / 1000 * hz, wdctimeout, chp);
1527 1.114 bouyer return 1;
1528 1.114 bouyer } else {
1529 1.114 bouyer goto again;
1530 1.114 bouyer }
1531 1.2 bouyer }
1532 1.31 bouyer __wdccommand_done(chp, xfer);
1533 1.31 bouyer return 1;
1534 1.2 bouyer }
1535 1.2 bouyer
1536 1.2 bouyer void
1537 1.31 bouyer __wdccommand_done(chp, xfer)
1538 1.31 bouyer struct channel_softc *chp;
1539 1.31 bouyer struct wdc_xfer *xfer;
1540 1.2 bouyer {
1541 1.31 bouyer struct wdc_command *wdc_c = xfer->cmd;
1542 1.2 bouyer
1543 1.34 bouyer WDCDEBUG_PRINT(("__wdccommand_done %s:%d:%d\n",
1544 1.34 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, xfer->drive), DEBUG_FUNCS);
1545 1.70 bouyer
1546 1.81 thorpej callout_stop(&chp->ch_callout);
1547 1.70 bouyer
1548 1.31 bouyer if (chp->ch_status & WDCS_DWF)
1549 1.31 bouyer wdc_c->flags |= AT_DF;
1550 1.31 bouyer if (chp->ch_status & WDCS_ERR) {
1551 1.31 bouyer wdc_c->flags |= AT_ERROR;
1552 1.31 bouyer wdc_c->r_error = chp->ch_error;
1553 1.31 bouyer }
1554 1.31 bouyer wdc_c->flags |= AT_DONE;
1555 1.80 enami if ((wdc_c->flags & AT_READREG) != 0 &&
1556 1.80 enami (chp->wdc->sc_dev.dv_flags & DVF_ACTIVE) != 0 &&
1557 1.75 enami (wdc_c->flags & (AT_ERROR | AT_DF)) == 0) {
1558 1.46 kenh wdc_c->r_head = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
1559 1.46 kenh wd_sdh);
1560 1.46 kenh wdc_c->r_cyl = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
1561 1.46 kenh wd_cyl_hi) << 8;
1562 1.46 kenh wdc_c->r_cyl |= bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
1563 1.46 kenh wd_cyl_lo);
1564 1.46 kenh wdc_c->r_sector = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
1565 1.46 kenh wd_sector);
1566 1.46 kenh wdc_c->r_count = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
1567 1.46 kenh wd_seccnt);
1568 1.46 kenh wdc_c->r_error = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
1569 1.46 kenh wd_error);
1570 1.46 kenh wdc_c->r_precomp = bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
1571 1.46 kenh wd_precomp);
1572 1.46 kenh }
1573 1.31 bouyer wdc_free_xfer(chp, xfer);
1574 1.71 bouyer if (wdc_c->flags & AT_WAIT)
1575 1.71 bouyer wakeup(wdc_c);
1576 1.71 bouyer else if (wdc_c->callback)
1577 1.71 bouyer wdc_c->callback(wdc_c->callback_arg);
1578 1.45 drochner wdcstart(chp);
1579 1.31 bouyer return;
1580 1.2 bouyer }
1581 1.2 bouyer
1582 1.2 bouyer /*
1583 1.31 bouyer * Send a command. The drive should be ready.
1584 1.2 bouyer * Assumes interrupts are blocked.
1585 1.2 bouyer */
1586 1.31 bouyer void
1587 1.31 bouyer wdccommand(chp, drive, command, cylin, head, sector, count, precomp)
1588 1.31 bouyer struct channel_softc *chp;
1589 1.31 bouyer u_int8_t drive;
1590 1.31 bouyer u_int8_t command;
1591 1.31 bouyer u_int16_t cylin;
1592 1.31 bouyer u_int8_t head, sector, count, precomp;
1593 1.31 bouyer {
1594 1.31 bouyer WDCDEBUG_PRINT(("wdccommand %s:%d:%d: command=0x%x cylin=%d head=%d "
1595 1.31 bouyer "sector=%d count=%d precomp=%d\n", chp->wdc->sc_dev.dv_xname,
1596 1.31 bouyer chp->channel, drive, command, cylin, head, sector, count, precomp),
1597 1.31 bouyer DEBUG_FUNCS);
1598 1.31 bouyer
1599 1.107 dbj if (chp->wdc->cap & WDC_CAPABILITY_SELECT)
1600 1.107 dbj chp->wdc->select(chp,drive);
1601 1.107 dbj
1602 1.31 bouyer /* Select drive, head, and addressing mode. */
1603 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
1604 1.31 bouyer WDSD_IBM | (drive << 4) | head);
1605 1.31 bouyer /* Load parameters. wd_features(ATA/ATAPI) = wd_precomp(ST506) */
1606 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_precomp,
1607 1.31 bouyer precomp);
1608 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_lo, cylin);
1609 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_cyl_hi, cylin >> 8);
1610 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sector, sector);
1611 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_seccnt, count);
1612 1.108 christos
1613 1.108 christos /* Send command. */
1614 1.108 christos bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_command, command);
1615 1.108 christos return;
1616 1.108 christos }
1617 1.108 christos
1618 1.108 christos /*
1619 1.108 christos * Send a 48-bit addressing command. The drive should be ready.
1620 1.108 christos * Assumes interrupts are blocked.
1621 1.108 christos */
1622 1.108 christos void
1623 1.108 christos wdccommandext(chp, drive, command, blkno, count)
1624 1.108 christos struct channel_softc *chp;
1625 1.108 christos u_int8_t drive;
1626 1.108 christos u_int8_t command;
1627 1.108 christos u_int64_t blkno;
1628 1.108 christos u_int16_t count;
1629 1.108 christos {
1630 1.108 christos WDCDEBUG_PRINT(("wdccommandext %s:%d:%d: command=0x%x blkno=%d "
1631 1.108 christos "count=%d\n", chp->wdc->sc_dev.dv_xname,
1632 1.108 christos chp->channel, drive, command, (u_int32_t) blkno, count),
1633 1.108 christos DEBUG_FUNCS);
1634 1.108 christos
1635 1.108 christos if (chp->wdc->cap & WDC_CAPABILITY_SELECT)
1636 1.108 christos chp->wdc->select(chp,drive);
1637 1.108 christos
1638 1.108 christos /* Select drive, head, and addressing mode. */
1639 1.108 christos bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
1640 1.108 christos (drive << 4) | WDSD_LBA);
1641 1.108 christos
1642 1.108 christos /* previous */
1643 1.108 christos bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_features, 0);
1644 1.108 christos bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_seccnt, count >> 8);
1645 1.108 christos bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_lba_hi, blkno >> 40);
1646 1.108 christos bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_lba_mi, blkno >> 32);
1647 1.108 christos bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_lba_lo, blkno >> 24);
1648 1.108 christos
1649 1.108 christos /* current */
1650 1.108 christos bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_features, 0);
1651 1.108 christos bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_seccnt, count);
1652 1.108 christos bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_lba_hi, blkno >> 16);
1653 1.108 christos bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_lba_mi, blkno >> 8);
1654 1.108 christos bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_lba_lo, blkno);
1655 1.2 bouyer
1656 1.31 bouyer /* Send command. */
1657 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_command, command);
1658 1.31 bouyer return;
1659 1.2 bouyer }
1660 1.2 bouyer
1661 1.2 bouyer /*
1662 1.31 bouyer * Simplified version of wdccommand(). Unbusy/ready/drq must be
1663 1.31 bouyer * tested by the caller.
1664 1.2 bouyer */
1665 1.31 bouyer void
1666 1.31 bouyer wdccommandshort(chp, drive, command)
1667 1.31 bouyer struct channel_softc *chp;
1668 1.31 bouyer int drive;
1669 1.31 bouyer int command;
1670 1.2 bouyer {
1671 1.2 bouyer
1672 1.31 bouyer WDCDEBUG_PRINT(("wdccommandshort %s:%d:%d command 0x%x\n",
1673 1.31 bouyer chp->wdc->sc_dev.dv_xname, chp->channel, drive, command),
1674 1.31 bouyer DEBUG_FUNCS);
1675 1.107 dbj
1676 1.107 dbj if (chp->wdc->cap & WDC_CAPABILITY_SELECT)
1677 1.107 dbj chp->wdc->select(chp,drive);
1678 1.2 bouyer
1679 1.31 bouyer /* Select drive. */
1680 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_sdh,
1681 1.31 bouyer WDSD_IBM | (drive << 4));
1682 1.2 bouyer
1683 1.31 bouyer bus_space_write_1(chp->cmd_iot, chp->cmd_ioh, wd_command, command);
1684 1.31 bouyer }
1685 1.2 bouyer
1686 1.31 bouyer /* Add a command to the queue and start controller. Must be called at splbio */
1687 1.2 bouyer
1688 1.2 bouyer void
1689 1.31 bouyer wdc_exec_xfer(chp, xfer)
1690 1.31 bouyer struct channel_softc *chp;
1691 1.2 bouyer struct wdc_xfer *xfer;
1692 1.2 bouyer {
1693 1.33 bouyer WDCDEBUG_PRINT(("wdc_exec_xfer %p channel %d drive %d\n", xfer,
1694 1.33 bouyer chp->channel, xfer->drive), DEBUG_XFERS);
1695 1.2 bouyer
1696 1.31 bouyer /* complete xfer setup */
1697 1.49 bouyer xfer->chp = chp;
1698 1.2 bouyer
1699 1.31 bouyer /*
1700 1.31 bouyer * If we are a polled command, and the list is not empty,
1701 1.31 bouyer * we are doing a dump. Drop the list to allow the polled command
1702 1.31 bouyer * to complete, we're going to reboot soon anyway.
1703 1.31 bouyer */
1704 1.31 bouyer if ((xfer->c_flags & C_POLL) != 0 &&
1705 1.31 bouyer chp->ch_queue->sc_xfer.tqh_first != NULL) {
1706 1.31 bouyer TAILQ_INIT(&chp->ch_queue->sc_xfer);
1707 1.31 bouyer }
1708 1.2 bouyer /* insert at the end of command list */
1709 1.31 bouyer TAILQ_INSERT_TAIL(&chp->ch_queue->sc_xfer,xfer , c_xferchain);
1710 1.31 bouyer WDCDEBUG_PRINT(("wdcstart from wdc_exec_xfer, flags 0x%x\n",
1711 1.33 bouyer chp->ch_flags), DEBUG_XFERS);
1712 1.45 drochner wdcstart(chp);
1713 1.31 bouyer }
1714 1.2 bouyer
1715 1.2 bouyer struct wdc_xfer *
1716 1.2 bouyer wdc_get_xfer(flags)
1717 1.2 bouyer int flags;
1718 1.2 bouyer {
1719 1.2 bouyer struct wdc_xfer *xfer;
1720 1.72 bouyer int s;
1721 1.2 bouyer
1722 1.72 bouyer s = splbio();
1723 1.71 bouyer xfer = pool_get(&wdc_xfer_pool,
1724 1.71 bouyer ((flags & WDC_NOSLEEP) != 0 ? PR_NOWAIT : PR_WAITOK));
1725 1.72 bouyer splx(s);
1726 1.99 chs if (xfer != NULL) {
1727 1.99 chs memset(xfer, 0, sizeof(struct wdc_xfer));
1728 1.99 chs }
1729 1.2 bouyer return xfer;
1730 1.2 bouyer }
1731 1.2 bouyer
1732 1.2 bouyer void
1733 1.31 bouyer wdc_free_xfer(chp, xfer)
1734 1.31 bouyer struct channel_softc *chp;
1735 1.2 bouyer struct wdc_xfer *xfer;
1736 1.2 bouyer {
1737 1.31 bouyer struct wdc_softc *wdc = chp->wdc;
1738 1.2 bouyer int s;
1739 1.2 bouyer
1740 1.31 bouyer if (wdc->cap & WDC_CAPABILITY_HWLOCK)
1741 1.31 bouyer (*wdc->free_hw)(chp);
1742 1.2 bouyer s = splbio();
1743 1.31 bouyer chp->ch_flags &= ~WDCF_ACTIVE;
1744 1.31 bouyer TAILQ_REMOVE(&chp->ch_queue->sc_xfer, xfer, c_xferchain);
1745 1.72 bouyer pool_put(&wdc_xfer_pool, xfer);
1746 1.2 bouyer splx(s);
1747 1.75 enami }
1748 1.75 enami
1749 1.75 enami /*
1750 1.75 enami * Kill off all pending xfers for a channel_softc.
1751 1.75 enami *
1752 1.75 enami * Must be called at splbio().
1753 1.75 enami */
1754 1.75 enami void
1755 1.75 enami wdc_kill_pending(chp)
1756 1.75 enami struct channel_softc *chp;
1757 1.75 enami {
1758 1.75 enami struct wdc_xfer *xfer;
1759 1.75 enami
1760 1.75 enami while ((xfer = TAILQ_FIRST(&chp->ch_queue->sc_xfer)) != NULL) {
1761 1.75 enami chp = xfer->chp;
1762 1.75 enami (*xfer->c_kill_xfer)(chp, xfer);
1763 1.75 enami }
1764 1.2 bouyer }
1765 1.2 bouyer
1766 1.31 bouyer static void
1767 1.31 bouyer __wdcerror(chp, msg)
1768 1.31 bouyer struct channel_softc *chp;
1769 1.2 bouyer char *msg;
1770 1.2 bouyer {
1771 1.31 bouyer struct wdc_xfer *xfer = chp->ch_queue->sc_xfer.tqh_first;
1772 1.88 mrg
1773 1.2 bouyer if (xfer == NULL)
1774 1.31 bouyer printf("%s:%d: %s\n", chp->wdc->sc_dev.dv_xname, chp->channel,
1775 1.31 bouyer msg);
1776 1.2 bouyer else
1777 1.31 bouyer printf("%s:%d:%d: %s\n", chp->wdc->sc_dev.dv_xname,
1778 1.49 bouyer chp->channel, xfer->drive, msg);
1779 1.2 bouyer }
1780 1.2 bouyer
1781 1.2 bouyer /*
1782 1.2 bouyer * the bit bucket
1783 1.2 bouyer */
1784 1.2 bouyer void
1785 1.31 bouyer wdcbit_bucket(chp, size)
1786 1.31 bouyer struct channel_softc *chp;
1787 1.2 bouyer int size;
1788 1.2 bouyer {
1789 1.2 bouyer
1790 1.12 cgd for (; size >= 2; size -= 2)
1791 1.31 bouyer (void)bus_space_read_2(chp->cmd_iot, chp->cmd_ioh, wd_data);
1792 1.12 cgd if (size)
1793 1.31 bouyer (void)bus_space_read_1(chp->cmd_iot, chp->cmd_ioh, wd_data);
1794 1.44 thorpej }
1795 1.44 thorpej
1796 1.44 thorpej int
1797 1.44 thorpej wdc_addref(chp)
1798 1.44 thorpej struct channel_softc *chp;
1799 1.44 thorpej {
1800 1.44 thorpej struct wdc_softc *wdc = chp->wdc;
1801 1.96 bouyer struct scsipi_adapter *adapt = &wdc->sc_atapi_adapter._generic;
1802 1.44 thorpej int s, error = 0;
1803 1.44 thorpej
1804 1.44 thorpej s = splbio();
1805 1.96 bouyer if (adapt->adapt_refcnt++ == 0 &&
1806 1.96 bouyer adapt->adapt_enable != NULL) {
1807 1.96 bouyer error = (*adapt->adapt_enable)(&wdc->sc_dev, 1);
1808 1.44 thorpej if (error)
1809 1.96 bouyer adapt->adapt_refcnt--;
1810 1.44 thorpej }
1811 1.44 thorpej splx(s);
1812 1.44 thorpej return (error);
1813 1.44 thorpej }
1814 1.44 thorpej
1815 1.44 thorpej void
1816 1.44 thorpej wdc_delref(chp)
1817 1.44 thorpej struct channel_softc *chp;
1818 1.44 thorpej {
1819 1.44 thorpej struct wdc_softc *wdc = chp->wdc;
1820 1.96 bouyer struct scsipi_adapter *adapt = &wdc->sc_atapi_adapter._generic;
1821 1.44 thorpej int s;
1822 1.44 thorpej
1823 1.44 thorpej s = splbio();
1824 1.96 bouyer if (adapt->adapt_refcnt-- == 1 &&
1825 1.96 bouyer adapt->adapt_enable != NULL)
1826 1.96 bouyer (void) (*adapt->adapt_enable)(&wdc->sc_dev, 0);
1827 1.44 thorpej splx(s);
1828 1.93 wrstuden }
1829 1.93 wrstuden
1830 1.93 wrstuden void
1831 1.93 wrstuden wdc_print_modes(struct channel_softc *chp)
1832 1.93 wrstuden {
1833 1.93 wrstuden int drive;
1834 1.93 wrstuden struct ata_drive_datas *drvp;
1835 1.93 wrstuden
1836 1.93 wrstuden for (drive = 0; drive < 2; drive++) {
1837 1.93 wrstuden drvp = &chp->ch_drive[drive];
1838 1.93 wrstuden if ((drvp->drive_flags & DRIVE) == 0)
1839 1.93 wrstuden continue;
1840 1.123 thorpej aprint_normal("%s(%s:%d:%d): using PIO mode %d",
1841 1.93 wrstuden drvp->drv_softc->dv_xname,
1842 1.93 wrstuden chp->wdc->sc_dev.dv_xname,
1843 1.93 wrstuden chp->channel, drive, drvp->PIO_mode);
1844 1.93 wrstuden if (drvp->drive_flags & DRIVE_DMA)
1845 1.123 thorpej aprint_normal(", DMA mode %d", drvp->DMA_mode);
1846 1.93 wrstuden if (drvp->drive_flags & DRIVE_UDMA) {
1847 1.123 thorpej aprint_normal(", Ultra-DMA mode %d", drvp->UDMA_mode);
1848 1.93 wrstuden if (drvp->UDMA_mode == 2)
1849 1.123 thorpej aprint_normal(" (Ultra/33)");
1850 1.93 wrstuden else if (drvp->UDMA_mode == 4)
1851 1.123 thorpej aprint_normal(" (Ultra/66)");
1852 1.93 wrstuden else if (drvp->UDMA_mode == 5)
1853 1.123 thorpej aprint_normal(" (Ultra/100)");
1854 1.123 thorpej else if (drvp->UDMA_mode == 6)
1855 1.123 thorpej aprint_normal(" (Ultra/133)");
1856 1.93 wrstuden }
1857 1.93 wrstuden if (drvp->drive_flags & (DRIVE_DMA | DRIVE_UDMA))
1858 1.123 thorpej aprint_normal(" (using DMA data transfers)");
1859 1.123 thorpej aprint_normal("\n");
1860 1.93 wrstuden }
1861 1.2 bouyer }
1862