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