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