ata.c revision 1.32 1 1.32 bouyer /* $NetBSD: ata.c,v 1.32 2004/08/03 22:37:19 bouyer 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.13 bouyer * 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.32 bouyer __KERNEL_RCSID(0, "$NetBSD: ata.c,v 1.32 2004/08/03 22:37:19 bouyer Exp $");
34 1.2 bouyer
35 1.6 hubertf #ifndef WDCDEBUG
36 1.2 bouyer #define WDCDEBUG
37 1.6 hubertf #endif /* WDCDEBUG */
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.23 thorpej #include <sys/kthread.h>
48 1.23 thorpej #include <sys/errno.h>
49 1.30 bouyer #include <sys/ataio.h>
50 1.2 bouyer
51 1.15 bouyer #include <machine/intr.h>
52 1.15 bouyer #include <machine/bus.h>
53 1.15 bouyer
54 1.2 bouyer #include <dev/ata/atareg.h>
55 1.2 bouyer #include <dev/ata/atavar.h>
56 1.15 bouyer #include <dev/ic/wdcreg.h>
57 1.15 bouyer #include <dev/ic/wdcvar.h>
58 1.2 bouyer
59 1.23 thorpej #include "locators.h"
60 1.23 thorpej
61 1.2 bouyer #define DEBUG_FUNCS 0x08
62 1.2 bouyer #define DEBUG_PROBE 0x10
63 1.23 thorpej #define DEBUG_DETACH 0x20
64 1.2 bouyer #ifdef WDCDEBUG
65 1.2 bouyer extern int wdcdebug_mask; /* init'ed in wdc.c */
66 1.2 bouyer #define WDCDEBUG_PRINT(args, level) \
67 1.2 bouyer if (wdcdebug_mask & (level)) \
68 1.2 bouyer printf args
69 1.2 bouyer #else
70 1.2 bouyer #define WDCDEBUG_PRINT(args, level)
71 1.2 bouyer #endif
72 1.2 bouyer
73 1.23 thorpej /*****************************************************************************
74 1.23 thorpej * ATA bus layer.
75 1.23 thorpej *
76 1.23 thorpej * ATA controllers attach an atabus instance, which handles probing the bus
77 1.23 thorpej * for drives, etc.
78 1.23 thorpej *****************************************************************************/
79 1.23 thorpej
80 1.30 bouyer dev_type_open(atabusopen);
81 1.30 bouyer dev_type_close(atabusclose);
82 1.30 bouyer dev_type_ioctl(atabusioctl);
83 1.30 bouyer
84 1.30 bouyer const struct cdevsw atabus_cdevsw = {
85 1.30 bouyer atabusopen, atabusclose, noread, nowrite, atabusioctl,
86 1.30 bouyer nostop, notty, nopoll, nommap, nokqfilter,
87 1.30 bouyer };
88 1.30 bouyer
89 1.30 bouyer extern struct cfdriver atabus_cd;
90 1.30 bouyer
91 1.30 bouyer
92 1.23 thorpej /*
93 1.23 thorpej * atabusprint:
94 1.23 thorpej *
95 1.23 thorpej * Autoconfiguration print routine used by ATA controllers when
96 1.23 thorpej * attaching an atabus instance.
97 1.23 thorpej */
98 1.23 thorpej int
99 1.23 thorpej atabusprint(void *aux, const char *pnp)
100 1.23 thorpej {
101 1.25 thorpej struct wdc_channel *chan = aux;
102 1.23 thorpej
103 1.23 thorpej if (pnp)
104 1.23 thorpej aprint_normal("atabus at %s", pnp);
105 1.26 thorpej aprint_normal(" channel %d", chan->ch_channel);
106 1.23 thorpej
107 1.23 thorpej return (UNCONF);
108 1.23 thorpej }
109 1.23 thorpej
110 1.23 thorpej /*
111 1.23 thorpej * ataprint:
112 1.23 thorpej *
113 1.23 thorpej * Autoconfiguration print routine.
114 1.23 thorpej */
115 1.23 thorpej int
116 1.23 thorpej ataprint(void *aux, const char *pnp)
117 1.23 thorpej {
118 1.23 thorpej struct ata_device *adev = aux;
119 1.23 thorpej
120 1.23 thorpej if (pnp)
121 1.23 thorpej aprint_normal("wd at %s", pnp);
122 1.23 thorpej aprint_normal(" drive %d", adev->adev_drv_data->drive);
123 1.23 thorpej
124 1.23 thorpej return (UNCONF);
125 1.23 thorpej }
126 1.23 thorpej
127 1.23 thorpej /*
128 1.23 thorpej * atabus_thread:
129 1.23 thorpej *
130 1.23 thorpej * Worker thread for the ATA bus.
131 1.23 thorpej */
132 1.23 thorpej static void
133 1.23 thorpej atabus_thread(void *arg)
134 1.23 thorpej {
135 1.23 thorpej struct atabus_softc *sc = arg;
136 1.25 thorpej struct wdc_channel *chp = sc->sc_chan;
137 1.24 thorpej struct ata_xfer *xfer;
138 1.23 thorpej int s;
139 1.23 thorpej
140 1.23 thorpej s = splbio();
141 1.23 thorpej chp->ch_flags |= WDCF_TH_RUN;
142 1.23 thorpej splx(s);
143 1.23 thorpej
144 1.23 thorpej /* Configure the devices on the bus. */
145 1.23 thorpej atabusconfig(sc);
146 1.23 thorpej
147 1.23 thorpej for (;;) {
148 1.23 thorpej s = splbio();
149 1.23 thorpej if ((chp->ch_flags & (WDCF_TH_RESET | WDCF_SHUTDOWN)) == 0 &&
150 1.23 thorpej ((chp->ch_flags & WDCF_ACTIVE) == 0 ||
151 1.23 thorpej chp->ch_queue->queue_freeze == 0)) {
152 1.23 thorpej chp->ch_flags &= ~WDCF_TH_RUN;
153 1.27 thorpej (void) tsleep(&chp->ch_thread, PRIBIO, "atath", 0);
154 1.23 thorpej chp->ch_flags |= WDCF_TH_RUN;
155 1.23 thorpej }
156 1.23 thorpej splx(s);
157 1.23 thorpej if (chp->ch_flags & WDCF_SHUTDOWN)
158 1.23 thorpej break;
159 1.23 thorpej s = splbio();
160 1.23 thorpej if (chp->ch_flags & WDCF_TH_RESET) {
161 1.31 bouyer /*
162 1.31 bouyer * wdc_reset_channel() will freeze 2 times, so
163 1.31 bouyer * unfreeze one time. Not a problem as we're at splbio
164 1.31 bouyer */
165 1.23 thorpej chp->ch_queue->queue_freeze--;
166 1.31 bouyer wdc_reset_channel(chp, AT_WAIT | chp->ch_reset_flags);
167 1.23 thorpej } else if ((chp->ch_flags & WDCF_ACTIVE) != 0 &&
168 1.23 thorpej chp->ch_queue->queue_freeze == 1) {
169 1.23 thorpej /*
170 1.23 thorpej * Caller has bumped queue_freeze, decrease it.
171 1.23 thorpej */
172 1.23 thorpej chp->ch_queue->queue_freeze--;
173 1.24 thorpej xfer = TAILQ_FIRST(&chp->ch_queue->queue_xfer);
174 1.23 thorpej KASSERT(xfer != NULL);
175 1.23 thorpej (*xfer->c_start)(chp, xfer);
176 1.23 thorpej } else if (chp->ch_queue->queue_freeze > 1)
177 1.23 thorpej panic("ata_thread: queue_freeze");
178 1.23 thorpej splx(s);
179 1.23 thorpej }
180 1.27 thorpej chp->ch_thread = NULL;
181 1.28 bouyer wakeup((void *)&chp->ch_flags);
182 1.23 thorpej kthread_exit(0);
183 1.23 thorpej }
184 1.23 thorpej
185 1.23 thorpej /*
186 1.23 thorpej * atabus_create_thread:
187 1.23 thorpej *
188 1.23 thorpej * Helper routine to create the ATA bus worker thread.
189 1.23 thorpej */
190 1.23 thorpej static void
191 1.23 thorpej atabus_create_thread(void *arg)
192 1.23 thorpej {
193 1.23 thorpej struct atabus_softc *sc = arg;
194 1.25 thorpej struct wdc_channel *chp = sc->sc_chan;
195 1.23 thorpej int error;
196 1.23 thorpej
197 1.27 thorpej if ((error = kthread_create1(atabus_thread, sc, &chp->ch_thread,
198 1.23 thorpej "%s", sc->sc_dev.dv_xname)) != 0)
199 1.23 thorpej aprint_error("%s: unable to create kernel thread: error %d\n",
200 1.23 thorpej sc->sc_dev.dv_xname, error);
201 1.23 thorpej }
202 1.23 thorpej
203 1.23 thorpej /*
204 1.23 thorpej * atabus_match:
205 1.23 thorpej *
206 1.23 thorpej * Autoconfiguration match routine.
207 1.23 thorpej */
208 1.23 thorpej static int
209 1.23 thorpej atabus_match(struct device *parent, struct cfdata *cf, void *aux)
210 1.23 thorpej {
211 1.25 thorpej struct wdc_channel *chp = aux;
212 1.23 thorpej
213 1.23 thorpej if (chp == NULL)
214 1.23 thorpej return (0);
215 1.23 thorpej
216 1.26 thorpej if (cf->cf_loc[ATACF_CHANNEL] != chp->ch_channel &&
217 1.23 thorpej cf->cf_loc[ATACF_CHANNEL] != ATACF_CHANNEL_DEFAULT)
218 1.23 thorpej return (0);
219 1.23 thorpej
220 1.23 thorpej return (1);
221 1.23 thorpej }
222 1.23 thorpej
223 1.23 thorpej /*
224 1.23 thorpej * atabus_attach:
225 1.23 thorpej *
226 1.23 thorpej * Autoconfiguration attach routine.
227 1.23 thorpej */
228 1.23 thorpej static void
229 1.23 thorpej atabus_attach(struct device *parent, struct device *self, void *aux)
230 1.23 thorpej {
231 1.23 thorpej struct atabus_softc *sc = (void *) self;
232 1.25 thorpej struct wdc_channel *chp = aux;
233 1.23 thorpej struct atabus_initq *initq;
234 1.23 thorpej
235 1.23 thorpej sc->sc_chan = chp;
236 1.23 thorpej
237 1.23 thorpej aprint_normal("\n");
238 1.23 thorpej aprint_naive("\n");
239 1.23 thorpej
240 1.23 thorpej initq = malloc(sizeof(*initq), M_DEVBUF, M_WAITOK);
241 1.23 thorpej initq->atabus_sc = sc;
242 1.23 thorpej TAILQ_INSERT_TAIL(&atabus_initq_head, initq, atabus_initq);
243 1.23 thorpej config_pending_incr();
244 1.23 thorpej kthread_create(atabus_create_thread, sc);
245 1.23 thorpej }
246 1.23 thorpej
247 1.23 thorpej /*
248 1.23 thorpej * atabus_activate:
249 1.23 thorpej *
250 1.23 thorpej * Autoconfiguration activation routine.
251 1.23 thorpej */
252 1.23 thorpej static int
253 1.23 thorpej atabus_activate(struct device *self, enum devact act)
254 1.23 thorpej {
255 1.23 thorpej struct atabus_softc *sc = (void *) self;
256 1.25 thorpej struct wdc_channel *chp = sc->sc_chan;
257 1.23 thorpej struct device *dev = NULL;
258 1.23 thorpej int s, i, error = 0;
259 1.23 thorpej
260 1.23 thorpej s = splbio();
261 1.23 thorpej switch (act) {
262 1.23 thorpej case DVACT_ACTIVATE:
263 1.23 thorpej error = EOPNOTSUPP;
264 1.23 thorpej break;
265 1.23 thorpej
266 1.23 thorpej case DVACT_DEACTIVATE:
267 1.23 thorpej /*
268 1.23 thorpej * We might deactivate the children of atapibus twice
269 1.23 thorpej * (once bia atapibus, once directly), but since the
270 1.23 thorpej * generic autoconfiguration code maintains the DVF_ACTIVE
271 1.23 thorpej * flag, it's safe.
272 1.23 thorpej */
273 1.23 thorpej if ((dev = chp->atapibus) != NULL) {
274 1.23 thorpej error = config_deactivate(dev);
275 1.23 thorpej if (error)
276 1.23 thorpej goto out;
277 1.23 thorpej }
278 1.23 thorpej
279 1.23 thorpej for (i = 0; i < 2; i++) {
280 1.23 thorpej if ((dev = chp->ch_drive[i].drv_softc) != NULL) {
281 1.23 thorpej WDCDEBUG_PRINT(("atabus_activate: %s: "
282 1.23 thorpej "deactivating %s\n", sc->sc_dev.dv_xname,
283 1.23 thorpej dev->dv_xname),
284 1.23 thorpej DEBUG_DETACH);
285 1.23 thorpej error = config_deactivate(dev);
286 1.23 thorpej if (error)
287 1.23 thorpej goto out;
288 1.23 thorpej }
289 1.23 thorpej }
290 1.23 thorpej break;
291 1.23 thorpej }
292 1.23 thorpej out:
293 1.23 thorpej splx(s);
294 1.23 thorpej
295 1.23 thorpej #ifdef WDCDEBUG
296 1.23 thorpej if (dev != NULL && error != 0)
297 1.23 thorpej WDCDEBUG_PRINT(("atabus_activate: %s: "
298 1.23 thorpej "error %d deactivating %s\n", sc->sc_dev.dv_xname,
299 1.23 thorpej error, dev->dv_xname), DEBUG_DETACH);
300 1.23 thorpej #endif /* WDCDEBUG */
301 1.23 thorpej
302 1.23 thorpej return (error);
303 1.23 thorpej }
304 1.23 thorpej
305 1.23 thorpej /*
306 1.23 thorpej * atabus_detach:
307 1.23 thorpej *
308 1.23 thorpej * Autoconfiguration detach routine.
309 1.23 thorpej */
310 1.23 thorpej static int
311 1.23 thorpej atabus_detach(struct device *self, int flags)
312 1.23 thorpej {
313 1.23 thorpej struct atabus_softc *sc = (void *) self;
314 1.25 thorpej struct wdc_channel *chp = sc->sc_chan;
315 1.23 thorpej struct device *dev = NULL;
316 1.23 thorpej int i, error = 0;
317 1.23 thorpej
318 1.23 thorpej /* Shutdown the channel. */
319 1.23 thorpej /* XXX NEED AN INTERLOCK HERE. */
320 1.23 thorpej chp->ch_flags |= WDCF_SHUTDOWN;
321 1.27 thorpej wakeup(&chp->ch_thread);
322 1.27 thorpej while (chp->ch_thread != NULL)
323 1.28 bouyer (void) tsleep((void *)&chp->ch_flags, PRIBIO, "atadown", 0);
324 1.23 thorpej
325 1.23 thorpej /*
326 1.23 thorpej * Detach atapibus and its children.
327 1.23 thorpej */
328 1.23 thorpej if ((dev = chp->atapibus) != NULL) {
329 1.23 thorpej WDCDEBUG_PRINT(("atabus_detach: %s: detaching %s\n",
330 1.23 thorpej sc->sc_dev.dv_xname, dev->dv_xname), DEBUG_DETACH);
331 1.23 thorpej error = config_detach(dev, flags);
332 1.23 thorpej if (error)
333 1.23 thorpej goto out;
334 1.23 thorpej }
335 1.23 thorpej
336 1.23 thorpej /*
337 1.23 thorpej * Detach our other children.
338 1.23 thorpej */
339 1.23 thorpej for (i = 0; i < 2; i++) {
340 1.23 thorpej if (chp->ch_drive[i].drive_flags & DRIVE_ATAPI)
341 1.23 thorpej continue;
342 1.23 thorpej if ((dev = chp->ch_drive[i].drv_softc) != NULL) {
343 1.23 thorpej WDCDEBUG_PRINT(("atabus_detach: %s: detaching %s\n",
344 1.23 thorpej sc->sc_dev.dv_xname, dev->dv_xname),
345 1.23 thorpej DEBUG_DETACH);
346 1.23 thorpej error = config_detach(dev, flags);
347 1.23 thorpej if (error)
348 1.23 thorpej goto out;
349 1.23 thorpej }
350 1.23 thorpej }
351 1.23 thorpej
352 1.23 thorpej wdc_kill_pending(chp);
353 1.23 thorpej out:
354 1.23 thorpej #ifdef WDCDEBUG
355 1.23 thorpej if (dev != NULL && error != 0)
356 1.23 thorpej WDCDEBUG_PRINT(("atabus_detach: %s: error %d detaching %s\n",
357 1.23 thorpej sc->sc_dev.dv_xname, error, dev->dv_xname),
358 1.23 thorpej DEBUG_DETACH);
359 1.23 thorpej #endif /* WDCDEBUG */
360 1.23 thorpej
361 1.23 thorpej return (error);
362 1.23 thorpej }
363 1.23 thorpej
364 1.23 thorpej CFATTACH_DECL(atabus, sizeof(struct atabus_softc),
365 1.23 thorpej atabus_match, atabus_attach, atabus_detach, atabus_activate);
366 1.23 thorpej
367 1.23 thorpej /*****************************************************************************
368 1.23 thorpej * Common ATA bus operations.
369 1.23 thorpej *****************************************************************************/
370 1.23 thorpej
371 1.2 bouyer /* Get the disk's parameters */
372 1.2 bouyer int
373 1.21 thorpej ata_get_params(struct ata_drive_datas *drvp, u_int8_t flags,
374 1.21 thorpej struct ataparams *prms)
375 1.2 bouyer {
376 1.2 bouyer char tb[DEV_BSIZE];
377 1.2 bouyer struct wdc_command wdc_c;
378 1.2 bouyer
379 1.2 bouyer #if BYTE_ORDER == LITTLE_ENDIAN
380 1.2 bouyer int i;
381 1.2 bouyer u_int16_t *p;
382 1.2 bouyer #endif
383 1.2 bouyer
384 1.22 thorpej WDCDEBUG_PRINT(("ata_get_parms\n"), DEBUG_FUNCS);
385 1.2 bouyer
386 1.2 bouyer memset(tb, 0, DEV_BSIZE);
387 1.2 bouyer memset(prms, 0, sizeof(struct ataparams));
388 1.2 bouyer memset(&wdc_c, 0, sizeof(struct wdc_command));
389 1.2 bouyer
390 1.2 bouyer if (drvp->drive_flags & DRIVE_ATA) {
391 1.2 bouyer wdc_c.r_command = WDCC_IDENTIFY;
392 1.5 bouyer wdc_c.r_st_bmask = WDCS_DRDY;
393 1.19 mycroft wdc_c.r_st_pmask = 0;
394 1.18 bouyer wdc_c.timeout = 3000; /* 3s */
395 1.7 bouyer } else if (drvp->drive_flags & DRIVE_ATAPI) {
396 1.2 bouyer wdc_c.r_command = ATAPI_IDENTIFY_DEVICE;
397 1.2 bouyer wdc_c.r_st_bmask = 0;
398 1.19 mycroft wdc_c.r_st_pmask = 0;
399 1.9 bouyer wdc_c.timeout = 10000; /* 10s */
400 1.7 bouyer } else {
401 1.22 thorpej WDCDEBUG_PRINT(("ata_get_parms: no disks\n"),
402 1.10 bouyer DEBUG_FUNCS|DEBUG_PROBE);
403 1.7 bouyer return CMD_ERR;
404 1.2 bouyer }
405 1.2 bouyer wdc_c.flags = AT_READ | flags;
406 1.2 bouyer wdc_c.data = tb;
407 1.2 bouyer wdc_c.bcount = DEV_BSIZE;
408 1.10 bouyer if (wdc_exec_command(drvp, &wdc_c) != WDC_COMPLETE) {
409 1.22 thorpej WDCDEBUG_PRINT(("ata_get_parms: wdc_exec_command failed\n"),
410 1.10 bouyer DEBUG_FUNCS|DEBUG_PROBE);
411 1.2 bouyer return CMD_AGAIN;
412 1.10 bouyer }
413 1.2 bouyer if (wdc_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
414 1.22 thorpej WDCDEBUG_PRINT(("ata_get_parms: wdc_c.flags=0x%x\n",
415 1.10 bouyer wdc_c.flags), DEBUG_FUNCS|DEBUG_PROBE);
416 1.2 bouyer return CMD_ERR;
417 1.2 bouyer } else {
418 1.17 bouyer /* if we didn't read any data something is wrong */
419 1.17 bouyer if ((wdc_c.flags & AT_XFDONE) == 0)
420 1.17 bouyer return CMD_ERR;
421 1.2 bouyer /* Read in parameter block. */
422 1.2 bouyer memcpy(prms, tb, sizeof(struct ataparams));
423 1.2 bouyer #if BYTE_ORDER == LITTLE_ENDIAN
424 1.2 bouyer /*
425 1.2 bouyer * Shuffle string byte order.
426 1.2 bouyer * ATAPI Mitsumi and NEC drives don't need this.
427 1.2 bouyer */
428 1.2 bouyer if ((prms->atap_config & WDC_CFG_ATAPI_MASK) ==
429 1.2 bouyer WDC_CFG_ATAPI &&
430 1.2 bouyer ((prms->atap_model[0] == 'N' &&
431 1.2 bouyer prms->atap_model[1] == 'E') ||
432 1.2 bouyer (prms->atap_model[0] == 'F' &&
433 1.2 bouyer prms->atap_model[1] == 'X')))
434 1.2 bouyer return 0;
435 1.2 bouyer for (i = 0; i < sizeof(prms->atap_model); i += 2) {
436 1.2 bouyer p = (u_short *)(prms->atap_model + i);
437 1.2 bouyer *p = ntohs(*p);
438 1.2 bouyer }
439 1.2 bouyer for (i = 0; i < sizeof(prms->atap_serial); i += 2) {
440 1.2 bouyer p = (u_short *)(prms->atap_serial + i);
441 1.2 bouyer *p = ntohs(*p);
442 1.2 bouyer }
443 1.2 bouyer for (i = 0; i < sizeof(prms->atap_revision); i += 2) {
444 1.2 bouyer p = (u_short *)(prms->atap_revision + i);
445 1.2 bouyer *p = ntohs(*p);
446 1.2 bouyer }
447 1.2 bouyer #endif
448 1.2 bouyer return CMD_OK;
449 1.2 bouyer }
450 1.2 bouyer }
451 1.2 bouyer
452 1.2 bouyer int
453 1.21 thorpej ata_set_mode(struct ata_drive_datas *drvp, u_int8_t mode, u_int8_t flags)
454 1.2 bouyer {
455 1.2 bouyer struct wdc_command wdc_c;
456 1.2 bouyer
457 1.22 thorpej WDCDEBUG_PRINT(("ata_set_mode=0x%x\n", mode), DEBUG_FUNCS);
458 1.2 bouyer memset(&wdc_c, 0, sizeof(struct wdc_command));
459 1.2 bouyer
460 1.2 bouyer wdc_c.r_command = SET_FEATURES;
461 1.2 bouyer wdc_c.r_st_bmask = 0;
462 1.2 bouyer wdc_c.r_st_pmask = 0;
463 1.29 thorpej wdc_c.r_features = WDSF_SET_MODE;
464 1.2 bouyer wdc_c.r_count = mode;
465 1.19 mycroft wdc_c.flags = flags;
466 1.2 bouyer wdc_c.timeout = 1000; /* 1s */
467 1.2 bouyer if (wdc_exec_command(drvp, &wdc_c) != WDC_COMPLETE)
468 1.2 bouyer return CMD_AGAIN;
469 1.2 bouyer if (wdc_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
470 1.2 bouyer return CMD_ERR;
471 1.2 bouyer }
472 1.2 bouyer return CMD_OK;
473 1.11 bouyer }
474 1.11 bouyer
475 1.11 bouyer void
476 1.21 thorpej ata_dmaerr(struct ata_drive_datas *drvp, int flags)
477 1.11 bouyer {
478 1.11 bouyer /*
479 1.11 bouyer * Downgrade decision: if we get NERRS_MAX in NXFER.
480 1.11 bouyer * We start with n_dmaerrs set to NERRS_MAX-1 so that the
481 1.11 bouyer * first error within the first NXFER ops will immediatly trigger
482 1.11 bouyer * a downgrade.
483 1.11 bouyer * If we got an error and n_xfers is bigger than NXFER reset counters.
484 1.11 bouyer */
485 1.11 bouyer drvp->n_dmaerrs++;
486 1.11 bouyer if (drvp->n_dmaerrs >= NERRS_MAX && drvp->n_xfers <= NXFER) {
487 1.20 bouyer wdc_downgrade_mode(drvp, flags);
488 1.11 bouyer drvp->n_dmaerrs = NERRS_MAX-1;
489 1.11 bouyer drvp->n_xfers = 0;
490 1.11 bouyer return;
491 1.11 bouyer }
492 1.11 bouyer if (drvp->n_xfers > NXFER) {
493 1.11 bouyer drvp->n_dmaerrs = 1; /* just got an error */
494 1.11 bouyer drvp->n_xfers = 1; /* restart counting from this error */
495 1.4 bouyer }
496 1.2 bouyer }
497 1.30 bouyer
498 1.30 bouyer /* management of the /dev/atabus* devices */
499 1.30 bouyer int atabusopen(dev, flag, fmt, p)
500 1.30 bouyer dev_t dev;
501 1.30 bouyer int flag, fmt;
502 1.30 bouyer struct proc *p;
503 1.30 bouyer {
504 1.30 bouyer struct atabus_softc *sc;
505 1.30 bouyer int error, unit = minor(dev);
506 1.30 bouyer
507 1.30 bouyer if (unit >= atabus_cd.cd_ndevs ||
508 1.30 bouyer (sc = atabus_cd.cd_devs[unit]) == NULL)
509 1.30 bouyer return (ENXIO);
510 1.30 bouyer
511 1.30 bouyer if (sc->sc_flags & ATABUSCF_OPEN)
512 1.30 bouyer return (EBUSY);
513 1.30 bouyer
514 1.30 bouyer if ((error = wdc_addref(sc->sc_chan)) != 0)
515 1.30 bouyer return (error);
516 1.30 bouyer
517 1.30 bouyer sc->sc_flags |= ATABUSCF_OPEN;
518 1.30 bouyer
519 1.30 bouyer return (0);
520 1.30 bouyer }
521 1.30 bouyer
522 1.30 bouyer
523 1.30 bouyer int
524 1.30 bouyer atabusclose(dev, flag, fmt, p)
525 1.30 bouyer dev_t dev;
526 1.30 bouyer int flag, fmt;
527 1.30 bouyer struct proc *p;
528 1.30 bouyer {
529 1.30 bouyer struct atabus_softc *sc = atabus_cd.cd_devs[minor(dev)];
530 1.30 bouyer
531 1.30 bouyer wdc_delref(sc->sc_chan);
532 1.30 bouyer
533 1.30 bouyer sc->sc_flags &= ~ATABUSCF_OPEN;
534 1.30 bouyer
535 1.30 bouyer return (0);
536 1.30 bouyer }
537 1.30 bouyer
538 1.30 bouyer int
539 1.30 bouyer atabusioctl(dev, cmd, addr, flag, p)
540 1.30 bouyer dev_t dev;
541 1.30 bouyer u_long cmd;
542 1.30 bouyer caddr_t addr;
543 1.30 bouyer int flag;
544 1.30 bouyer struct proc *p;
545 1.30 bouyer {
546 1.30 bouyer struct atabus_softc *sc = atabus_cd.cd_devs[minor(dev)];
547 1.32 bouyer struct wdc_channel *chp = sc->sc_chan;
548 1.32 bouyer int min_drive, max_drive, drive;
549 1.30 bouyer int error;
550 1.30 bouyer int s;
551 1.30 bouyer
552 1.30 bouyer /*
553 1.30 bouyer * Enforce write permission for ioctls that change the
554 1.30 bouyer * state of the bus. Host adapter specific ioctls must
555 1.30 bouyer * be checked by the adapter driver.
556 1.30 bouyer */
557 1.30 bouyer switch (cmd) {
558 1.30 bouyer case ATABUSIOSCAN:
559 1.30 bouyer case ATABUSIODETACH:
560 1.30 bouyer case ATABUSIORESET:
561 1.30 bouyer if ((flag & FWRITE) == 0)
562 1.30 bouyer return (EBADF);
563 1.30 bouyer }
564 1.30 bouyer
565 1.30 bouyer switch (cmd) {
566 1.30 bouyer case ATABUSIORESET:
567 1.30 bouyer s = splbio();
568 1.30 bouyer wdc_reset_channel(sc->sc_chan, AT_WAIT | AT_POLL);
569 1.30 bouyer splx(s);
570 1.30 bouyer error = 0;
571 1.30 bouyer break;
572 1.32 bouyer case ATABUSIOSCAN:
573 1.32 bouyer {
574 1.32 bouyer #if 0
575 1.32 bouyer struct atabusioscan_args *a=
576 1.32 bouyer (struct atabusioscan_args *)addr;
577 1.32 bouyer #endif
578 1.32 bouyer if ((chp->ch_drive[0].drive_flags & DRIVE_OLD) ||
579 1.32 bouyer (chp->ch_drive[1].drive_flags & DRIVE_OLD))
580 1.32 bouyer return (EOPNOTSUPP);
581 1.32 bouyer return (EOPNOTSUPP);
582 1.32 bouyer }
583 1.32 bouyer case ATABUSIODETACH:
584 1.32 bouyer {
585 1.32 bouyer struct atabusioscan_args *a=
586 1.32 bouyer (struct atabusioscan_args *)addr;
587 1.32 bouyer if ((chp->ch_drive[0].drive_flags & DRIVE_OLD) ||
588 1.32 bouyer (chp->ch_drive[1].drive_flags & DRIVE_OLD))
589 1.32 bouyer return (EOPNOTSUPP);
590 1.32 bouyer switch (a->at_dev) {
591 1.32 bouyer case -1:
592 1.32 bouyer min_drive = 0;
593 1.32 bouyer max_drive = 1;
594 1.32 bouyer break;
595 1.32 bouyer case 0:
596 1.32 bouyer case 1:
597 1.32 bouyer min_drive = max_drive = a->at_dev;
598 1.32 bouyer break;
599 1.32 bouyer default:
600 1.32 bouyer return (EINVAL);
601 1.32 bouyer }
602 1.32 bouyer for (drive = min_drive; drive <= max_drive; drive++) {
603 1.32 bouyer if (chp->ch_drive[drive].drv_softc != NULL) {
604 1.32 bouyer error = config_detach(
605 1.32 bouyer chp->ch_drive[drive].drv_softc, 0);
606 1.32 bouyer if (error)
607 1.32 bouyer return (error);
608 1.32 bouyer }
609 1.32 bouyer }
610 1.32 bouyer error = 0;
611 1.32 bouyer break;
612 1.32 bouyer }
613 1.30 bouyer default:
614 1.30 bouyer error = ENOTTY;
615 1.30 bouyer }
616 1.30 bouyer return (error);
617 1.30 bouyer };
618