ata.c revision 1.35 1 1.35 mycroft /* $NetBSD: ata.c,v 1.35 2004/08/10 23:09:38 mycroft 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.35 mycroft __KERNEL_RCSID(0, "$NetBSD: ata.c,v 1.35 2004/08/10 23:09:38 mycroft 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.33 bouyer (chp->ch_queue->active_xfer == NULL ||
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.33 bouyer } else if (chp->ch_queue->active_xfer != NULL &&
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.33 bouyer xfer = chp->ch_queue->active_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.35 mycroft if (wdc_addref(chp))
241 1.35 mycroft return;
242 1.35 mycroft
243 1.23 thorpej initq = malloc(sizeof(*initq), M_DEVBUF, M_WAITOK);
244 1.23 thorpej initq->atabus_sc = sc;
245 1.23 thorpej TAILQ_INSERT_TAIL(&atabus_initq_head, initq, atabus_initq);
246 1.23 thorpej config_pending_incr();
247 1.23 thorpej kthread_create(atabus_create_thread, sc);
248 1.23 thorpej }
249 1.23 thorpej
250 1.23 thorpej /*
251 1.23 thorpej * atabus_activate:
252 1.23 thorpej *
253 1.23 thorpej * Autoconfiguration activation routine.
254 1.23 thorpej */
255 1.23 thorpej static int
256 1.23 thorpej atabus_activate(struct device *self, enum devact act)
257 1.23 thorpej {
258 1.23 thorpej struct atabus_softc *sc = (void *) self;
259 1.25 thorpej struct wdc_channel *chp = sc->sc_chan;
260 1.23 thorpej struct device *dev = NULL;
261 1.23 thorpej int s, i, error = 0;
262 1.23 thorpej
263 1.23 thorpej s = splbio();
264 1.23 thorpej switch (act) {
265 1.23 thorpej case DVACT_ACTIVATE:
266 1.23 thorpej error = EOPNOTSUPP;
267 1.23 thorpej break;
268 1.23 thorpej
269 1.23 thorpej case DVACT_DEACTIVATE:
270 1.23 thorpej /*
271 1.23 thorpej * We might deactivate the children of atapibus twice
272 1.23 thorpej * (once bia atapibus, once directly), but since the
273 1.23 thorpej * generic autoconfiguration code maintains the DVF_ACTIVE
274 1.23 thorpej * flag, it's safe.
275 1.23 thorpej */
276 1.23 thorpej if ((dev = chp->atapibus) != NULL) {
277 1.23 thorpej error = config_deactivate(dev);
278 1.23 thorpej if (error)
279 1.23 thorpej goto out;
280 1.23 thorpej }
281 1.23 thorpej
282 1.23 thorpej for (i = 0; i < 2; i++) {
283 1.23 thorpej if ((dev = chp->ch_drive[i].drv_softc) != NULL) {
284 1.23 thorpej WDCDEBUG_PRINT(("atabus_activate: %s: "
285 1.23 thorpej "deactivating %s\n", sc->sc_dev.dv_xname,
286 1.23 thorpej dev->dv_xname),
287 1.23 thorpej DEBUG_DETACH);
288 1.23 thorpej error = config_deactivate(dev);
289 1.23 thorpej if (error)
290 1.23 thorpej goto out;
291 1.23 thorpej }
292 1.23 thorpej }
293 1.23 thorpej break;
294 1.23 thorpej }
295 1.23 thorpej out:
296 1.23 thorpej splx(s);
297 1.23 thorpej
298 1.23 thorpej #ifdef WDCDEBUG
299 1.23 thorpej if (dev != NULL && error != 0)
300 1.23 thorpej WDCDEBUG_PRINT(("atabus_activate: %s: "
301 1.23 thorpej "error %d deactivating %s\n", sc->sc_dev.dv_xname,
302 1.23 thorpej error, dev->dv_xname), DEBUG_DETACH);
303 1.23 thorpej #endif /* WDCDEBUG */
304 1.23 thorpej
305 1.23 thorpej return (error);
306 1.23 thorpej }
307 1.23 thorpej
308 1.23 thorpej /*
309 1.23 thorpej * atabus_detach:
310 1.23 thorpej *
311 1.23 thorpej * Autoconfiguration detach routine.
312 1.23 thorpej */
313 1.23 thorpej static int
314 1.23 thorpej atabus_detach(struct device *self, int flags)
315 1.23 thorpej {
316 1.23 thorpej struct atabus_softc *sc = (void *) self;
317 1.25 thorpej struct wdc_channel *chp = sc->sc_chan;
318 1.23 thorpej struct device *dev = NULL;
319 1.23 thorpej int i, error = 0;
320 1.23 thorpej
321 1.23 thorpej /* Shutdown the channel. */
322 1.23 thorpej /* XXX NEED AN INTERLOCK HERE. */
323 1.23 thorpej chp->ch_flags |= WDCF_SHUTDOWN;
324 1.27 thorpej wakeup(&chp->ch_thread);
325 1.27 thorpej while (chp->ch_thread != NULL)
326 1.28 bouyer (void) tsleep((void *)&chp->ch_flags, PRIBIO, "atadown", 0);
327 1.23 thorpej
328 1.23 thorpej /*
329 1.23 thorpej * Detach atapibus and its children.
330 1.23 thorpej */
331 1.23 thorpej if ((dev = chp->atapibus) != NULL) {
332 1.23 thorpej WDCDEBUG_PRINT(("atabus_detach: %s: detaching %s\n",
333 1.23 thorpej sc->sc_dev.dv_xname, dev->dv_xname), DEBUG_DETACH);
334 1.23 thorpej error = config_detach(dev, flags);
335 1.23 thorpej if (error)
336 1.23 thorpej goto out;
337 1.23 thorpej }
338 1.23 thorpej
339 1.23 thorpej /*
340 1.23 thorpej * Detach our other children.
341 1.23 thorpej */
342 1.23 thorpej for (i = 0; i < 2; i++) {
343 1.23 thorpej if (chp->ch_drive[i].drive_flags & DRIVE_ATAPI)
344 1.23 thorpej continue;
345 1.23 thorpej if ((dev = chp->ch_drive[i].drv_softc) != NULL) {
346 1.23 thorpej WDCDEBUG_PRINT(("atabus_detach: %s: detaching %s\n",
347 1.23 thorpej sc->sc_dev.dv_xname, dev->dv_xname),
348 1.23 thorpej DEBUG_DETACH);
349 1.23 thorpej error = config_detach(dev, flags);
350 1.23 thorpej if (error)
351 1.23 thorpej goto out;
352 1.23 thorpej }
353 1.23 thorpej }
354 1.23 thorpej
355 1.23 thorpej out:
356 1.23 thorpej #ifdef WDCDEBUG
357 1.23 thorpej if (dev != NULL && error != 0)
358 1.23 thorpej WDCDEBUG_PRINT(("atabus_detach: %s: error %d detaching %s\n",
359 1.23 thorpej sc->sc_dev.dv_xname, error, dev->dv_xname),
360 1.23 thorpej DEBUG_DETACH);
361 1.23 thorpej #endif /* WDCDEBUG */
362 1.23 thorpej
363 1.23 thorpej return (error);
364 1.23 thorpej }
365 1.23 thorpej
366 1.23 thorpej CFATTACH_DECL(atabus, sizeof(struct atabus_softc),
367 1.23 thorpej atabus_match, atabus_attach, atabus_detach, atabus_activate);
368 1.23 thorpej
369 1.23 thorpej /*****************************************************************************
370 1.23 thorpej * Common ATA bus operations.
371 1.23 thorpej *****************************************************************************/
372 1.23 thorpej
373 1.2 bouyer /* Get the disk's parameters */
374 1.2 bouyer int
375 1.21 thorpej ata_get_params(struct ata_drive_datas *drvp, u_int8_t flags,
376 1.21 thorpej struct ataparams *prms)
377 1.2 bouyer {
378 1.2 bouyer char tb[DEV_BSIZE];
379 1.2 bouyer struct wdc_command wdc_c;
380 1.2 bouyer
381 1.2 bouyer #if BYTE_ORDER == LITTLE_ENDIAN
382 1.2 bouyer int i;
383 1.2 bouyer u_int16_t *p;
384 1.2 bouyer #endif
385 1.2 bouyer
386 1.22 thorpej WDCDEBUG_PRINT(("ata_get_parms\n"), DEBUG_FUNCS);
387 1.2 bouyer
388 1.2 bouyer memset(tb, 0, DEV_BSIZE);
389 1.2 bouyer memset(prms, 0, sizeof(struct ataparams));
390 1.2 bouyer memset(&wdc_c, 0, sizeof(struct wdc_command));
391 1.2 bouyer
392 1.2 bouyer if (drvp->drive_flags & DRIVE_ATA) {
393 1.2 bouyer wdc_c.r_command = WDCC_IDENTIFY;
394 1.5 bouyer wdc_c.r_st_bmask = WDCS_DRDY;
395 1.19 mycroft wdc_c.r_st_pmask = 0;
396 1.18 bouyer wdc_c.timeout = 3000; /* 3s */
397 1.7 bouyer } else if (drvp->drive_flags & DRIVE_ATAPI) {
398 1.2 bouyer wdc_c.r_command = ATAPI_IDENTIFY_DEVICE;
399 1.2 bouyer wdc_c.r_st_bmask = 0;
400 1.19 mycroft wdc_c.r_st_pmask = 0;
401 1.9 bouyer wdc_c.timeout = 10000; /* 10s */
402 1.7 bouyer } else {
403 1.22 thorpej WDCDEBUG_PRINT(("ata_get_parms: no disks\n"),
404 1.10 bouyer DEBUG_FUNCS|DEBUG_PROBE);
405 1.7 bouyer return CMD_ERR;
406 1.2 bouyer }
407 1.2 bouyer wdc_c.flags = AT_READ | flags;
408 1.2 bouyer wdc_c.data = tb;
409 1.2 bouyer wdc_c.bcount = DEV_BSIZE;
410 1.10 bouyer if (wdc_exec_command(drvp, &wdc_c) != WDC_COMPLETE) {
411 1.22 thorpej WDCDEBUG_PRINT(("ata_get_parms: wdc_exec_command failed\n"),
412 1.10 bouyer DEBUG_FUNCS|DEBUG_PROBE);
413 1.2 bouyer return CMD_AGAIN;
414 1.10 bouyer }
415 1.2 bouyer if (wdc_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
416 1.22 thorpej WDCDEBUG_PRINT(("ata_get_parms: wdc_c.flags=0x%x\n",
417 1.10 bouyer wdc_c.flags), DEBUG_FUNCS|DEBUG_PROBE);
418 1.2 bouyer return CMD_ERR;
419 1.2 bouyer } else {
420 1.17 bouyer /* if we didn't read any data something is wrong */
421 1.17 bouyer if ((wdc_c.flags & AT_XFDONE) == 0)
422 1.17 bouyer return CMD_ERR;
423 1.2 bouyer /* Read in parameter block. */
424 1.2 bouyer memcpy(prms, tb, sizeof(struct ataparams));
425 1.2 bouyer #if BYTE_ORDER == LITTLE_ENDIAN
426 1.2 bouyer /*
427 1.2 bouyer * Shuffle string byte order.
428 1.2 bouyer * ATAPI Mitsumi and NEC drives don't need this.
429 1.2 bouyer */
430 1.2 bouyer if ((prms->atap_config & WDC_CFG_ATAPI_MASK) ==
431 1.2 bouyer WDC_CFG_ATAPI &&
432 1.2 bouyer ((prms->atap_model[0] == 'N' &&
433 1.2 bouyer prms->atap_model[1] == 'E') ||
434 1.2 bouyer (prms->atap_model[0] == 'F' &&
435 1.2 bouyer prms->atap_model[1] == 'X')))
436 1.2 bouyer return 0;
437 1.2 bouyer for (i = 0; i < sizeof(prms->atap_model); i += 2) {
438 1.2 bouyer p = (u_short *)(prms->atap_model + i);
439 1.2 bouyer *p = ntohs(*p);
440 1.2 bouyer }
441 1.2 bouyer for (i = 0; i < sizeof(prms->atap_serial); i += 2) {
442 1.2 bouyer p = (u_short *)(prms->atap_serial + i);
443 1.2 bouyer *p = ntohs(*p);
444 1.2 bouyer }
445 1.2 bouyer for (i = 0; i < sizeof(prms->atap_revision); i += 2) {
446 1.2 bouyer p = (u_short *)(prms->atap_revision + i);
447 1.2 bouyer *p = ntohs(*p);
448 1.2 bouyer }
449 1.2 bouyer #endif
450 1.2 bouyer return CMD_OK;
451 1.2 bouyer }
452 1.2 bouyer }
453 1.2 bouyer
454 1.2 bouyer int
455 1.21 thorpej ata_set_mode(struct ata_drive_datas *drvp, u_int8_t mode, u_int8_t flags)
456 1.2 bouyer {
457 1.2 bouyer struct wdc_command wdc_c;
458 1.2 bouyer
459 1.22 thorpej WDCDEBUG_PRINT(("ata_set_mode=0x%x\n", mode), DEBUG_FUNCS);
460 1.2 bouyer memset(&wdc_c, 0, sizeof(struct wdc_command));
461 1.2 bouyer
462 1.2 bouyer wdc_c.r_command = SET_FEATURES;
463 1.2 bouyer wdc_c.r_st_bmask = 0;
464 1.2 bouyer wdc_c.r_st_pmask = 0;
465 1.29 thorpej wdc_c.r_features = WDSF_SET_MODE;
466 1.2 bouyer wdc_c.r_count = mode;
467 1.19 mycroft wdc_c.flags = flags;
468 1.2 bouyer wdc_c.timeout = 1000; /* 1s */
469 1.2 bouyer if (wdc_exec_command(drvp, &wdc_c) != WDC_COMPLETE)
470 1.2 bouyer return CMD_AGAIN;
471 1.2 bouyer if (wdc_c.flags & (AT_ERROR | AT_TIMEOU | AT_DF)) {
472 1.2 bouyer return CMD_ERR;
473 1.2 bouyer }
474 1.2 bouyer return CMD_OK;
475 1.11 bouyer }
476 1.11 bouyer
477 1.11 bouyer void
478 1.21 thorpej ata_dmaerr(struct ata_drive_datas *drvp, int flags)
479 1.11 bouyer {
480 1.11 bouyer /*
481 1.11 bouyer * Downgrade decision: if we get NERRS_MAX in NXFER.
482 1.11 bouyer * We start with n_dmaerrs set to NERRS_MAX-1 so that the
483 1.11 bouyer * first error within the first NXFER ops will immediatly trigger
484 1.11 bouyer * a downgrade.
485 1.11 bouyer * If we got an error and n_xfers is bigger than NXFER reset counters.
486 1.11 bouyer */
487 1.11 bouyer drvp->n_dmaerrs++;
488 1.11 bouyer if (drvp->n_dmaerrs >= NERRS_MAX && drvp->n_xfers <= NXFER) {
489 1.20 bouyer wdc_downgrade_mode(drvp, flags);
490 1.11 bouyer drvp->n_dmaerrs = NERRS_MAX-1;
491 1.11 bouyer drvp->n_xfers = 0;
492 1.11 bouyer return;
493 1.11 bouyer }
494 1.11 bouyer if (drvp->n_xfers > NXFER) {
495 1.11 bouyer drvp->n_dmaerrs = 1; /* just got an error */
496 1.11 bouyer drvp->n_xfers = 1; /* restart counting from this error */
497 1.4 bouyer }
498 1.2 bouyer }
499 1.30 bouyer
500 1.30 bouyer /* management of the /dev/atabus* devices */
501 1.30 bouyer int atabusopen(dev, flag, fmt, p)
502 1.30 bouyer dev_t dev;
503 1.30 bouyer int flag, fmt;
504 1.30 bouyer struct proc *p;
505 1.30 bouyer {
506 1.30 bouyer struct atabus_softc *sc;
507 1.30 bouyer int error, unit = minor(dev);
508 1.30 bouyer
509 1.30 bouyer if (unit >= atabus_cd.cd_ndevs ||
510 1.30 bouyer (sc = atabus_cd.cd_devs[unit]) == NULL)
511 1.30 bouyer return (ENXIO);
512 1.30 bouyer
513 1.30 bouyer if (sc->sc_flags & ATABUSCF_OPEN)
514 1.30 bouyer return (EBUSY);
515 1.30 bouyer
516 1.30 bouyer if ((error = wdc_addref(sc->sc_chan)) != 0)
517 1.30 bouyer return (error);
518 1.30 bouyer
519 1.30 bouyer sc->sc_flags |= ATABUSCF_OPEN;
520 1.30 bouyer
521 1.30 bouyer return (0);
522 1.30 bouyer }
523 1.30 bouyer
524 1.30 bouyer
525 1.30 bouyer int
526 1.30 bouyer atabusclose(dev, flag, fmt, p)
527 1.30 bouyer dev_t dev;
528 1.30 bouyer int flag, fmt;
529 1.30 bouyer struct proc *p;
530 1.30 bouyer {
531 1.30 bouyer struct atabus_softc *sc = atabus_cd.cd_devs[minor(dev)];
532 1.30 bouyer
533 1.30 bouyer wdc_delref(sc->sc_chan);
534 1.30 bouyer
535 1.30 bouyer sc->sc_flags &= ~ATABUSCF_OPEN;
536 1.30 bouyer
537 1.30 bouyer return (0);
538 1.30 bouyer }
539 1.30 bouyer
540 1.30 bouyer int
541 1.30 bouyer atabusioctl(dev, cmd, addr, flag, p)
542 1.30 bouyer dev_t dev;
543 1.30 bouyer u_long cmd;
544 1.30 bouyer caddr_t addr;
545 1.30 bouyer int flag;
546 1.30 bouyer struct proc *p;
547 1.30 bouyer {
548 1.30 bouyer struct atabus_softc *sc = atabus_cd.cd_devs[minor(dev)];
549 1.32 bouyer struct wdc_channel *chp = sc->sc_chan;
550 1.32 bouyer int min_drive, max_drive, drive;
551 1.30 bouyer int error;
552 1.30 bouyer int s;
553 1.30 bouyer
554 1.30 bouyer /*
555 1.30 bouyer * Enforce write permission for ioctls that change the
556 1.30 bouyer * state of the bus. Host adapter specific ioctls must
557 1.30 bouyer * be checked by the adapter driver.
558 1.30 bouyer */
559 1.30 bouyer switch (cmd) {
560 1.30 bouyer case ATABUSIOSCAN:
561 1.30 bouyer case ATABUSIODETACH:
562 1.30 bouyer case ATABUSIORESET:
563 1.30 bouyer if ((flag & FWRITE) == 0)
564 1.30 bouyer return (EBADF);
565 1.30 bouyer }
566 1.30 bouyer
567 1.30 bouyer switch (cmd) {
568 1.30 bouyer case ATABUSIORESET:
569 1.30 bouyer s = splbio();
570 1.30 bouyer wdc_reset_channel(sc->sc_chan, AT_WAIT | AT_POLL);
571 1.30 bouyer splx(s);
572 1.30 bouyer error = 0;
573 1.30 bouyer break;
574 1.32 bouyer case ATABUSIOSCAN:
575 1.32 bouyer {
576 1.32 bouyer #if 0
577 1.32 bouyer struct atabusioscan_args *a=
578 1.32 bouyer (struct atabusioscan_args *)addr;
579 1.32 bouyer #endif
580 1.32 bouyer if ((chp->ch_drive[0].drive_flags & DRIVE_OLD) ||
581 1.32 bouyer (chp->ch_drive[1].drive_flags & DRIVE_OLD))
582 1.32 bouyer return (EOPNOTSUPP);
583 1.32 bouyer return (EOPNOTSUPP);
584 1.32 bouyer }
585 1.32 bouyer case ATABUSIODETACH:
586 1.32 bouyer {
587 1.32 bouyer struct atabusioscan_args *a=
588 1.32 bouyer (struct atabusioscan_args *)addr;
589 1.32 bouyer if ((chp->ch_drive[0].drive_flags & DRIVE_OLD) ||
590 1.32 bouyer (chp->ch_drive[1].drive_flags & DRIVE_OLD))
591 1.32 bouyer return (EOPNOTSUPP);
592 1.32 bouyer switch (a->at_dev) {
593 1.32 bouyer case -1:
594 1.32 bouyer min_drive = 0;
595 1.32 bouyer max_drive = 1;
596 1.32 bouyer break;
597 1.32 bouyer case 0:
598 1.32 bouyer case 1:
599 1.32 bouyer min_drive = max_drive = a->at_dev;
600 1.32 bouyer break;
601 1.32 bouyer default:
602 1.32 bouyer return (EINVAL);
603 1.32 bouyer }
604 1.32 bouyer for (drive = min_drive; drive <= max_drive; drive++) {
605 1.32 bouyer if (chp->ch_drive[drive].drv_softc != NULL) {
606 1.32 bouyer error = config_detach(
607 1.32 bouyer chp->ch_drive[drive].drv_softc, 0);
608 1.32 bouyer if (error)
609 1.32 bouyer return (error);
610 1.34 bouyer chp->ch_drive[drive].drv_softc = NULL;
611 1.32 bouyer }
612 1.32 bouyer }
613 1.32 bouyer error = 0;
614 1.32 bouyer break;
615 1.32 bouyer }
616 1.30 bouyer default:
617 1.30 bouyer error = ENOTTY;
618 1.30 bouyer }
619 1.30 bouyer return (error);
620 1.30 bouyer };
621