ata.c revision 1.79 1 1.79 christos /* $NetBSD: ata.c,v 1.79 2006/10/12 01:30:55 christos Exp $ */
2 1.21 thorpej
3 1.2 bouyer /*
4 1.16 bouyer * Copyright (c) 1998, 2001 Manuel Bouyer. All rights reserved.
5 1.2 bouyer *
6 1.2 bouyer * Redistribution and use in source and binary forms, with or without
7 1.2 bouyer * modification, are permitted provided that the following conditions
8 1.2 bouyer * are met:
9 1.2 bouyer * 1. Redistributions of source code must retain the above copyright
10 1.2 bouyer * notice, this list of conditions and the following disclaimer.
11 1.2 bouyer * 2. Redistributions in binary form must reproduce the above copyright
12 1.2 bouyer * notice, this list of conditions and the following disclaimer in the
13 1.2 bouyer * documentation and/or other materials provided with the distribution.
14 1.2 bouyer * 3. All advertising materials mentioning features or use of this software
15 1.2 bouyer * must display the following acknowledgement:
16 1.2 bouyer * This product includes software developed by Manuel Bouyer.
17 1.2 bouyer * 4. The name of the author may not be used to endorse or promote products
18 1.2 bouyer * derived from this software without specific prior written permission.
19 1.2 bouyer *
20 1.2 bouyer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 1.2 bouyer * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22 1.2 bouyer * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23 1.65 perry * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 1.2 bouyer * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 1.2 bouyer * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 1.2 bouyer * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27 1.2 bouyer * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 1.2 bouyer * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 1.2 bouyer * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 1.2 bouyer */
31 1.14 lukem
32 1.14 lukem #include <sys/cdefs.h>
33 1.79 christos __KERNEL_RCSID(0, "$NetBSD: ata.c,v 1.79 2006/10/12 01:30:55 christos Exp $");
34 1.2 bouyer
35 1.47 thorpej #ifndef ATADEBUG
36 1.47 thorpej #define ATADEBUG
37 1.47 thorpej #endif /* ATADEBUG */
38 1.2 bouyer
39 1.2 bouyer #include <sys/param.h>
40 1.2 bouyer #include <sys/systm.h>
41 1.2 bouyer #include <sys/kernel.h>
42 1.2 bouyer #include <sys/malloc.h>
43 1.2 bouyer #include <sys/device.h>
44 1.30 bouyer #include <sys/conf.h>
45 1.30 bouyer #include <sys/fcntl.h>
46 1.23 thorpej #include <sys/proc.h>
47 1.41 thorpej #include <sys/pool.h>
48 1.23 thorpej #include <sys/kthread.h>
49 1.23 thorpej #include <sys/errno.h>
50 1.30 bouyer #include <sys/ataio.h>
51 1.2 bouyer
52 1.15 bouyer #include <machine/intr.h>
53 1.15 bouyer #include <machine/bus.h>
54 1.15 bouyer
55 1.76 itohy #include <dev/ata/ataconf.h>
56 1.2 bouyer #include <dev/ata/atareg.h>
57 1.2 bouyer #include <dev/ata/atavar.h>
58 1.76 itohy #include <dev/ic/wdcvar.h> /* for PIOBM */
59 1.2 bouyer
60 1.23 thorpej #include "locators.h"
61 1.23 thorpej
62 1.51 thorpej #include "atapibus.h"
63 1.51 thorpej #include "ataraid.h"
64 1.51 thorpej
65 1.65 perry #if NATARAID > 0
66 1.65 perry #include <dev/ata/ata_raidvar.h>
67 1.51 thorpej #endif
68 1.51 thorpej
69 1.2 bouyer #define DEBUG_FUNCS 0x08
70 1.2 bouyer #define DEBUG_PROBE 0x10
71 1.23 thorpej #define DEBUG_DETACH 0x20
72 1.44 thorpej #define DEBUG_XFERS 0x40
73 1.47 thorpej #ifdef ATADEBUG
74 1.47 thorpej int atadebug_mask = 0;
75 1.47 thorpej #define ATADEBUG_PRINT(args, level) \
76 1.47 thorpej if (atadebug_mask & (level)) \
77 1.2 bouyer printf args
78 1.2 bouyer #else
79 1.47 thorpej #define ATADEBUG_PRINT(args, level)
80 1.2 bouyer #endif
81 1.2 bouyer
82 1.41 thorpej POOL_INIT(ata_xfer_pool, sizeof(struct ata_xfer), 0, 0, 0, "ataspl", NULL);
83 1.41 thorpej
84 1.51 thorpej /*
85 1.51 thorpej * A queue of atabus instances, used to ensure the same bus probe order
86 1.51 thorpej * for a given hardware configuration at each boot.
87 1.51 thorpej */
88 1.51 thorpej struct atabus_initq_head atabus_initq_head =
89 1.51 thorpej TAILQ_HEAD_INITIALIZER(atabus_initq_head);
90 1.51 thorpej struct simplelock atabus_interlock = SIMPLELOCK_INITIALIZER;
91 1.51 thorpej
92 1.23 thorpej /*****************************************************************************
93 1.23 thorpej * ATA bus layer.
94 1.23 thorpej *
95 1.23 thorpej * ATA controllers attach an atabus instance, which handles probing the bus
96 1.23 thorpej * for drives, etc.
97 1.23 thorpej *****************************************************************************/
98 1.23 thorpej
99 1.30 bouyer dev_type_open(atabusopen);
100 1.30 bouyer dev_type_close(atabusclose);
101 1.30 bouyer dev_type_ioctl(atabusioctl);
102 1.30 bouyer
103 1.30 bouyer const struct cdevsw atabus_cdevsw = {
104 1.30 bouyer atabusopen, atabusclose, noread, nowrite, atabusioctl,
105 1.75 christos nostop, notty, nopoll, nommap, nokqfilter, D_OTHER
106 1.30 bouyer };
107 1.30 bouyer
108 1.30 bouyer extern struct cfdriver atabus_cd;
109 1.30 bouyer
110 1.64 jmcneill static void atabus_powerhook(int, void *);
111 1.30 bouyer
112 1.23 thorpej /*
113 1.23 thorpej * atabusprint:
114 1.23 thorpej *
115 1.23 thorpej * Autoconfiguration print routine used by ATA controllers when
116 1.23 thorpej * attaching an atabus instance.
117 1.23 thorpej */
118 1.23 thorpej int
119 1.23 thorpej atabusprint(void *aux, const char *pnp)
120 1.23 thorpej {
121 1.48 thorpej struct ata_channel *chan = aux;
122 1.65 perry
123 1.23 thorpej if (pnp)
124 1.23 thorpej aprint_normal("atabus at %s", pnp);
125 1.26 thorpej aprint_normal(" channel %d", chan->ch_channel);
126 1.23 thorpej
127 1.23 thorpej return (UNCONF);
128 1.23 thorpej }
129 1.23 thorpej
130 1.23 thorpej /*
131 1.23 thorpej * ataprint:
132 1.23 thorpej *
133 1.23 thorpej * Autoconfiguration print routine.
134 1.23 thorpej */
135 1.23 thorpej int
136 1.23 thorpej ataprint(void *aux, const char *pnp)
137 1.23 thorpej {
138 1.23 thorpej struct ata_device *adev = aux;
139 1.23 thorpej
140 1.23 thorpej if (pnp)
141 1.23 thorpej aprint_normal("wd at %s", pnp);
142 1.23 thorpej aprint_normal(" drive %d", adev->adev_drv_data->drive);
143 1.23 thorpej
144 1.23 thorpej return (UNCONF);
145 1.23 thorpej }
146 1.23 thorpej
147 1.52 thorpej /*
148 1.52 thorpej * ata_channel_attach:
149 1.52 thorpej *
150 1.52 thorpej * Common parts of attaching an atabus to an ATA controller channel.
151 1.52 thorpej */
152 1.52 thorpej void
153 1.52 thorpej ata_channel_attach(struct ata_channel *chp)
154 1.52 thorpej {
155 1.52 thorpej
156 1.52 thorpej if (chp->ch_flags & ATACH_DISABLED)
157 1.52 thorpej return;
158 1.65 perry
159 1.52 thorpej callout_init(&chp->ch_callout);
160 1.52 thorpej
161 1.52 thorpej TAILQ_INIT(&chp->ch_queue->queue_xfer);
162 1.52 thorpej chp->ch_queue->queue_freeze = 0;
163 1.68 bouyer chp->ch_queue->queue_flags = 0;
164 1.52 thorpej chp->ch_queue->active_xfer = NULL;
165 1.52 thorpej
166 1.71 drochner chp->atabus = config_found_ia(&chp->ch_atac->atac_dev, "ata", chp,
167 1.71 drochner atabusprint);
168 1.52 thorpej }
169 1.52 thorpej
170 1.51 thorpej static void
171 1.51 thorpej atabusconfig(struct atabus_softc *atabus_sc)
172 1.51 thorpej {
173 1.51 thorpej struct ata_channel *chp = atabus_sc->sc_chan;
174 1.51 thorpej struct atac_softc *atac = chp->ch_atac;
175 1.58 thorpej int i, s;
176 1.51 thorpej struct atabus_initq *atabus_initq = NULL;
177 1.51 thorpej
178 1.51 thorpej /* Probe for the drives. */
179 1.51 thorpej (*atac->atac_probe)(chp);
180 1.51 thorpej
181 1.51 thorpej ATADEBUG_PRINT(("atabusattach: ch_drive_flags 0x%x 0x%x\n",
182 1.51 thorpej chp->ch_drive[0].drive_flags, chp->ch_drive[1].drive_flags),
183 1.51 thorpej DEBUG_PROBE);
184 1.51 thorpej
185 1.51 thorpej /* If no drives, abort here */
186 1.51 thorpej for (i = 0; i < chp->ch_ndrive; i++)
187 1.51 thorpej if ((chp->ch_drive[i].drive_flags & DRIVE) != 0)
188 1.51 thorpej break;
189 1.51 thorpej if (i == chp->ch_ndrive)
190 1.51 thorpej goto out;
191 1.51 thorpej
192 1.51 thorpej /* Shortcut in case we've been shutdown */
193 1.51 thorpej if (chp->ch_flags & ATACH_SHUTDOWN)
194 1.51 thorpej goto out;
195 1.51 thorpej
196 1.51 thorpej /* Make sure the devices probe in atabus order to avoid jitter. */
197 1.51 thorpej simple_lock(&atabus_interlock);
198 1.51 thorpej while(1) {
199 1.51 thorpej atabus_initq = TAILQ_FIRST(&atabus_initq_head);
200 1.51 thorpej if (atabus_initq->atabus_sc == atabus_sc)
201 1.51 thorpej break;
202 1.51 thorpej ltsleep(&atabus_initq_head, PRIBIO, "ata_initq", 0,
203 1.51 thorpej &atabus_interlock);
204 1.51 thorpej }
205 1.51 thorpej simple_unlock(&atabus_interlock);
206 1.51 thorpej
207 1.51 thorpej /*
208 1.51 thorpej * Attach an ATAPI bus, if needed.
209 1.51 thorpej */
210 1.51 thorpej for (i = 0; i < chp->ch_ndrive; i++) {
211 1.51 thorpej if (chp->ch_drive[i].drive_flags & DRIVE_ATAPI) {
212 1.51 thorpej #if NATAPIBUS > 0
213 1.51 thorpej (*atac->atac_atapibus_attach)(atabus_sc);
214 1.51 thorpej #else
215 1.51 thorpej /*
216 1.51 thorpej * Fake the autoconfig "not configured" message
217 1.51 thorpej */
218 1.51 thorpej aprint_normal("atapibus at %s not configured\n",
219 1.51 thorpej atac->atac_dev.dv_xname);
220 1.51 thorpej chp->atapibus = NULL;
221 1.58 thorpej s = splbio();
222 1.51 thorpej for (i = 0; i < chp->ch_ndrive; i++)
223 1.51 thorpej chp->ch_drive[i].drive_flags &= ~DRIVE_ATAPI;
224 1.58 thorpej splx(s);
225 1.51 thorpej #endif
226 1.51 thorpej break;
227 1.51 thorpej }
228 1.51 thorpej }
229 1.51 thorpej
230 1.51 thorpej for (i = 0; i < chp->ch_ndrive; i++) {
231 1.51 thorpej struct ata_device adev;
232 1.51 thorpej if ((chp->ch_drive[i].drive_flags &
233 1.51 thorpej (DRIVE_ATA | DRIVE_OLD)) == 0) {
234 1.51 thorpej continue;
235 1.51 thorpej }
236 1.51 thorpej memset(&adev, 0, sizeof(struct ata_device));
237 1.51 thorpej adev.adev_bustype = atac->atac_bustype_ata;
238 1.51 thorpej adev.adev_channel = chp->ch_channel;
239 1.51 thorpej adev.adev_openings = 1;
240 1.51 thorpej adev.adev_drv_data = &chp->ch_drive[i];
241 1.71 drochner chp->ata_drives[i] = config_found_ia(&atabus_sc->sc_dev,
242 1.71 drochner "ata_hl", &adev, ataprint);
243 1.51 thorpej if (chp->ata_drives[i] != NULL)
244 1.51 thorpej ata_probe_caps(&chp->ch_drive[i]);
245 1.58 thorpej else {
246 1.58 thorpej s = splbio();
247 1.51 thorpej chp->ch_drive[i].drive_flags &=
248 1.51 thorpej ~(DRIVE_ATA | DRIVE_OLD);
249 1.58 thorpej splx(s);
250 1.58 thorpej }
251 1.51 thorpej }
252 1.51 thorpej
253 1.51 thorpej /* now that we know the drives, the controller can set its modes */
254 1.51 thorpej if (atac->atac_set_modes) {
255 1.51 thorpej (*atac->atac_set_modes)(chp);
256 1.51 thorpej ata_print_modes(chp);
257 1.51 thorpej }
258 1.51 thorpej #if NATARAID > 0
259 1.51 thorpej if (atac->atac_cap & ATAC_CAP_RAID)
260 1.51 thorpej for (i = 0; i < chp->ch_ndrive; i++)
261 1.51 thorpej if (chp->ata_drives[i] != NULL)
262 1.51 thorpej ata_raid_check_component(chp->ata_drives[i]);
263 1.51 thorpej #endif /* NATARAID > 0 */
264 1.51 thorpej
265 1.51 thorpej /*
266 1.51 thorpej * reset drive_flags for unattached devices, reset state for attached
267 1.51 thorpej * ones
268 1.51 thorpej */
269 1.58 thorpej s = splbio();
270 1.51 thorpej for (i = 0; i < chp->ch_ndrive; i++) {
271 1.51 thorpej if (chp->ch_drive[i].drv_softc == NULL)
272 1.51 thorpej chp->ch_drive[i].drive_flags = 0;
273 1.51 thorpej else
274 1.51 thorpej chp->ch_drive[i].state = 0;
275 1.51 thorpej }
276 1.58 thorpej splx(s);
277 1.51 thorpej
278 1.51 thorpej out:
279 1.51 thorpej if (atabus_initq == NULL) {
280 1.51 thorpej simple_lock(&atabus_interlock);
281 1.51 thorpej while(1) {
282 1.51 thorpej atabus_initq = TAILQ_FIRST(&atabus_initq_head);
283 1.51 thorpej if (atabus_initq->atabus_sc == atabus_sc)
284 1.51 thorpej break;
285 1.51 thorpej ltsleep(&atabus_initq_head, PRIBIO, "ata_initq", 0,
286 1.51 thorpej &atabus_interlock);
287 1.51 thorpej }
288 1.51 thorpej simple_unlock(&atabus_interlock);
289 1.51 thorpej }
290 1.51 thorpej simple_lock(&atabus_interlock);
291 1.51 thorpej TAILQ_REMOVE(&atabus_initq_head, atabus_initq, atabus_initq);
292 1.51 thorpej simple_unlock(&atabus_interlock);
293 1.51 thorpej
294 1.51 thorpej free(atabus_initq, M_DEVBUF);
295 1.51 thorpej wakeup(&atabus_initq_head);
296 1.51 thorpej
297 1.51 thorpej ata_delref(chp);
298 1.51 thorpej
299 1.51 thorpej config_pending_decr();
300 1.51 thorpej }
301 1.51 thorpej
302 1.23 thorpej /*
303 1.23 thorpej * atabus_thread:
304 1.23 thorpej *
305 1.23 thorpej * Worker thread for the ATA bus.
306 1.23 thorpej */
307 1.23 thorpej static void
308 1.23 thorpej atabus_thread(void *arg)
309 1.23 thorpej {
310 1.23 thorpej struct atabus_softc *sc = arg;
311 1.48 thorpej struct ata_channel *chp = sc->sc_chan;
312 1.24 thorpej struct ata_xfer *xfer;
313 1.48 thorpej int i, s;
314 1.23 thorpej
315 1.23 thorpej s = splbio();
316 1.48 thorpej chp->ch_flags |= ATACH_TH_RUN;
317 1.48 thorpej
318 1.48 thorpej /*
319 1.48 thorpej * Probe the drives. Reset all flags to 0 to indicate to controllers
320 1.48 thorpej * that can re-probe that all drives must be probed..
321 1.48 thorpej *
322 1.48 thorpej * Note: ch_ndrive may be changed during the probe.
323 1.48 thorpej */
324 1.48 thorpej for (i = 0; i < ATA_MAXDRIVES; i++)
325 1.48 thorpej chp->ch_drive[i].drive_flags = 0;
326 1.23 thorpej splx(s);
327 1.23 thorpej
328 1.23 thorpej /* Configure the devices on the bus. */
329 1.68 bouyer atabusconfig(sc);
330 1.23 thorpej
331 1.69 bouyer s = splbio();
332 1.23 thorpej for (;;) {
333 1.48 thorpej if ((chp->ch_flags & (ATACH_TH_RESET | ATACH_SHUTDOWN)) == 0 &&
334 1.33 bouyer (chp->ch_queue->active_xfer == NULL ||
335 1.23 thorpej chp->ch_queue->queue_freeze == 0)) {
336 1.48 thorpej chp->ch_flags &= ~ATACH_TH_RUN;
337 1.27 thorpej (void) tsleep(&chp->ch_thread, PRIBIO, "atath", 0);
338 1.48 thorpej chp->ch_flags |= ATACH_TH_RUN;
339 1.23 thorpej }
340 1.59 thorpej if (chp->ch_flags & ATACH_SHUTDOWN) {
341 1.23 thorpej break;
342 1.59 thorpej }
343 1.48 thorpej if (chp->ch_flags & ATACH_TH_RESET) {
344 1.31 bouyer /*
345 1.55 thorpej * ata_reset_channel() will freeze 2 times, so
346 1.31 bouyer * unfreeze one time. Not a problem as we're at splbio
347 1.31 bouyer */
348 1.23 thorpej chp->ch_queue->queue_freeze--;
349 1.55 thorpej ata_reset_channel(chp, AT_WAIT | chp->ch_reset_flags);
350 1.33 bouyer } else if (chp->ch_queue->active_xfer != NULL &&
351 1.23 thorpej chp->ch_queue->queue_freeze == 1) {
352 1.23 thorpej /*
353 1.23 thorpej * Caller has bumped queue_freeze, decrease it.
354 1.23 thorpej */
355 1.23 thorpej chp->ch_queue->queue_freeze--;
356 1.33 bouyer xfer = chp->ch_queue->active_xfer;
357 1.23 thorpej KASSERT(xfer != NULL);
358 1.61 bouyer (*xfer->c_start)(xfer->c_chp, xfer);
359 1.23 thorpej } else if (chp->ch_queue->queue_freeze > 1)
360 1.23 thorpej panic("ata_thread: queue_freeze");
361 1.23 thorpej }
362 1.69 bouyer splx(s);
363 1.27 thorpej chp->ch_thread = NULL;
364 1.70 christos wakeup(&chp->ch_flags);
365 1.23 thorpej kthread_exit(0);
366 1.23 thorpej }
367 1.23 thorpej
368 1.23 thorpej /*
369 1.23 thorpej * atabus_create_thread:
370 1.23 thorpej *
371 1.23 thorpej * Helper routine to create the ATA bus worker thread.
372 1.23 thorpej */
373 1.23 thorpej static void
374 1.23 thorpej atabus_create_thread(void *arg)
375 1.23 thorpej {
376 1.23 thorpej struct atabus_softc *sc = arg;
377 1.48 thorpej struct ata_channel *chp = sc->sc_chan;
378 1.23 thorpej int error;
379 1.23 thorpej
380 1.27 thorpej if ((error = kthread_create1(atabus_thread, sc, &chp->ch_thread,
381 1.23 thorpej "%s", sc->sc_dev.dv_xname)) != 0)
382 1.23 thorpej aprint_error("%s: unable to create kernel thread: error %d\n",
383 1.23 thorpej sc->sc_dev.dv_xname, error);
384 1.23 thorpej }
385 1.23 thorpej
386 1.23 thorpej /*
387 1.23 thorpej * atabus_match:
388 1.23 thorpej *
389 1.23 thorpej * Autoconfiguration match routine.
390 1.23 thorpej */
391 1.23 thorpej static int
392 1.79 christos atabus_match(struct device *parent __unused, struct cfdata *cf, void *aux)
393 1.23 thorpej {
394 1.48 thorpej struct ata_channel *chp = aux;
395 1.23 thorpej
396 1.23 thorpej if (chp == NULL)
397 1.23 thorpej return (0);
398 1.65 perry
399 1.26 thorpej if (cf->cf_loc[ATACF_CHANNEL] != chp->ch_channel &&
400 1.23 thorpej cf->cf_loc[ATACF_CHANNEL] != ATACF_CHANNEL_DEFAULT)
401 1.23 thorpej return (0);
402 1.65 perry
403 1.23 thorpej return (1);
404 1.23 thorpej }
405 1.23 thorpej
406 1.23 thorpej /*
407 1.23 thorpej * atabus_attach:
408 1.23 thorpej *
409 1.23 thorpej * Autoconfiguration attach routine.
410 1.23 thorpej */
411 1.23 thorpej static void
412 1.79 christos atabus_attach(struct device *parent __unused, struct device *self, void *aux)
413 1.23 thorpej {
414 1.23 thorpej struct atabus_softc *sc = (void *) self;
415 1.48 thorpej struct ata_channel *chp = aux;
416 1.23 thorpej struct atabus_initq *initq;
417 1.23 thorpej
418 1.23 thorpej sc->sc_chan = chp;
419 1.23 thorpej
420 1.23 thorpej aprint_normal("\n");
421 1.23 thorpej aprint_naive("\n");
422 1.23 thorpej
423 1.43 thorpej if (ata_addref(chp))
424 1.35 mycroft return;
425 1.35 mycroft
426 1.23 thorpej initq = malloc(sizeof(*initq), M_DEVBUF, M_WAITOK);
427 1.23 thorpej initq->atabus_sc = sc;
428 1.23 thorpej TAILQ_INSERT_TAIL(&atabus_initq_head, initq, atabus_initq);
429 1.23 thorpej config_pending_incr();
430 1.23 thorpej kthread_create(atabus_create_thread, sc);
431 1.64 jmcneill
432 1.77 jmcneill sc->sc_powerhook = powerhook_establish(sc->sc_dev.dv_xname,
433 1.77 jmcneill atabus_powerhook, sc);
434 1.64 jmcneill if (sc->sc_powerhook == NULL)
435 1.64 jmcneill printf("%s: WARNING: unable to establish power hook\n",
436 1.64 jmcneill sc->sc_dev.dv_xname);
437 1.23 thorpej }
438 1.23 thorpej
439 1.23 thorpej /*
440 1.23 thorpej * atabus_activate:
441 1.23 thorpej *
442 1.23 thorpej * Autoconfiguration activation routine.
443 1.23 thorpej */
444 1.23 thorpej static int
445 1.23 thorpej atabus_activate(struct device *self, enum devact act)
446 1.23 thorpej {
447 1.23 thorpej struct atabus_softc *sc = (void *) self;
448 1.48 thorpej struct ata_channel *chp = sc->sc_chan;
449 1.23 thorpej struct device *dev = NULL;
450 1.23 thorpej int s, i, error = 0;
451 1.23 thorpej
452 1.23 thorpej s = splbio();
453 1.23 thorpej switch (act) {
454 1.23 thorpej case DVACT_ACTIVATE:
455 1.23 thorpej error = EOPNOTSUPP;
456 1.23 thorpej break;
457 1.65 perry
458 1.23 thorpej case DVACT_DEACTIVATE:
459 1.23 thorpej /*
460 1.23 thorpej * We might deactivate the children of atapibus twice
461 1.23 thorpej * (once bia atapibus, once directly), but since the
462 1.23 thorpej * generic autoconfiguration code maintains the DVF_ACTIVE
463 1.23 thorpej * flag, it's safe.
464 1.23 thorpej */
465 1.23 thorpej if ((dev = chp->atapibus) != NULL) {
466 1.23 thorpej error = config_deactivate(dev);
467 1.23 thorpej if (error)
468 1.23 thorpej goto out;
469 1.23 thorpej }
470 1.23 thorpej
471 1.48 thorpej for (i = 0; i < chp->ch_ndrive; i++) {
472 1.23 thorpej if ((dev = chp->ch_drive[i].drv_softc) != NULL) {
473 1.47 thorpej ATADEBUG_PRINT(("atabus_activate: %s: "
474 1.23 thorpej "deactivating %s\n", sc->sc_dev.dv_xname,
475 1.23 thorpej dev->dv_xname),
476 1.23 thorpej DEBUG_DETACH);
477 1.23 thorpej error = config_deactivate(dev);
478 1.23 thorpej if (error)
479 1.23 thorpej goto out;
480 1.23 thorpej }
481 1.23 thorpej }
482 1.23 thorpej break;
483 1.23 thorpej }
484 1.23 thorpej out:
485 1.23 thorpej splx(s);
486 1.23 thorpej
487 1.47 thorpej #ifdef ATADEBUG
488 1.23 thorpej if (dev != NULL && error != 0)
489 1.47 thorpej ATADEBUG_PRINT(("atabus_activate: %s: "
490 1.23 thorpej "error %d deactivating %s\n", sc->sc_dev.dv_xname,
491 1.23 thorpej error, dev->dv_xname), DEBUG_DETACH);
492 1.47 thorpej #endif /* ATADEBUG */
493 1.23 thorpej
494 1.23 thorpej return (error);
495 1.23 thorpej }
496 1.23 thorpej
497 1.23 thorpej /*
498 1.23 thorpej * atabus_detach:
499 1.23 thorpej *
500 1.23 thorpej * Autoconfiguration detach routine.
501 1.23 thorpej */
502 1.23 thorpej static int
503 1.23 thorpej atabus_detach(struct device *self, int flags)
504 1.23 thorpej {
505 1.23 thorpej struct atabus_softc *sc = (void *) self;
506 1.48 thorpej struct ata_channel *chp = sc->sc_chan;
507 1.23 thorpej struct device *dev = NULL;
508 1.57 thorpej int s, i, error = 0;
509 1.23 thorpej
510 1.23 thorpej /* Shutdown the channel. */
511 1.57 thorpej s = splbio(); /* XXX ALSO NEED AN INTERLOCK HERE. */
512 1.48 thorpej chp->ch_flags |= ATACH_SHUTDOWN;
513 1.57 thorpej splx(s);
514 1.27 thorpej wakeup(&chp->ch_thread);
515 1.27 thorpej while (chp->ch_thread != NULL)
516 1.70 christos (void) tsleep(&chp->ch_flags, PRIBIO, "atadown", 0);
517 1.65 perry
518 1.66 tacha /* power hook */
519 1.66 tacha if (sc->sc_powerhook)
520 1.66 tacha powerhook_disestablish(sc->sc_powerhook);
521 1.66 tacha
522 1.23 thorpej /*
523 1.23 thorpej * Detach atapibus and its children.
524 1.23 thorpej */
525 1.23 thorpej if ((dev = chp->atapibus) != NULL) {
526 1.47 thorpej ATADEBUG_PRINT(("atabus_detach: %s: detaching %s\n",
527 1.23 thorpej sc->sc_dev.dv_xname, dev->dv_xname), DEBUG_DETACH);
528 1.23 thorpej error = config_detach(dev, flags);
529 1.23 thorpej if (error)
530 1.23 thorpej goto out;
531 1.23 thorpej }
532 1.23 thorpej
533 1.23 thorpej /*
534 1.23 thorpej * Detach our other children.
535 1.23 thorpej */
536 1.48 thorpej for (i = 0; i < chp->ch_ndrive; i++) {
537 1.23 thorpej if (chp->ch_drive[i].drive_flags & DRIVE_ATAPI)
538 1.23 thorpej continue;
539 1.23 thorpej if ((dev = chp->ch_drive[i].drv_softc) != NULL) {
540 1.47 thorpej ATADEBUG_PRINT(("atabus_detach: %s: detaching %s\n",
541 1.23 thorpej sc->sc_dev.dv_xname, dev->dv_xname),
542 1.23 thorpej DEBUG_DETACH);
543 1.23 thorpej error = config_detach(dev, flags);
544 1.23 thorpej if (error)
545 1.23 thorpej goto out;
546 1.23 thorpej }
547 1.23 thorpej }
548 1.23 thorpej
549 1.23 thorpej out:
550 1.47 thorpej #ifdef ATADEBUG
551 1.23 thorpej if (dev != NULL && error != 0)
552 1.47 thorpej ATADEBUG_PRINT(("atabus_detach: %s: error %d detaching %s\n",
553 1.23 thorpej sc->sc_dev.dv_xname, error, dev->dv_xname),
554 1.23 thorpej DEBUG_DETACH);
555 1.47 thorpej #endif /* ATADEBUG */
556 1.23 thorpej
557 1.23 thorpej return (error);
558 1.23 thorpej }
559 1.23 thorpej
560 1.23 thorpej CFATTACH_DECL(atabus, sizeof(struct atabus_softc),
561 1.23 thorpej atabus_match, atabus_attach, atabus_detach, atabus_activate);
562 1.23 thorpej
563 1.23 thorpej /*****************************************************************************
564 1.23 thorpej * Common ATA bus operations.
565 1.23 thorpej *****************************************************************************/
566 1.23 thorpej
567 1.2 bouyer /* Get the disk's parameters */
568 1.2 bouyer int
569 1.21 thorpej ata_get_params(struct ata_drive_datas *drvp, u_int8_t flags,
570 1.21 thorpej struct ataparams *prms)
571 1.2 bouyer {
572 1.2 bouyer char tb[DEV_BSIZE];
573 1.36 thorpej struct ata_command ata_c;
574 1.50 thorpej struct ata_channel *chp = drvp->chnl_softc;
575 1.50 thorpej struct atac_softc *atac = chp->ch_atac;
576 1.2 bouyer
577 1.2 bouyer #if BYTE_ORDER == LITTLE_ENDIAN
578 1.2 bouyer int i;
579 1.2 bouyer u_int16_t *p;
580 1.2 bouyer #endif
581 1.2 bouyer
582 1.47 thorpej ATADEBUG_PRINT(("ata_get_parms\n"), DEBUG_FUNCS);
583 1.2 bouyer
584 1.2 bouyer memset(tb, 0, DEV_BSIZE);
585 1.2 bouyer memset(prms, 0, sizeof(struct ataparams));
586 1.36 thorpej memset(&ata_c, 0, sizeof(struct ata_command));
587 1.2 bouyer
588 1.2 bouyer if (drvp->drive_flags & DRIVE_ATA) {
589 1.36 thorpej ata_c.r_command = WDCC_IDENTIFY;
590 1.36 thorpej ata_c.r_st_bmask = WDCS_DRDY;
591 1.73 bouyer ata_c.r_st_pmask = WDCS_DRQ;
592 1.36 thorpej ata_c.timeout = 3000; /* 3s */
593 1.7 bouyer } else if (drvp->drive_flags & DRIVE_ATAPI) {
594 1.36 thorpej ata_c.r_command = ATAPI_IDENTIFY_DEVICE;
595 1.36 thorpej ata_c.r_st_bmask = 0;
596 1.73 bouyer ata_c.r_st_pmask = WDCS_DRQ;
597 1.36 thorpej ata_c.timeout = 10000; /* 10s */
598 1.7 bouyer } else {
599 1.47 thorpej ATADEBUG_PRINT(("ata_get_parms: no disks\n"),
600 1.10 bouyer DEBUG_FUNCS|DEBUG_PROBE);
601 1.7 bouyer return CMD_ERR;
602 1.2 bouyer }
603 1.36 thorpej ata_c.flags = AT_READ | flags;
604 1.36 thorpej ata_c.data = tb;
605 1.36 thorpej ata_c.bcount = DEV_BSIZE;
606 1.50 thorpej if ((*atac->atac_bustype_ata->ata_exec_command)(drvp,
607 1.50 thorpej &ata_c) != ATACMD_COMPLETE) {
608 1.47 thorpej ATADEBUG_PRINT(("ata_get_parms: wdc_exec_command failed\n"),
609 1.10 bouyer DEBUG_FUNCS|DEBUG_PROBE);
610 1.2 bouyer return CMD_AGAIN;
611 1.10 bouyer }
612 1.36 thorpej if (ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
613 1.47 thorpej ATADEBUG_PRINT(("ata_get_parms: ata_c.flags=0x%x\n",
614 1.36 thorpej ata_c.flags), DEBUG_FUNCS|DEBUG_PROBE);
615 1.2 bouyer return CMD_ERR;
616 1.2 bouyer } else {
617 1.17 bouyer /* if we didn't read any data something is wrong */
618 1.36 thorpej if ((ata_c.flags & AT_XFDONE) == 0)
619 1.17 bouyer return CMD_ERR;
620 1.2 bouyer /* Read in parameter block. */
621 1.2 bouyer memcpy(prms, tb, sizeof(struct ataparams));
622 1.2 bouyer #if BYTE_ORDER == LITTLE_ENDIAN
623 1.2 bouyer /*
624 1.2 bouyer * Shuffle string byte order.
625 1.2 bouyer * ATAPI Mitsumi and NEC drives don't need this.
626 1.2 bouyer */
627 1.2 bouyer if ((prms->atap_config & WDC_CFG_ATAPI_MASK) ==
628 1.2 bouyer WDC_CFG_ATAPI &&
629 1.2 bouyer ((prms->atap_model[0] == 'N' &&
630 1.2 bouyer prms->atap_model[1] == 'E') ||
631 1.2 bouyer (prms->atap_model[0] == 'F' &&
632 1.2 bouyer prms->atap_model[1] == 'X')))
633 1.2 bouyer return 0;
634 1.2 bouyer for (i = 0; i < sizeof(prms->atap_model); i += 2) {
635 1.2 bouyer p = (u_short *)(prms->atap_model + i);
636 1.2 bouyer *p = ntohs(*p);
637 1.2 bouyer }
638 1.2 bouyer for (i = 0; i < sizeof(prms->atap_serial); i += 2) {
639 1.2 bouyer p = (u_short *)(prms->atap_serial + i);
640 1.2 bouyer *p = ntohs(*p);
641 1.2 bouyer }
642 1.2 bouyer for (i = 0; i < sizeof(prms->atap_revision); i += 2) {
643 1.2 bouyer p = (u_short *)(prms->atap_revision + i);
644 1.2 bouyer *p = ntohs(*p);
645 1.2 bouyer }
646 1.2 bouyer #endif
647 1.2 bouyer return CMD_OK;
648 1.2 bouyer }
649 1.2 bouyer }
650 1.2 bouyer
651 1.2 bouyer int
652 1.21 thorpej ata_set_mode(struct ata_drive_datas *drvp, u_int8_t mode, u_int8_t flags)
653 1.2 bouyer {
654 1.36 thorpej struct ata_command ata_c;
655 1.50 thorpej struct ata_channel *chp = drvp->chnl_softc;
656 1.50 thorpej struct atac_softc *atac = chp->ch_atac;
657 1.2 bouyer
658 1.47 thorpej ATADEBUG_PRINT(("ata_set_mode=0x%x\n", mode), DEBUG_FUNCS);
659 1.36 thorpej memset(&ata_c, 0, sizeof(struct ata_command));
660 1.2 bouyer
661 1.36 thorpej ata_c.r_command = SET_FEATURES;
662 1.36 thorpej ata_c.r_st_bmask = 0;
663 1.36 thorpej ata_c.r_st_pmask = 0;
664 1.36 thorpej ata_c.r_features = WDSF_SET_MODE;
665 1.36 thorpej ata_c.r_count = mode;
666 1.36 thorpej ata_c.flags = flags;
667 1.36 thorpej ata_c.timeout = 1000; /* 1s */
668 1.50 thorpej if ((*atac->atac_bustype_ata->ata_exec_command)(drvp,
669 1.50 thorpej &ata_c) != ATACMD_COMPLETE)
670 1.2 bouyer return CMD_AGAIN;
671 1.36 thorpej if (ata_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
672 1.2 bouyer return CMD_ERR;
673 1.2 bouyer }
674 1.2 bouyer return CMD_OK;
675 1.11 bouyer }
676 1.11 bouyer
677 1.78 itohy #if NATA_DMA
678 1.11 bouyer void
679 1.21 thorpej ata_dmaerr(struct ata_drive_datas *drvp, int flags)
680 1.11 bouyer {
681 1.11 bouyer /*
682 1.11 bouyer * Downgrade decision: if we get NERRS_MAX in NXFER.
683 1.11 bouyer * We start with n_dmaerrs set to NERRS_MAX-1 so that the
684 1.11 bouyer * first error within the first NXFER ops will immediatly trigger
685 1.11 bouyer * a downgrade.
686 1.11 bouyer * If we got an error and n_xfers is bigger than NXFER reset counters.
687 1.11 bouyer */
688 1.11 bouyer drvp->n_dmaerrs++;
689 1.11 bouyer if (drvp->n_dmaerrs >= NERRS_MAX && drvp->n_xfers <= NXFER) {
690 1.39 thorpej ata_downgrade_mode(drvp, flags);
691 1.11 bouyer drvp->n_dmaerrs = NERRS_MAX-1;
692 1.11 bouyer drvp->n_xfers = 0;
693 1.11 bouyer return;
694 1.11 bouyer }
695 1.11 bouyer if (drvp->n_xfers > NXFER) {
696 1.11 bouyer drvp->n_dmaerrs = 1; /* just got an error */
697 1.11 bouyer drvp->n_xfers = 1; /* restart counting from this error */
698 1.4 bouyer }
699 1.2 bouyer }
700 1.78 itohy #endif /* NATA_DMA */
701 1.30 bouyer
702 1.44 thorpej /*
703 1.68 bouyer * freeze the queue and wait for the controller to be idle. Caller has to
704 1.68 bouyer * unfreeze/restart the queue
705 1.68 bouyer */
706 1.68 bouyer void
707 1.68 bouyer ata_queue_idle(struct ata_queue *queue)
708 1.68 bouyer {
709 1.68 bouyer int s = splbio();
710 1.68 bouyer queue->queue_freeze++;
711 1.68 bouyer while (queue->active_xfer != NULL) {
712 1.68 bouyer queue->queue_flags |= QF_IDLE_WAIT;
713 1.68 bouyer tsleep(&queue->queue_flags, PRIBIO, "qidl", 0);
714 1.68 bouyer }
715 1.68 bouyer splx(s);
716 1.68 bouyer }
717 1.68 bouyer
718 1.68 bouyer /*
719 1.57 thorpej * Add a command to the queue and start controller.
720 1.57 thorpej *
721 1.57 thorpej * MUST BE CALLED AT splbio()!
722 1.44 thorpej */
723 1.44 thorpej void
724 1.48 thorpej ata_exec_xfer(struct ata_channel *chp, struct ata_xfer *xfer)
725 1.44 thorpej {
726 1.44 thorpej
727 1.47 thorpej ATADEBUG_PRINT(("ata_exec_xfer %p channel %d drive %d\n", xfer,
728 1.44 thorpej chp->ch_channel, xfer->c_drive), DEBUG_XFERS);
729 1.44 thorpej
730 1.44 thorpej /* complete xfer setup */
731 1.44 thorpej xfer->c_chp = chp;
732 1.44 thorpej
733 1.44 thorpej /* insert at the end of command list */
734 1.44 thorpej TAILQ_INSERT_TAIL(&chp->ch_queue->queue_xfer, xfer, c_xferchain);
735 1.47 thorpej ATADEBUG_PRINT(("atastart from ata_exec_xfer, flags 0x%x\n",
736 1.44 thorpej chp->ch_flags), DEBUG_XFERS);
737 1.62 bouyer /*
738 1.62 bouyer * if polling and can sleep, wait for the xfer to be at head of queue
739 1.62 bouyer */
740 1.62 bouyer if ((xfer->c_flags & (C_POLL | C_WAIT)) == (C_POLL | C_WAIT)) {
741 1.62 bouyer while (chp->ch_queue->active_xfer != NULL ||
742 1.62 bouyer TAILQ_FIRST(&chp->ch_queue->queue_xfer) != xfer) {
743 1.62 bouyer xfer->c_flags |= C_WAITACT;
744 1.62 bouyer tsleep(xfer, PRIBIO, "ataact", 0);
745 1.62 bouyer xfer->c_flags &= ~C_WAITACT;
746 1.62 bouyer if (xfer->c_flags & C_FREE) {
747 1.62 bouyer ata_free_xfer(chp, xfer);
748 1.62 bouyer return;
749 1.62 bouyer }
750 1.62 bouyer }
751 1.62 bouyer }
752 1.45 thorpej atastart(chp);
753 1.45 thorpej }
754 1.45 thorpej
755 1.45 thorpej /*
756 1.45 thorpej * Start I/O on a controller, for the given channel.
757 1.45 thorpej * The first xfer may be not for our channel if the channel queues
758 1.45 thorpej * are shared.
759 1.57 thorpej *
760 1.57 thorpej * MUST BE CALLED AT splbio()!
761 1.45 thorpej */
762 1.45 thorpej void
763 1.48 thorpej atastart(struct ata_channel *chp)
764 1.45 thorpej {
765 1.49 thorpej struct atac_softc *atac = chp->ch_atac;
766 1.45 thorpej struct ata_xfer *xfer;
767 1.45 thorpej
768 1.56 thorpej #ifdef ATA_DEBUG
769 1.45 thorpej int spl1, spl2;
770 1.45 thorpej
771 1.45 thorpej spl1 = splbio();
772 1.45 thorpej spl2 = splbio();
773 1.45 thorpej if (spl2 != spl1) {
774 1.45 thorpej printf("atastart: not at splbio()\n");
775 1.45 thorpej panic("atastart");
776 1.45 thorpej }
777 1.45 thorpej splx(spl2);
778 1.45 thorpej splx(spl1);
779 1.56 thorpej #endif /* ATA_DEBUG */
780 1.45 thorpej
781 1.45 thorpej /* is there a xfer ? */
782 1.45 thorpej if ((xfer = TAILQ_FIRST(&chp->ch_queue->queue_xfer)) == NULL)
783 1.45 thorpej return;
784 1.45 thorpej
785 1.45 thorpej /* adjust chp, in case we have a shared queue */
786 1.45 thorpej chp = xfer->c_chp;
787 1.45 thorpej
788 1.45 thorpej if (chp->ch_queue->active_xfer != NULL) {
789 1.45 thorpej return; /* channel aleady active */
790 1.45 thorpej }
791 1.45 thorpej if (__predict_false(chp->ch_queue->queue_freeze > 0)) {
792 1.68 bouyer if (chp->ch_queue->queue_flags & QF_IDLE_WAIT) {
793 1.68 bouyer chp->ch_queue->queue_flags &= ~QF_IDLE_WAIT;
794 1.68 bouyer wakeup(&chp->ch_queue->queue_flags);
795 1.68 bouyer }
796 1.68 bouyer return; /* queue frozen */
797 1.45 thorpej }
798 1.62 bouyer /*
799 1.62 bouyer * if someone is waiting for the command to be active, wake it up
800 1.62 bouyer * and let it process the command
801 1.62 bouyer */
802 1.62 bouyer if (xfer->c_flags & C_WAITACT) {
803 1.62 bouyer ATADEBUG_PRINT(("atastart: xfer %p channel %d drive %d "
804 1.62 bouyer "wait active\n", xfer, chp->ch_channel, xfer->c_drive),
805 1.62 bouyer DEBUG_XFERS);
806 1.62 bouyer wakeup(xfer);
807 1.62 bouyer return;
808 1.62 bouyer }
809 1.45 thorpej #ifdef DIAGNOSTIC
810 1.48 thorpej if ((chp->ch_flags & ATACH_IRQ_WAIT) != 0)
811 1.45 thorpej panic("atastart: channel waiting for irq");
812 1.45 thorpej #endif
813 1.49 thorpej if (atac->atac_claim_hw)
814 1.49 thorpej if (!(*atac->atac_claim_hw)(chp, 0))
815 1.45 thorpej return;
816 1.45 thorpej
817 1.47 thorpej ATADEBUG_PRINT(("atastart: xfer %p channel %d drive %d\n", xfer,
818 1.45 thorpej chp->ch_channel, xfer->c_drive), DEBUG_XFERS);
819 1.45 thorpej if (chp->ch_drive[xfer->c_drive].drive_flags & DRIVE_RESET) {
820 1.45 thorpej chp->ch_drive[xfer->c_drive].drive_flags &= ~DRIVE_RESET;
821 1.45 thorpej chp->ch_drive[xfer->c_drive].state = 0;
822 1.45 thorpej }
823 1.45 thorpej chp->ch_queue->active_xfer = xfer;
824 1.45 thorpej TAILQ_REMOVE(&chp->ch_queue->queue_xfer, xfer, c_xferchain);
825 1.65 perry
826 1.49 thorpej if (atac->atac_cap & ATAC_CAP_NOIRQ)
827 1.45 thorpej KASSERT(xfer->c_flags & C_POLL);
828 1.62 bouyer
829 1.45 thorpej xfer->c_start(chp, xfer);
830 1.44 thorpej }
831 1.44 thorpej
832 1.41 thorpej struct ata_xfer *
833 1.41 thorpej ata_get_xfer(int flags)
834 1.41 thorpej {
835 1.41 thorpej struct ata_xfer *xfer;
836 1.41 thorpej int s;
837 1.41 thorpej
838 1.41 thorpej s = splbio();
839 1.41 thorpej xfer = pool_get(&ata_xfer_pool,
840 1.41 thorpej ((flags & ATAXF_NOSLEEP) != 0 ? PR_NOWAIT : PR_WAITOK));
841 1.41 thorpej splx(s);
842 1.41 thorpej if (xfer != NULL) {
843 1.41 thorpej memset(xfer, 0, sizeof(struct ata_xfer));
844 1.41 thorpej }
845 1.41 thorpej return xfer;
846 1.41 thorpej }
847 1.41 thorpej
848 1.41 thorpej void
849 1.48 thorpej ata_free_xfer(struct ata_channel *chp, struct ata_xfer *xfer)
850 1.41 thorpej {
851 1.49 thorpej struct atac_softc *atac = chp->ch_atac;
852 1.41 thorpej int s;
853 1.41 thorpej
854 1.62 bouyer if (xfer->c_flags & C_WAITACT) {
855 1.62 bouyer /* Someone is waiting for this xfer, so we can't free now */
856 1.62 bouyer xfer->c_flags |= C_FREE;
857 1.62 bouyer wakeup(xfer);
858 1.62 bouyer return;
859 1.62 bouyer }
860 1.62 bouyer
861 1.76 itohy #if NATA_PIOBM /* XXX wdc dependent code */
862 1.76 itohy if (xfer->c_flags & C_PIOBM) {
863 1.76 itohy struct wdc_softc *wdc = CHAN_TO_WDC(chp);
864 1.76 itohy
865 1.76 itohy /* finish the busmastering PIO */
866 1.76 itohy (*wdc->piobm_done)(wdc->dma_arg,
867 1.76 itohy chp->ch_channel, xfer->c_drive);
868 1.76 itohy chp->ch_flags &= ~(ATACH_DMA_WAIT | ATACH_PIOBM_WAIT | ATACH_IRQ_WAIT);
869 1.76 itohy }
870 1.76 itohy #endif
871 1.76 itohy
872 1.49 thorpej if (atac->atac_free_hw)
873 1.49 thorpej (*atac->atac_free_hw)(chp);
874 1.41 thorpej s = splbio();
875 1.41 thorpej pool_put(&ata_xfer_pool, xfer);
876 1.41 thorpej splx(s);
877 1.41 thorpej }
878 1.41 thorpej
879 1.42 thorpej /*
880 1.48 thorpej * Kill off all pending xfers for a ata_channel.
881 1.42 thorpej *
882 1.42 thorpej * Must be called at splbio().
883 1.42 thorpej */
884 1.42 thorpej void
885 1.42 thorpej ata_kill_pending(struct ata_drive_datas *drvp)
886 1.42 thorpej {
887 1.48 thorpej struct ata_channel *chp = drvp->chnl_softc;
888 1.42 thorpej struct ata_xfer *xfer, *next_xfer;
889 1.42 thorpej int s = splbio();
890 1.42 thorpej
891 1.42 thorpej for (xfer = TAILQ_FIRST(&chp->ch_queue->queue_xfer);
892 1.42 thorpej xfer != NULL; xfer = next_xfer) {
893 1.42 thorpej next_xfer = TAILQ_NEXT(xfer, c_xferchain);
894 1.42 thorpej if (xfer->c_chp != chp || xfer->c_drive != drvp->drive)
895 1.42 thorpej continue;
896 1.42 thorpej TAILQ_REMOVE(&chp->ch_queue->queue_xfer, xfer, c_xferchain);
897 1.42 thorpej (*xfer->c_kill_xfer)(chp, xfer, KILL_GONE);
898 1.42 thorpej }
899 1.42 thorpej
900 1.42 thorpej while ((xfer = chp->ch_queue->active_xfer) != NULL) {
901 1.42 thorpej if (xfer->c_chp == chp && xfer->c_drive == drvp->drive) {
902 1.42 thorpej drvp->drive_flags |= DRIVE_WAITDRAIN;
903 1.42 thorpej (void) tsleep(&chp->ch_queue->active_xfer,
904 1.42 thorpej PRIBIO, "atdrn", 0);
905 1.42 thorpej } else {
906 1.42 thorpej /* no more xfer for us */
907 1.42 thorpej break;
908 1.42 thorpej }
909 1.42 thorpej }
910 1.42 thorpej splx(s);
911 1.42 thorpej }
912 1.42 thorpej
913 1.55 thorpej /*
914 1.55 thorpej * ata_reset_channel:
915 1.55 thorpej *
916 1.55 thorpej * Reset and ATA channel.
917 1.57 thorpej *
918 1.57 thorpej * MUST BE CALLED AT splbio()!
919 1.55 thorpej */
920 1.55 thorpej void
921 1.55 thorpej ata_reset_channel(struct ata_channel *chp, int flags)
922 1.55 thorpej {
923 1.55 thorpej struct atac_softc *atac = chp->ch_atac;
924 1.55 thorpej int drive;
925 1.55 thorpej
926 1.57 thorpej #ifdef ATA_DEBUG
927 1.57 thorpej int spl1, spl2;
928 1.57 thorpej
929 1.57 thorpej spl1 = splbio();
930 1.57 thorpej spl2 = splbio();
931 1.57 thorpej if (spl2 != spl1) {
932 1.57 thorpej printf("ata_reset_channel: not at splbio()\n");
933 1.57 thorpej panic("ata_reset_channel");
934 1.57 thorpej }
935 1.57 thorpej splx(spl2);
936 1.57 thorpej splx(spl1);
937 1.57 thorpej #endif /* ATA_DEBUG */
938 1.57 thorpej
939 1.55 thorpej chp->ch_queue->queue_freeze++;
940 1.55 thorpej
941 1.55 thorpej /*
942 1.55 thorpej * If we can poll or wait it's OK, otherwise wake up the
943 1.55 thorpej * kernel thread to do it for us.
944 1.55 thorpej */
945 1.55 thorpej if ((flags & (AT_POLL | AT_WAIT)) == 0) {
946 1.55 thorpej if (chp->ch_flags & ATACH_TH_RESET) {
947 1.55 thorpej /* No need to schedule a reset more than one time. */
948 1.60 bouyer chp->ch_queue->queue_freeze--;
949 1.55 thorpej return;
950 1.55 thorpej }
951 1.55 thorpej chp->ch_flags |= ATACH_TH_RESET;
952 1.55 thorpej chp->ch_reset_flags = flags & (AT_RST_EMERG | AT_RST_NOCMD);
953 1.55 thorpej wakeup(&chp->ch_thread);
954 1.55 thorpej return;
955 1.55 thorpej }
956 1.55 thorpej
957 1.55 thorpej (*atac->atac_bustype_ata->ata_reset_channel)(chp, flags);
958 1.55 thorpej
959 1.55 thorpej for (drive = 0; drive < chp->ch_ndrive; drive++)
960 1.55 thorpej chp->ch_drive[drive].state = 0;
961 1.55 thorpej
962 1.55 thorpej chp->ch_flags &= ~ATACH_TH_RESET;
963 1.55 thorpej if ((flags & AT_RST_EMERG) == 0) {
964 1.55 thorpej chp->ch_queue->queue_freeze--;
965 1.55 thorpej atastart(chp);
966 1.55 thorpej } else {
967 1.55 thorpej /* make sure that we can use polled commands */
968 1.55 thorpej TAILQ_INIT(&chp->ch_queue->queue_xfer);
969 1.55 thorpej chp->ch_queue->queue_freeze = 0;
970 1.55 thorpej chp->ch_queue->active_xfer = NULL;
971 1.55 thorpej }
972 1.55 thorpej }
973 1.55 thorpej
974 1.43 thorpej int
975 1.48 thorpej ata_addref(struct ata_channel *chp)
976 1.43 thorpej {
977 1.65 perry struct atac_softc *atac = chp->ch_atac;
978 1.49 thorpej struct scsipi_adapter *adapt = &atac->atac_atapi_adapter._generic;
979 1.43 thorpej int s, error = 0;
980 1.43 thorpej
981 1.43 thorpej s = splbio();
982 1.43 thorpej if (adapt->adapt_refcnt++ == 0 &&
983 1.43 thorpej adapt->adapt_enable != NULL) {
984 1.49 thorpej error = (*adapt->adapt_enable)(&atac->atac_dev, 1);
985 1.43 thorpej if (error)
986 1.43 thorpej adapt->adapt_refcnt--;
987 1.43 thorpej }
988 1.43 thorpej splx(s);
989 1.43 thorpej return (error);
990 1.43 thorpej }
991 1.43 thorpej
992 1.43 thorpej void
993 1.48 thorpej ata_delref(struct ata_channel *chp)
994 1.43 thorpej {
995 1.49 thorpej struct atac_softc *atac = chp->ch_atac;
996 1.49 thorpej struct scsipi_adapter *adapt = &atac->atac_atapi_adapter._generic;
997 1.43 thorpej int s;
998 1.43 thorpej
999 1.43 thorpej s = splbio();
1000 1.43 thorpej if (adapt->adapt_refcnt-- == 1 &&
1001 1.43 thorpej adapt->adapt_enable != NULL)
1002 1.49 thorpej (void) (*adapt->adapt_enable)(&atac->atac_dev, 0);
1003 1.43 thorpej splx(s);
1004 1.43 thorpej }
1005 1.43 thorpej
1006 1.38 thorpej void
1007 1.48 thorpej ata_print_modes(struct ata_channel *chp)
1008 1.38 thorpej {
1009 1.49 thorpej struct atac_softc *atac = chp->ch_atac;
1010 1.38 thorpej int drive;
1011 1.38 thorpej struct ata_drive_datas *drvp;
1012 1.38 thorpej
1013 1.67 matt for (drive = 0; drive < chp->ch_ndrive; drive++) {
1014 1.38 thorpej drvp = &chp->ch_drive[drive];
1015 1.67 matt if ((drvp->drive_flags & DRIVE) == 0 || drvp->drv_softc == NULL)
1016 1.38 thorpej continue;
1017 1.38 thorpej aprint_normal("%s(%s:%d:%d): using PIO mode %d",
1018 1.38 thorpej drvp->drv_softc->dv_xname,
1019 1.49 thorpej atac->atac_dev.dv_xname,
1020 1.67 matt chp->ch_channel, drvp->drive, drvp->PIO_mode);
1021 1.78 itohy #if NATA_DMA
1022 1.38 thorpej if (drvp->drive_flags & DRIVE_DMA)
1023 1.38 thorpej aprint_normal(", DMA mode %d", drvp->DMA_mode);
1024 1.78 itohy #if NATA_UDMA
1025 1.38 thorpej if (drvp->drive_flags & DRIVE_UDMA) {
1026 1.38 thorpej aprint_normal(", Ultra-DMA mode %d", drvp->UDMA_mode);
1027 1.38 thorpej if (drvp->UDMA_mode == 2)
1028 1.38 thorpej aprint_normal(" (Ultra/33)");
1029 1.38 thorpej else if (drvp->UDMA_mode == 4)
1030 1.38 thorpej aprint_normal(" (Ultra/66)");
1031 1.38 thorpej else if (drvp->UDMA_mode == 5)
1032 1.38 thorpej aprint_normal(" (Ultra/100)");
1033 1.38 thorpej else if (drvp->UDMA_mode == 6)
1034 1.38 thorpej aprint_normal(" (Ultra/133)");
1035 1.38 thorpej }
1036 1.78 itohy #endif /* NATA_UDMA */
1037 1.78 itohy #endif /* NATA_DMA */
1038 1.78 itohy #if NATA_DMA || NATA_PIOBM
1039 1.78 itohy if (0
1040 1.78 itohy #if NATA_DMA
1041 1.78 itohy || (drvp->drive_flags & (DRIVE_DMA | DRIVE_UDMA))
1042 1.78 itohy #endif
1043 1.76 itohy #if NATA_PIOBM
1044 1.76 itohy /* PIOBM capable controllers use DMA for PIO commands */
1045 1.76 itohy || (atac->atac_cap & ATAC_CAP_PIOBM)
1046 1.76 itohy #endif
1047 1.76 itohy )
1048 1.63 soren aprint_normal(" (using DMA)");
1049 1.78 itohy #endif /* NATA_DMA || NATA_PIOBM */
1050 1.38 thorpej aprint_normal("\n");
1051 1.38 thorpej }
1052 1.38 thorpej }
1053 1.38 thorpej
1054 1.78 itohy #if NATA_DMA
1055 1.39 thorpej /*
1056 1.39 thorpej * downgrade the transfer mode of a drive after an error. return 1 if
1057 1.39 thorpej * downgrade was possible, 0 otherwise.
1058 1.57 thorpej *
1059 1.57 thorpej * MUST BE CALLED AT splbio()!
1060 1.39 thorpej */
1061 1.39 thorpej int
1062 1.39 thorpej ata_downgrade_mode(struct ata_drive_datas *drvp, int flags)
1063 1.39 thorpej {
1064 1.48 thorpej struct ata_channel *chp = drvp->chnl_softc;
1065 1.49 thorpej struct atac_softc *atac = chp->ch_atac;
1066 1.39 thorpej struct device *drv_dev = drvp->drv_softc;
1067 1.74 thorpej int cf_flags = device_cfdata(drv_dev)->cf_flags;
1068 1.39 thorpej
1069 1.39 thorpej /* if drive or controller don't know its mode, we can't do much */
1070 1.39 thorpej if ((drvp->drive_flags & DRIVE_MODE) == 0 ||
1071 1.49 thorpej (atac->atac_set_modes == NULL))
1072 1.39 thorpej return 0;
1073 1.39 thorpej /* current drive mode was set by a config flag, let it this way */
1074 1.39 thorpej if ((cf_flags & ATA_CONFIG_PIO_SET) ||
1075 1.39 thorpej (cf_flags & ATA_CONFIG_DMA_SET) ||
1076 1.39 thorpej (cf_flags & ATA_CONFIG_UDMA_SET))
1077 1.39 thorpej return 0;
1078 1.39 thorpej
1079 1.78 itohy #if NATA_UDMA
1080 1.39 thorpej /*
1081 1.39 thorpej * If we were using Ultra-DMA mode, downgrade to the next lower mode.
1082 1.39 thorpej */
1083 1.39 thorpej if ((drvp->drive_flags & DRIVE_UDMA) && drvp->UDMA_mode >= 2) {
1084 1.39 thorpej drvp->UDMA_mode--;
1085 1.39 thorpej printf("%s: transfer error, downgrading to Ultra-DMA mode %d\n",
1086 1.39 thorpej drv_dev->dv_xname, drvp->UDMA_mode);
1087 1.39 thorpej }
1088 1.78 itohy #endif
1089 1.39 thorpej
1090 1.39 thorpej /*
1091 1.39 thorpej * If we were using ultra-DMA, don't downgrade to multiword DMA.
1092 1.39 thorpej */
1093 1.39 thorpej else if (drvp->drive_flags & (DRIVE_DMA | DRIVE_UDMA)) {
1094 1.39 thorpej drvp->drive_flags &= ~(DRIVE_DMA | DRIVE_UDMA);
1095 1.39 thorpej drvp->PIO_mode = drvp->PIO_cap;
1096 1.39 thorpej printf("%s: transfer error, downgrading to PIO mode %d\n",
1097 1.39 thorpej drv_dev->dv_xname, drvp->PIO_mode);
1098 1.39 thorpej } else /* already using PIO, can't downgrade */
1099 1.39 thorpej return 0;
1100 1.39 thorpej
1101 1.49 thorpej (*atac->atac_set_modes)(chp);
1102 1.39 thorpej ata_print_modes(chp);
1103 1.39 thorpej /* reset the channel, which will shedule all drives for setup */
1104 1.55 thorpej ata_reset_channel(chp, flags | AT_RST_NOCMD);
1105 1.39 thorpej return 1;
1106 1.39 thorpej }
1107 1.78 itohy #endif /* NATA_DMA */
1108 1.39 thorpej
1109 1.40 thorpej /*
1110 1.40 thorpej * Probe drive's capabilities, for use by the controller later
1111 1.65 perry * Assumes drvp points to an existing drive.
1112 1.40 thorpej */
1113 1.40 thorpej void
1114 1.40 thorpej ata_probe_caps(struct ata_drive_datas *drvp)
1115 1.40 thorpej {
1116 1.40 thorpej struct ataparams params, params2;
1117 1.48 thorpej struct ata_channel *chp = drvp->chnl_softc;
1118 1.49 thorpej struct atac_softc *atac = chp->ch_atac;
1119 1.40 thorpej struct device *drv_dev = drvp->drv_softc;
1120 1.58 thorpej int i, printed, s;
1121 1.70 christos const char *sep = "";
1122 1.40 thorpej int cf_flags;
1123 1.40 thorpej
1124 1.40 thorpej if (ata_get_params(drvp, AT_WAIT, ¶ms) != CMD_OK) {
1125 1.40 thorpej /* IDENTIFY failed. Can't tell more about the device */
1126 1.40 thorpej return;
1127 1.40 thorpej }
1128 1.49 thorpej if ((atac->atac_cap & (ATAC_CAP_DATA16 | ATAC_CAP_DATA32)) ==
1129 1.49 thorpej (ATAC_CAP_DATA16 | ATAC_CAP_DATA32)) {
1130 1.40 thorpej /*
1131 1.40 thorpej * Controller claims 16 and 32 bit transfers.
1132 1.40 thorpej * Re-do an IDENTIFY with 32-bit transfers,
1133 1.40 thorpej * and compare results.
1134 1.40 thorpej */
1135 1.58 thorpej s = splbio();
1136 1.40 thorpej drvp->drive_flags |= DRIVE_CAP32;
1137 1.58 thorpej splx(s);
1138 1.40 thorpej ata_get_params(drvp, AT_WAIT, ¶ms2);
1139 1.40 thorpej if (memcmp(¶ms, ¶ms2, sizeof(struct ataparams)) != 0) {
1140 1.40 thorpej /* Not good. fall back to 16bits */
1141 1.58 thorpej s = splbio();
1142 1.40 thorpej drvp->drive_flags &= ~DRIVE_CAP32;
1143 1.58 thorpej splx(s);
1144 1.40 thorpej } else {
1145 1.40 thorpej aprint_normal("%s: 32-bit data port\n",
1146 1.40 thorpej drv_dev->dv_xname);
1147 1.40 thorpej }
1148 1.40 thorpej }
1149 1.40 thorpej #if 0 /* Some ultra-DMA drives claims to only support ATA-3. sigh */
1150 1.65 perry if (params.atap_ata_major > 0x01 &&
1151 1.40 thorpej params.atap_ata_major != 0xffff) {
1152 1.40 thorpej for (i = 14; i > 0; i--) {
1153 1.40 thorpej if (params.atap_ata_major & (1 << i)) {
1154 1.40 thorpej aprint_normal("%s: ATA version %d\n",
1155 1.40 thorpej drv_dev->dv_xname, i);
1156 1.40 thorpej drvp->ata_vers = i;
1157 1.40 thorpej break;
1158 1.40 thorpej }
1159 1.40 thorpej }
1160 1.40 thorpej }
1161 1.40 thorpej #endif
1162 1.40 thorpej
1163 1.40 thorpej /* An ATAPI device is at last PIO mode 3 */
1164 1.40 thorpej if (drvp->drive_flags & DRIVE_ATAPI)
1165 1.40 thorpej drvp->PIO_mode = 3;
1166 1.40 thorpej
1167 1.40 thorpej /*
1168 1.65 perry * It's not in the specs, but it seems that some drive
1169 1.40 thorpej * returns 0xffff in atap_extensions when this field is invalid
1170 1.40 thorpej */
1171 1.40 thorpej if (params.atap_extensions != 0xffff &&
1172 1.40 thorpej (params.atap_extensions & WDC_EXT_MODES)) {
1173 1.40 thorpej printed = 0;
1174 1.40 thorpej /*
1175 1.40 thorpej * XXX some drives report something wrong here (they claim to
1176 1.40 thorpej * support PIO mode 8 !). As mode is coded on 3 bits in
1177 1.40 thorpej * SET FEATURE, limit it to 7 (so limit i to 4).
1178 1.40 thorpej * If higher mode than 7 is found, abort.
1179 1.40 thorpej */
1180 1.40 thorpej for (i = 7; i >= 0; i--) {
1181 1.40 thorpej if ((params.atap_piomode_supp & (1 << i)) == 0)
1182 1.40 thorpej continue;
1183 1.40 thorpej if (i > 4)
1184 1.40 thorpej return;
1185 1.40 thorpej /*
1186 1.40 thorpej * See if mode is accepted.
1187 1.40 thorpej * If the controller can't set its PIO mode,
1188 1.40 thorpej * assume the defaults are good, so don't try
1189 1.40 thorpej * to set it
1190 1.40 thorpej */
1191 1.49 thorpej if (atac->atac_set_modes)
1192 1.40 thorpej /*
1193 1.40 thorpej * It's OK to pool here, it's fast enouth
1194 1.40 thorpej * to not bother waiting for interrupt
1195 1.40 thorpej */
1196 1.40 thorpej if (ata_set_mode(drvp, 0x08 | (i + 3),
1197 1.40 thorpej AT_WAIT) != CMD_OK)
1198 1.40 thorpej continue;
1199 1.65 perry if (!printed) {
1200 1.40 thorpej aprint_normal("%s: drive supports PIO mode %d",
1201 1.40 thorpej drv_dev->dv_xname, i + 3);
1202 1.40 thorpej sep = ",";
1203 1.40 thorpej printed = 1;
1204 1.40 thorpej }
1205 1.40 thorpej /*
1206 1.40 thorpej * If controller's driver can't set its PIO mode,
1207 1.40 thorpej * get the highter one for the drive.
1208 1.40 thorpej */
1209 1.49 thorpej if (atac->atac_set_modes == NULL ||
1210 1.49 thorpej atac->atac_pio_cap >= i + 3) {
1211 1.40 thorpej drvp->PIO_mode = i + 3;
1212 1.40 thorpej drvp->PIO_cap = i + 3;
1213 1.40 thorpej break;
1214 1.40 thorpej }
1215 1.40 thorpej }
1216 1.40 thorpej if (!printed) {
1217 1.65 perry /*
1218 1.40 thorpej * We didn't find a valid PIO mode.
1219 1.40 thorpej * Assume the values returned for DMA are buggy too
1220 1.40 thorpej */
1221 1.40 thorpej return;
1222 1.40 thorpej }
1223 1.58 thorpej s = splbio();
1224 1.40 thorpej drvp->drive_flags |= DRIVE_MODE;
1225 1.58 thorpej splx(s);
1226 1.40 thorpej printed = 0;
1227 1.40 thorpej for (i = 7; i >= 0; i--) {
1228 1.40 thorpej if ((params.atap_dmamode_supp & (1 << i)) == 0)
1229 1.40 thorpej continue;
1230 1.78 itohy #if NATA_DMA
1231 1.49 thorpej if ((atac->atac_cap & ATAC_CAP_DMA) &&
1232 1.49 thorpej atac->atac_set_modes != NULL)
1233 1.40 thorpej if (ata_set_mode(drvp, 0x20 | i, AT_WAIT)
1234 1.40 thorpej != CMD_OK)
1235 1.40 thorpej continue;
1236 1.78 itohy #endif
1237 1.40 thorpej if (!printed) {
1238 1.40 thorpej aprint_normal("%s DMA mode %d", sep, i);
1239 1.40 thorpej sep = ",";
1240 1.40 thorpej printed = 1;
1241 1.40 thorpej }
1242 1.78 itohy #if NATA_DMA
1243 1.49 thorpej if (atac->atac_cap & ATAC_CAP_DMA) {
1244 1.49 thorpej if (atac->atac_set_modes != NULL &&
1245 1.49 thorpej atac->atac_dma_cap < i)
1246 1.40 thorpej continue;
1247 1.40 thorpej drvp->DMA_mode = i;
1248 1.40 thorpej drvp->DMA_cap = i;
1249 1.58 thorpej s = splbio();
1250 1.40 thorpej drvp->drive_flags |= DRIVE_DMA;
1251 1.58 thorpej splx(s);
1252 1.40 thorpej }
1253 1.78 itohy #endif
1254 1.40 thorpej break;
1255 1.40 thorpej }
1256 1.40 thorpej if (params.atap_extensions & WDC_EXT_UDMA_MODES) {
1257 1.40 thorpej printed = 0;
1258 1.40 thorpej for (i = 7; i >= 0; i--) {
1259 1.40 thorpej if ((params.atap_udmamode_supp & (1 << i))
1260 1.40 thorpej == 0)
1261 1.40 thorpej continue;
1262 1.78 itohy #if NATA_UDMA
1263 1.49 thorpej if (atac->atac_set_modes != NULL &&
1264 1.49 thorpej (atac->atac_cap & ATAC_CAP_UDMA))
1265 1.40 thorpej if (ata_set_mode(drvp, 0x40 | i,
1266 1.40 thorpej AT_WAIT) != CMD_OK)
1267 1.40 thorpej continue;
1268 1.78 itohy #endif
1269 1.40 thorpej if (!printed) {
1270 1.40 thorpej aprint_normal("%s Ultra-DMA mode %d",
1271 1.40 thorpej sep, i);
1272 1.40 thorpej if (i == 2)
1273 1.40 thorpej aprint_normal(" (Ultra/33)");
1274 1.40 thorpej else if (i == 4)
1275 1.40 thorpej aprint_normal(" (Ultra/66)");
1276 1.40 thorpej else if (i == 5)
1277 1.40 thorpej aprint_normal(" (Ultra/100)");
1278 1.40 thorpej else if (i == 6)
1279 1.40 thorpej aprint_normal(" (Ultra/133)");
1280 1.40 thorpej sep = ",";
1281 1.40 thorpej printed = 1;
1282 1.40 thorpej }
1283 1.78 itohy #if NATA_UDMA
1284 1.49 thorpej if (atac->atac_cap & ATAC_CAP_UDMA) {
1285 1.49 thorpej if (atac->atac_set_modes != NULL &&
1286 1.49 thorpej atac->atac_udma_cap < i)
1287 1.40 thorpej continue;
1288 1.40 thorpej drvp->UDMA_mode = i;
1289 1.40 thorpej drvp->UDMA_cap = i;
1290 1.58 thorpej s = splbio();
1291 1.40 thorpej drvp->drive_flags |= DRIVE_UDMA;
1292 1.58 thorpej splx(s);
1293 1.40 thorpej }
1294 1.78 itohy #endif
1295 1.40 thorpej break;
1296 1.40 thorpej }
1297 1.40 thorpej }
1298 1.40 thorpej aprint_normal("\n");
1299 1.40 thorpej }
1300 1.40 thorpej
1301 1.58 thorpej s = splbio();
1302 1.40 thorpej drvp->drive_flags &= ~DRIVE_NOSTREAM;
1303 1.40 thorpej if (drvp->drive_flags & DRIVE_ATAPI) {
1304 1.65 perry if (atac->atac_cap & ATAC_CAP_ATAPI_NOSTREAM)
1305 1.40 thorpej drvp->drive_flags |= DRIVE_NOSTREAM;
1306 1.40 thorpej } else {
1307 1.65 perry if (atac->atac_cap & ATAC_CAP_ATA_NOSTREAM)
1308 1.40 thorpej drvp->drive_flags |= DRIVE_NOSTREAM;
1309 1.40 thorpej }
1310 1.58 thorpej splx(s);
1311 1.40 thorpej
1312 1.40 thorpej /* Try to guess ATA version here, if it didn't get reported */
1313 1.40 thorpej if (drvp->ata_vers == 0) {
1314 1.78 itohy #if NATA_UDMA
1315 1.40 thorpej if (drvp->drive_flags & DRIVE_UDMA)
1316 1.40 thorpej drvp->ata_vers = 4; /* should be at last ATA-4 */
1317 1.78 itohy else
1318 1.78 itohy #endif
1319 1.78 itohy if (drvp->PIO_cap > 2)
1320 1.40 thorpej drvp->ata_vers = 2; /* should be at last ATA-2 */
1321 1.40 thorpej }
1322 1.74 thorpej cf_flags = device_cfdata(drv_dev)->cf_flags;
1323 1.40 thorpej if (cf_flags & ATA_CONFIG_PIO_SET) {
1324 1.58 thorpej s = splbio();
1325 1.40 thorpej drvp->PIO_mode =
1326 1.40 thorpej (cf_flags & ATA_CONFIG_PIO_MODES) >> ATA_CONFIG_PIO_OFF;
1327 1.40 thorpej drvp->drive_flags |= DRIVE_MODE;
1328 1.58 thorpej splx(s);
1329 1.40 thorpej }
1330 1.78 itohy #if NATA_DMA
1331 1.49 thorpej if ((atac->atac_cap & ATAC_CAP_DMA) == 0) {
1332 1.40 thorpej /* don't care about DMA modes */
1333 1.40 thorpej return;
1334 1.40 thorpej }
1335 1.40 thorpej if (cf_flags & ATA_CONFIG_DMA_SET) {
1336 1.58 thorpej s = splbio();
1337 1.40 thorpej if ((cf_flags & ATA_CONFIG_DMA_MODES) ==
1338 1.40 thorpej ATA_CONFIG_DMA_DISABLE) {
1339 1.40 thorpej drvp->drive_flags &= ~DRIVE_DMA;
1340 1.40 thorpej } else {
1341 1.40 thorpej drvp->DMA_mode = (cf_flags & ATA_CONFIG_DMA_MODES) >>
1342 1.40 thorpej ATA_CONFIG_DMA_OFF;
1343 1.40 thorpej drvp->drive_flags |= DRIVE_DMA | DRIVE_MODE;
1344 1.40 thorpej }
1345 1.58 thorpej splx(s);
1346 1.40 thorpej }
1347 1.78 itohy #if NATA_UDMA
1348 1.49 thorpej if ((atac->atac_cap & ATAC_CAP_UDMA) == 0) {
1349 1.40 thorpej /* don't care about UDMA modes */
1350 1.40 thorpej return;
1351 1.40 thorpej }
1352 1.40 thorpej if (cf_flags & ATA_CONFIG_UDMA_SET) {
1353 1.58 thorpej s = splbio();
1354 1.40 thorpej if ((cf_flags & ATA_CONFIG_UDMA_MODES) ==
1355 1.40 thorpej ATA_CONFIG_UDMA_DISABLE) {
1356 1.40 thorpej drvp->drive_flags &= ~DRIVE_UDMA;
1357 1.40 thorpej } else {
1358 1.40 thorpej drvp->UDMA_mode = (cf_flags & ATA_CONFIG_UDMA_MODES) >>
1359 1.40 thorpej ATA_CONFIG_UDMA_OFF;
1360 1.40 thorpej drvp->drive_flags |= DRIVE_UDMA | DRIVE_MODE;
1361 1.40 thorpej }
1362 1.58 thorpej splx(s);
1363 1.40 thorpej }
1364 1.78 itohy #endif /* NATA_UDMA */
1365 1.78 itohy #endif /* NATA_DMA */
1366 1.40 thorpej }
1367 1.40 thorpej
1368 1.30 bouyer /* management of the /dev/atabus* devices */
1369 1.54 thorpej int
1370 1.79 christos atabusopen(dev_t dev, int flag __unused, int fmt __unused,
1371 1.79 christos struct lwp *l __unused)
1372 1.30 bouyer {
1373 1.30 bouyer struct atabus_softc *sc;
1374 1.30 bouyer int error, unit = minor(dev);
1375 1.65 perry
1376 1.30 bouyer if (unit >= atabus_cd.cd_ndevs ||
1377 1.30 bouyer (sc = atabus_cd.cd_devs[unit]) == NULL)
1378 1.30 bouyer return (ENXIO);
1379 1.65 perry
1380 1.30 bouyer if (sc->sc_flags & ATABUSCF_OPEN)
1381 1.30 bouyer return (EBUSY);
1382 1.30 bouyer
1383 1.43 thorpej if ((error = ata_addref(sc->sc_chan)) != 0)
1384 1.30 bouyer return (error);
1385 1.30 bouyer
1386 1.30 bouyer sc->sc_flags |= ATABUSCF_OPEN;
1387 1.30 bouyer
1388 1.30 bouyer return (0);
1389 1.30 bouyer }
1390 1.30 bouyer
1391 1.30 bouyer
1392 1.30 bouyer int
1393 1.79 christos atabusclose(dev_t dev, int flag __unused, int fmt __unused,
1394 1.79 christos struct lwp *l __unused)
1395 1.30 bouyer {
1396 1.30 bouyer struct atabus_softc *sc = atabus_cd.cd_devs[minor(dev)];
1397 1.30 bouyer
1398 1.43 thorpej ata_delref(sc->sc_chan);
1399 1.30 bouyer
1400 1.30 bouyer sc->sc_flags &= ~ATABUSCF_OPEN;
1401 1.30 bouyer
1402 1.30 bouyer return (0);
1403 1.30 bouyer }
1404 1.30 bouyer
1405 1.30 bouyer int
1406 1.79 christos atabusioctl(dev_t dev, u_long cmd, caddr_t addr, int flag,
1407 1.79 christos struct lwp *l __unused)
1408 1.30 bouyer {
1409 1.30 bouyer struct atabus_softc *sc = atabus_cd.cd_devs[minor(dev)];
1410 1.48 thorpej struct ata_channel *chp = sc->sc_chan;
1411 1.32 bouyer int min_drive, max_drive, drive;
1412 1.30 bouyer int error;
1413 1.30 bouyer int s;
1414 1.30 bouyer
1415 1.30 bouyer /*
1416 1.30 bouyer * Enforce write permission for ioctls that change the
1417 1.30 bouyer * state of the bus. Host adapter specific ioctls must
1418 1.30 bouyer * be checked by the adapter driver.
1419 1.30 bouyer */
1420 1.30 bouyer switch (cmd) {
1421 1.30 bouyer case ATABUSIOSCAN:
1422 1.30 bouyer case ATABUSIODETACH:
1423 1.30 bouyer case ATABUSIORESET:
1424 1.30 bouyer if ((flag & FWRITE) == 0)
1425 1.30 bouyer return (EBADF);
1426 1.30 bouyer }
1427 1.30 bouyer
1428 1.30 bouyer switch (cmd) {
1429 1.30 bouyer case ATABUSIORESET:
1430 1.30 bouyer s = splbio();
1431 1.55 thorpej ata_reset_channel(sc->sc_chan, AT_WAIT | AT_POLL);
1432 1.30 bouyer splx(s);
1433 1.30 bouyer error = 0;
1434 1.30 bouyer break;
1435 1.32 bouyer case ATABUSIOSCAN:
1436 1.32 bouyer {
1437 1.32 bouyer #if 0
1438 1.32 bouyer struct atabusioscan_args *a=
1439 1.32 bouyer (struct atabusioscan_args *)addr;
1440 1.32 bouyer #endif
1441 1.32 bouyer if ((chp->ch_drive[0].drive_flags & DRIVE_OLD) ||
1442 1.32 bouyer (chp->ch_drive[1].drive_flags & DRIVE_OLD))
1443 1.32 bouyer return (EOPNOTSUPP);
1444 1.32 bouyer return (EOPNOTSUPP);
1445 1.32 bouyer }
1446 1.32 bouyer case ATABUSIODETACH:
1447 1.32 bouyer {
1448 1.32 bouyer struct atabusioscan_args *a=
1449 1.32 bouyer (struct atabusioscan_args *)addr;
1450 1.32 bouyer if ((chp->ch_drive[0].drive_flags & DRIVE_OLD) ||
1451 1.32 bouyer (chp->ch_drive[1].drive_flags & DRIVE_OLD))
1452 1.32 bouyer return (EOPNOTSUPP);
1453 1.32 bouyer switch (a->at_dev) {
1454 1.32 bouyer case -1:
1455 1.32 bouyer min_drive = 0;
1456 1.32 bouyer max_drive = 1;
1457 1.32 bouyer break;
1458 1.32 bouyer case 0:
1459 1.32 bouyer case 1:
1460 1.32 bouyer min_drive = max_drive = a->at_dev;
1461 1.32 bouyer break;
1462 1.32 bouyer default:
1463 1.32 bouyer return (EINVAL);
1464 1.32 bouyer }
1465 1.32 bouyer for (drive = min_drive; drive <= max_drive; drive++) {
1466 1.32 bouyer if (chp->ch_drive[drive].drv_softc != NULL) {
1467 1.32 bouyer error = config_detach(
1468 1.32 bouyer chp->ch_drive[drive].drv_softc, 0);
1469 1.32 bouyer if (error)
1470 1.32 bouyer return (error);
1471 1.34 bouyer chp->ch_drive[drive].drv_softc = NULL;
1472 1.32 bouyer }
1473 1.32 bouyer }
1474 1.32 bouyer error = 0;
1475 1.32 bouyer break;
1476 1.32 bouyer }
1477 1.30 bouyer default:
1478 1.30 bouyer error = ENOTTY;
1479 1.30 bouyer }
1480 1.30 bouyer return (error);
1481 1.30 bouyer };
1482 1.64 jmcneill
1483 1.64 jmcneill static void
1484 1.64 jmcneill atabus_powerhook(int why, void *hdl)
1485 1.64 jmcneill {
1486 1.64 jmcneill struct atabus_softc *sc = (struct atabus_softc *)hdl;
1487 1.64 jmcneill struct ata_channel *chp = sc->sc_chan;
1488 1.64 jmcneill int s;
1489 1.64 jmcneill
1490 1.64 jmcneill switch (why) {
1491 1.64 jmcneill case PWR_SOFTSUSPEND:
1492 1.64 jmcneill case PWR_SOFTSTANDBY:
1493 1.68 bouyer /* freeze the queue and wait for the controller to be idle */
1494 1.68 bouyer ata_queue_idle(chp->ch_queue);
1495 1.68 bouyer break;
1496 1.68 bouyer case PWR_RESUME:
1497 1.68 bouyer printf("%s: resuming...\n", sc->sc_dev.dv_xname);
1498 1.64 jmcneill s = splbio();
1499 1.68 bouyer KASSERT(chp->ch_queue->queue_freeze > 0);
1500 1.68 bouyer /* unfreeze the queue and reset drives (to wake them up) */
1501 1.68 bouyer chp->ch_queue->queue_freeze--;
1502 1.68 bouyer ata_reset_channel(chp, AT_WAIT);
1503 1.64 jmcneill splx(s);
1504 1.64 jmcneill break;
1505 1.64 jmcneill case PWR_SUSPEND:
1506 1.64 jmcneill case PWR_STANDBY:
1507 1.64 jmcneill case PWR_SOFTRESUME:
1508 1.64 jmcneill break;
1509 1.64 jmcneill }
1510 1.64 jmcneill
1511 1.64 jmcneill return;
1512 1.64 jmcneill }
1513