siisata.c revision 1.27.6.3 1 /* $NetBSD: siisata.c,v 1.27.6.3 2017/02/05 13:40:28 skrll Exp $ */
2
3 /* from ahcisata_core.c */
4
5 /*
6 * Copyright (c) 2006 Manuel Bouyer.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
28 */
29
30 /* from atapi_wdc.c */
31
32 /*
33 * Copyright (c) 1998, 2001 Manuel Bouyer.
34 *
35 * Redistribution and use in source and binary forms, with or without
36 * modification, are permitted provided that the following conditions
37 * are met:
38 * 1. Redistributions of source code must retain the above copyright
39 * notice, this list of conditions and the following disclaimer.
40 * 2. Redistributions in binary form must reproduce the above copyright
41 * notice, this list of conditions and the following disclaimer in the
42 * documentation and/or other materials provided with the distribution.
43 *
44 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
45 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
46 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
47 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
48 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
49 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
50 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
51 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
52 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
53 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
54 */
55
56 /*
57 * Copyright (c) 2007, 2008, 2009, 2010 Jonathan A. Kollasch.
58 * All rights reserved.
59 *
60 * Redistribution and use in source and binary forms, with or without
61 * modification, are permitted provided that the following conditions
62 * are met:
63 * 1. Redistributions of source code must retain the above copyright
64 * notice, this list of conditions and the following disclaimer.
65 * 2. Redistributions in binary form must reproduce the above copyright
66 * notice, this list of conditions and the following disclaimer in the
67 * documentation and/or other materials provided with the distribution.
68 *
69 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
70 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
71 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
72 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
73 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
74 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
75 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
76 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
77 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
78 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
79 */
80
81 #include <sys/cdefs.h>
82 __KERNEL_RCSID(0, "$NetBSD: siisata.c,v 1.27.6.3 2017/02/05 13:40:28 skrll Exp $");
83
84 #include <sys/types.h>
85 #include <sys/malloc.h>
86 #include <sys/param.h>
87 #include <sys/kernel.h>
88 #include <sys/systm.h>
89 #include <sys/syslog.h>
90 #include <sys/disklabel.h>
91 #include <sys/buf.h>
92 #include <sys/proc.h>
93
94 #include <dev/ata/atareg.h>
95 #include <dev/ata/satavar.h>
96 #include <dev/ata/satareg.h>
97 #include <dev/ata/satafisvar.h>
98 #include <dev/ata/satafisreg.h>
99 #include <dev/ata/satapmpreg.h>
100 #include <dev/ic/siisatavar.h>
101 #include <dev/ic/siisatareg.h>
102
103 #include <dev/scsipi/scsi_all.h> /* for SCSI status */
104
105 #include "atapibus.h"
106
107 #ifdef SIISATA_DEBUG
108 int siisata_debug_mask = 0;
109 #endif
110
111 #define ATA_DELAY 10000 /* 10s for a drive I/O */
112
113 #ifndef __BUS_SPACE_HAS_STREAM_METHODS
114 #if _BYTE_ORDER == _LITTLE_ENDIAN
115 #define bus_space_read_stream_4 bus_space_read_4
116 #define bus_space_read_region_stream_4 bus_space_read_region_4
117 #else
118 static inline uint32_t
119 bus_space_read_stream_4(bus_space_tag_t t, bus_space_handle_t h, bus_size_t o)
120 {
121 return htole32(bus_space_read_4(t, h, o));
122 }
123
124 static inline void
125 bus_space_read_region_stream_4(bus_space_tag_t t, bus_space_handle_t h, bus_size_t o, uint32_t *p, bus_size_t c)
126 {
127 bus_space_read_region_4(t, h, o, p, c);
128 for (bus_size_t i = 0; i < c; i++) {
129 p[i] = htole32(p[i]);
130 }
131 }
132 #endif
133 #endif
134
135 static void siisata_attach_port(struct siisata_softc *, int);
136 static void siisata_intr_port(struct siisata_channel *);
137
138 void siisata_probe_drive(struct ata_channel *);
139 void siisata_setup_channel(struct ata_channel *);
140
141 int siisata_ata_bio(struct ata_drive_datas *, struct ata_bio *);
142 void siisata_reset_drive(struct ata_drive_datas *, int, uint32_t *);
143 void siisata_reset_channel(struct ata_channel *, int);
144 int siisata_ata_addref(struct ata_drive_datas *);
145 void siisata_ata_delref(struct ata_drive_datas *);
146 void siisata_killpending(struct ata_drive_datas *);
147
148 void siisata_cmd_start(struct ata_channel *, struct ata_xfer *);
149 int siisata_cmd_complete(struct ata_channel *, struct ata_xfer *, int);
150 void siisata_cmd_done(struct ata_channel *, struct ata_xfer *, int);
151 void siisata_cmd_kill_xfer(struct ata_channel *, struct ata_xfer *, int);
152
153 void siisata_bio_start(struct ata_channel *, struct ata_xfer *);
154 int siisata_bio_complete(struct ata_channel *, struct ata_xfer *, int);
155 void siisata_bio_kill_xfer(struct ata_channel *, struct ata_xfer *, int);
156 int siisata_exec_command(struct ata_drive_datas *, struct ata_command *);
157
158 void siisata_timeout(void *);
159
160 static void siisata_reinit_port(struct ata_channel *);
161 static void siisata_device_reset(struct ata_channel *);
162 static void siisata_activate_prb(struct siisata_channel *, int);
163 static void siisata_deactivate_prb(struct siisata_channel *, int);
164 static int siisata_dma_setup(struct ata_channel *chp, int slot,
165 void *data, size_t, int);
166
167 #if NATAPIBUS > 0
168 void siisata_atapibus_attach(struct atabus_softc *);
169 void siisata_atapi_probe_device(struct atapibus_softc *, int);
170 void siisata_atapi_minphys(struct buf *);
171 void siisata_atapi_start(struct ata_channel *,struct ata_xfer *);
172 int siisata_atapi_complete(struct ata_channel *, struct ata_xfer *, int);
173 void siisata_atapi_kill_xfer(struct ata_channel *, struct ata_xfer *, int);
174 void siisata_atapi_done(struct ata_channel *, struct ata_xfer *, int);
175 void siisata_atapi_scsipi_request(struct scsipi_channel *,
176 scsipi_adapter_req_t, void *);
177 void siisata_atapi_kill_pending(struct scsipi_periph *);
178 #endif /* NATAPIBUS */
179
180 const struct ata_bustype siisata_ata_bustype = {
181 SCSIPI_BUSTYPE_ATA,
182 siisata_ata_bio,
183 siisata_reset_drive,
184 siisata_reset_channel,
185 siisata_exec_command,
186 ata_get_params,
187 siisata_ata_addref,
188 siisata_ata_delref,
189 siisata_killpending
190 };
191
192 #if NATAPIBUS > 0
193 static const struct scsipi_bustype siisata_atapi_bustype = {
194 SCSIPI_BUSTYPE_ATAPI,
195 atapi_scsipi_cmd,
196 atapi_interpret_sense,
197 atapi_print_addr,
198 siisata_atapi_kill_pending,
199 NULL,
200 };
201 #endif /* NATAPIBUS */
202
203
204 void
205 siisata_attach(struct siisata_softc *sc)
206 {
207 int i;
208
209 SIISATA_DEBUG_PRINT(("%s: %s: GR_GC: 0x%08x\n",
210 SIISATANAME(sc), __func__, GRREAD(sc, GR_GC)), DEBUG_FUNCS);
211
212 sc->sc_atac.atac_cap = ATAC_CAP_DMA | ATAC_CAP_UDMA;
213 sc->sc_atac.atac_pio_cap = 4;
214 sc->sc_atac.atac_dma_cap = 2;
215 sc->sc_atac.atac_udma_cap = 6;
216 sc->sc_atac.atac_channels = sc->sc_chanarray;
217 sc->sc_atac.atac_probe = siisata_probe_drive;
218 sc->sc_atac.atac_bustype_ata = &siisata_ata_bustype;
219 sc->sc_atac.atac_set_modes = siisata_setup_channel;
220 #if NATAPIBUS > 0
221 sc->sc_atac.atac_atapibus_attach = siisata_atapibus_attach;
222 #endif
223
224 /* come out of reset state */
225 GRWRITE(sc, GR_GC, 0);
226
227 for (i = 0; i < sc->sc_atac.atac_nchannels; i++) {
228 siisata_attach_port(sc, i);
229 }
230
231 SIISATA_DEBUG_PRINT(("%s: %s: GR_GC: 0x%08x\n",
232 SIISATANAME(sc), __func__, GRREAD(sc, GR_GC)),
233 DEBUG_FUNCS);
234 return;
235 }
236
237 static void
238 siisata_disable_port_interrupt(struct ata_channel *chp)
239 {
240 struct siisata_softc *sc = (struct siisata_softc *)chp->ch_atac;
241
242 PRWRITE(sc, PRX(chp->ch_channel, PRO_PIEC), 0xffffffff);
243 }
244
245 static void
246 siisata_enable_port_interrupt(struct ata_channel *chp)
247 {
248 struct siisata_softc *sc = (struct siisata_softc *)chp->ch_atac;
249
250 /* clear any interrupts */
251 (void)PRREAD(sc, PRX(chp->ch_channel, PRO_PSS));
252 PRWRITE(sc, PRX(chp->ch_channel, PRO_PIS), 0xffffffff);
253 /* and enable CmdErrr+CmdCmpl interrupting */
254 PRWRITE(sc, PRX(chp->ch_channel, PRO_PIES),
255 PR_PIS_CMDERRR | PR_PIS_CMDCMPL);
256 }
257
258 static void
259 siisata_init_port(struct siisata_softc *sc, int port)
260 {
261 struct siisata_channel *schp;
262 struct ata_channel *chp;
263
264 schp = &sc->sc_channels[port];
265 chp = (struct ata_channel *)schp;
266
267 /* come out of reset, 64-bit activation */
268 PRWRITE(sc, PRX(chp->ch_channel, PRO_PCC),
269 PR_PC_32BA | PR_PC_PORT_RESET);
270 /* initialize port */
271 siisata_reinit_port(chp);
272 /* enable CmdErrr+CmdCmpl interrupting */
273 siisata_enable_port_interrupt(chp);
274 /* enable port interrupt */
275 GRWRITE(sc, GR_GC, GRREAD(sc, GR_GC) | GR_GC_PXIE(chp->ch_channel));
276 }
277
278 static void
279 siisata_attach_port(struct siisata_softc *sc, int port)
280 {
281 int j;
282 int dmasize;
283 int error;
284 void *prbp;
285 struct siisata_channel *schp;
286 struct ata_channel *chp;
287
288 schp = &sc->sc_channels[port];
289 chp = (struct ata_channel *)schp;
290 sc->sc_chanarray[port] = chp;
291 chp->ch_channel = port;
292 chp->ch_atac = &sc->sc_atac;
293 chp->ch_queue = malloc(sizeof(struct ata_queue),
294 M_DEVBUF, M_NOWAIT|M_ZERO);
295 if (chp->ch_queue == NULL) {
296 aprint_error_dev(sc->sc_atac.atac_dev,
297 "port %d: can't allocate memory "
298 "for command queue\n", chp->ch_channel);
299 return;
300 }
301
302 dmasize = SIISATA_CMD_SIZE * SIISATA_MAX_SLOTS;
303
304 SIISATA_DEBUG_PRINT(("%s: %s: dmasize: %d\n", SIISATANAME(sc),
305 __func__, dmasize), DEBUG_FUNCS);
306
307 error = bus_dmamem_alloc(sc->sc_dmat, dmasize, PAGE_SIZE, 0,
308 &schp->sch_prb_seg, 1, &schp->sch_prb_nseg, BUS_DMA_NOWAIT);
309 if (error) {
310 aprint_error_dev(sc->sc_atac.atac_dev,
311 "unable to allocate PRB table memory, "
312 "error=%d\n", error);
313 return;
314 }
315
316 error = bus_dmamem_map(sc->sc_dmat,
317 &schp->sch_prb_seg, schp->sch_prb_nseg,
318 dmasize, &prbp, BUS_DMA_NOWAIT | BUS_DMA_COHERENT);
319 if (error) {
320 aprint_error_dev(sc->sc_atac.atac_dev,
321 "unable to map PRB table memory, "
322 "error=%d\n", error);
323 bus_dmamem_free(sc->sc_dmat,
324 &schp->sch_prb_seg, schp->sch_prb_nseg);
325 return;
326 }
327
328 error = bus_dmamap_create(sc->sc_dmat, dmasize, 1, dmasize, 0,
329 BUS_DMA_NOWAIT, &schp->sch_prbd);
330 if (error) {
331 aprint_error_dev(sc->sc_atac.atac_dev,
332 "unable to create PRB table map, "
333 "error=%d\n", error);
334 bus_dmamem_unmap(sc->sc_dmat, prbp, dmasize);
335 bus_dmamem_free(sc->sc_dmat,
336 &schp->sch_prb_seg, schp->sch_prb_nseg);
337 return;
338 }
339
340 error = bus_dmamap_load(sc->sc_dmat, schp->sch_prbd,
341 prbp, dmasize, NULL, BUS_DMA_NOWAIT);
342 if (error) {
343 aprint_error_dev(sc->sc_atac.atac_dev,
344 "unable to load PRB table map, "
345 "error=%d\n", error);
346 bus_dmamap_destroy(sc->sc_dmat, schp->sch_prbd);
347 bus_dmamem_unmap(sc->sc_dmat, prbp, dmasize);
348 bus_dmamem_free(sc->sc_dmat,
349 &schp->sch_prb_seg, schp->sch_prb_nseg);
350 return;
351 }
352
353 for (j = 0; j < SIISATA_MAX_SLOTS; j++) {
354 schp->sch_prb[j] = (struct siisata_prb *)
355 ((char *)prbp + SIISATA_CMD_SIZE * j);
356 schp->sch_bus_prb[j] =
357 schp->sch_prbd->dm_segs[0].ds_addr +
358 SIISATA_CMD_SIZE * j;
359 error = bus_dmamap_create(sc->sc_dmat, MAXPHYS,
360 SIISATA_NSGE, MAXPHYS, 0,
361 BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
362 &schp->sch_datad[j]);
363 if (error) {
364 aprint_error_dev(sc->sc_atac.atac_dev,
365 "couldn't create xfer DMA map, error=%d\n",
366 error);
367 return;
368 }
369 }
370
371 if (bus_space_subregion(sc->sc_prt, sc->sc_prh,
372 PRX(chp->ch_channel, PRO_SSTATUS), 4, &schp->sch_sstatus) != 0) {
373 aprint_error_dev(sc->sc_atac.atac_dev,
374 "couldn't map port %d SStatus regs\n",
375 chp->ch_channel);
376 return;
377 }
378 if (bus_space_subregion(sc->sc_prt, sc->sc_prh,
379 PRX(chp->ch_channel, PRO_SCONTROL), 4, &schp->sch_scontrol) != 0) {
380 aprint_error_dev(sc->sc_atac.atac_dev,
381 "couldn't map port %d SControl regs\n",
382 chp->ch_channel);
383 return;
384 }
385 if (bus_space_subregion(sc->sc_prt, sc->sc_prh,
386 PRX(chp->ch_channel, PRO_SERROR), 4, &schp->sch_serror) != 0) {
387 aprint_error_dev(sc->sc_atac.atac_dev,
388 "couldn't map port %d SError regs\n",
389 chp->ch_channel);
390 return;
391 }
392
393 siisata_init_port(sc, port);
394
395 ata_channel_attach(chp);
396
397 return;
398 }
399
400 int
401 siisata_detach(struct siisata_softc *sc, int flags)
402 {
403 struct atac_softc *atac = &sc->sc_atac;
404 struct scsipi_adapter *adapt = &atac->atac_atapi_adapter._generic;
405 struct siisata_channel *schp;
406 struct ata_channel *chp;
407 int i, j, error;
408
409 for (i = 0; i < sc->sc_atac.atac_nchannels; i++) {
410 schp = &sc->sc_channels[i];
411 chp = sc->sc_chanarray[i];
412
413 if (chp->atabus == NULL)
414 continue;
415 if ((error = config_detach(chp->atabus, flags)) != 0)
416 return error;
417
418 for (j = 0; j < SIISATA_MAX_SLOTS; j++)
419 bus_dmamap_destroy(sc->sc_dmat, schp->sch_datad[j]);
420
421 bus_dmamap_unload(sc->sc_dmat, schp->sch_prbd);
422 bus_dmamap_destroy(sc->sc_dmat, schp->sch_prbd);
423 bus_dmamem_unmap(sc->sc_dmat, schp->sch_prb[0],
424 SIISATA_CMD_SIZE * SIISATA_MAX_SLOTS);
425 bus_dmamem_free(sc->sc_dmat,
426 &schp->sch_prb_seg, schp->sch_prb_nseg);
427
428 free(chp->ch_queue, M_DEVBUF);
429 chp->atabus = NULL;
430 }
431
432 if (adapt->adapt_refcnt != 0)
433 return EBUSY;
434
435 /* leave the chip in reset */
436 GRWRITE(sc, GR_GC, GR_GC_GLBLRST);
437
438 return 0;
439 }
440
441 void
442 siisata_resume(struct siisata_softc *sc)
443 {
444 int i;
445
446 /* come out of reset state */
447 GRWRITE(sc, GR_GC, 0);
448
449 for (i = 0; i < sc->sc_atac.atac_nchannels; i++) {
450 siisata_init_port(sc, i);
451 }
452
453 }
454
455 int
456 siisata_intr(void *v)
457 {
458 struct siisata_softc *sc = v;
459 uint32_t is;
460 int i, r = 0;
461 while ((is = GRREAD(sc, GR_GIS))) {
462 SIISATA_DEBUG_PRINT(("%s: %s: GR_GIS: 0x%08x\n",
463 SIISATANAME(sc), __func__, is), DEBUG_INTR);
464 r = 1;
465 for (i = 0; i < sc->sc_atac.atac_nchannels; i++)
466 if (is & GR_GIS_PXIS(i))
467 siisata_intr_port(&sc->sc_channels[i]);
468 }
469 return r;
470 }
471
472 static void
473 siisata_intr_port(struct siisata_channel *schp)
474 {
475 struct siisata_softc *sc;
476 struct ata_channel *chp;
477 struct ata_xfer *xfer;
478 int slot;
479 uint32_t pss, pis;
480 uint32_t prbfis;
481
482 sc = (struct siisata_softc *)schp->ata_channel.ch_atac;
483 chp = &schp->ata_channel;
484 xfer = chp->ch_queue->active_xfer;
485 slot = SIISATA_NON_NCQ_SLOT;
486
487 pis = PRREAD(sc, PRX(chp->ch_channel, PRO_PIS));
488
489 SIISATA_DEBUG_PRINT(("%s: %s port %d, pis 0x%x ",
490 SIISATANAME(sc), __func__, chp->ch_channel, pis), DEBUG_INTR);
491
492 if (pis & PR_PIS_CMDCMPL) {
493 /* get slot status, clearing completion interrupt */
494 pss = PRREAD(sc, PRX(chp->ch_channel, PRO_PSS));
495 SIISATA_DEBUG_PRINT(("pss 0x%x\n", pss), DEBUG_INTR);
496 /* is this expected? */
497 /* XXX improve */
498 if ((schp->sch_active_slots & __BIT(slot)) == 0) {
499 aprint_error( "%s: unexpected command "
500 "completion on port %d\n",
501 SIISATANAME(sc), chp->ch_channel);
502 return;
503 }
504 if ((~pss & __BIT(slot)) == 0) {
505 aprint_error( "%s: unknown slot "
506 "completion on port %d, pss 0x%x\n",
507 SIISATANAME(sc), chp->ch_channel, pss);
508 return;
509 }
510 } else if (pis & PR_PIS_CMDERRR) {
511 uint32_t ec;
512
513 /* emulate a CRC error by default */
514 chp->ch_status = WDCS_ERR;
515 chp->ch_error = WDCE_CRC;
516
517 ec = PRREAD(sc, PRX(chp->ch_channel, PRO_PCE));
518 SIISATA_DEBUG_PRINT(("ec %d\n", ec), DEBUG_INTR);
519 if (ec <= PR_PCE_DATAFISERROR) {
520 if (ec == PR_PCE_DEVICEERROR && xfer != NULL) {
521 /* read in specific information about error */
522 prbfis = bus_space_read_stream_4(
523 sc->sc_prt, sc->sc_prh,
524 PRSX(chp->ch_channel, slot, PRSO_FIS));
525 /* set ch_status and ch_error */
526 satafis_rdh_parse(chp, (uint8_t *)&prbfis);
527 }
528 siisata_reinit_port(chp);
529 } else {
530 aprint_error_dev(sc->sc_atac.atac_dev, "fatal error %d"
531 " on channel %d (ctx 0x%x), resetting\n",
532 ec, chp->ch_channel,
533 PRREAD(sc, PRX(chp->ch_channel, PRO_PCR)));
534 /* okay, we have a "Fatal Error" */
535 siisata_device_reset(chp);
536 }
537 }
538
539 /* clear some (ok, all) ints */
540 PRWRITE(sc, PRX(chp->ch_channel, PRO_PIS), 0xffffffff);
541 if (xfer && xfer->c_intr)
542 xfer->c_intr(chp, xfer, slot);
543
544 return;
545 }
546
547 void
548 siisata_reset_drive(struct ata_drive_datas *drvp, int flags, uint32_t *sigp)
549 {
550 struct ata_channel *chp = drvp->chnl_softc;
551 struct siisata_softc *sc = (struct siisata_softc *)chp->ch_atac;
552 struct siisata_channel *schp = (struct siisata_channel *)chp;
553 struct siisata_prb *prb;
554 int slot = SIISATA_NON_NCQ_SLOT;
555 int i;
556
557 /* wait for ready */
558 while (!(PRREAD(sc, PRX(chp->ch_channel, PRO_PS)) & PR_PS_PORT_READY))
559 DELAY(10);
560
561 prb = schp->sch_prb[slot];
562 memset(prb, 0, sizeof(struct siisata_prb));
563 prb->prb_control =
564 htole16(PRB_CF_SOFT_RESET | PRB_CF_INTERRUPT_MASK);
565 KASSERT(drvp->drive <= PMP_PORT_CTL);
566 prb->prb_fis[rhd_c] = drvp->drive;
567
568 siisata_activate_prb(schp, slot);
569
570 for(i = 0; i < 3100; i++) {
571 if ((PRREAD(sc, PRX(chp->ch_channel, PRO_PSS)) &
572 PR_PXSS(slot)) == 0)
573 break;
574 if (flags & AT_WAIT)
575 tsleep(schp, PRIBIO, "siiprb", mstohz(10));
576 else
577 DELAY(10000);
578 }
579
580 siisata_deactivate_prb(schp, slot);
581 if (i == 3100) {
582 /* timeout */
583 siisata_device_reset(chp);
584 if (sigp)
585 *sigp = 0xffffffff;
586 } else {
587 /* read the signature out of the FIS */
588 if (sigp) {
589 *sigp = 0;
590 *sigp |= (PRREAD(sc, PRSX(chp->ch_channel, slot,
591 PRSO_FIS+0x4)) & 0x00ffffff) << 8;
592 *sigp |= PRREAD(sc, PRSX(chp->ch_channel, slot,
593 PRSO_FIS+0xc)) & 0xff;
594 }
595 }
596
597 #if 1
598 /* attempt to downgrade signaling in event of CRC error */
599 /* XXX should be part of the MI (S)ATA subsystem */
600 if (chp->ch_status == 0x51 && chp->ch_error == 0x84) {
601 bus_space_write_4(sc->sc_prt, schp->sch_scontrol, 0,
602 SControl_IPM_NONE | SControl_SPD_G1 | SControl_DET_INIT);
603 DELAY(10);
604 bus_space_write_4(sc->sc_prt, schp->sch_scontrol, 0,
605 SControl_IPM_NONE | SControl_SPD_G1);
606 DELAY(10);
607 for (;;) {
608 if ((bus_space_read_4(sc->sc_prt, schp->sch_sstatus, 0)
609 & SStatus_DET_mask) == SStatus_DET_DEV)
610 break;
611 DELAY(10);
612 }
613 }
614 #endif
615
616 #if 1
617 chp->ch_status = 0;
618 chp->ch_error = 0;
619 #endif
620 return;
621 }
622
623 void
624 siisata_reset_channel(struct ata_channel *chp, int flags)
625 {
626 struct siisata_softc *sc = (struct siisata_softc *)chp->ch_atac;
627 struct siisata_channel *schp = (struct siisata_channel *)chp;
628
629 SIISATA_DEBUG_PRINT(("%s: %s\n", SIISATANAME(sc), __func__),
630 DEBUG_FUNCS);
631
632 if (sata_reset_interface(chp, sc->sc_prt, schp->sch_scontrol,
633 schp->sch_sstatus, flags) != SStatus_DET_DEV) {
634 aprint_error("%s port %d: reset failed\n",
635 SIISATANAME(sc), chp->ch_channel);
636 /* XXX and then ? */
637 }
638 /* wait for ready */
639 while (!(PRREAD(sc, PRX(chp->ch_channel, PRO_PS)) & PR_PS_PORT_READY))
640 DELAY(10);
641 PRWRITE(sc, PRX(chp->ch_channel, PRO_SERROR),
642 PRREAD(sc, PRX(chp->ch_channel, PRO_SERROR)));
643 if (chp->ch_queue->active_xfer) {
644 chp->ch_queue->active_xfer->c_kill_xfer(chp,
645 chp->ch_queue->active_xfer, KILL_RESET);
646 }
647
648 return;
649 }
650
651 int
652 siisata_ata_addref(struct ata_drive_datas *drvp)
653 {
654 return 0;
655 }
656
657 void
658 siisata_ata_delref(struct ata_drive_datas *drvp)
659 {
660 return;
661 }
662
663 void
664 siisata_killpending(struct ata_drive_datas *drvp)
665 {
666 return;
667 }
668
669 void
670 siisata_probe_drive(struct ata_channel *chp)
671 {
672 struct siisata_softc *sc = (struct siisata_softc *)chp->ch_atac;
673 struct siisata_channel *schp = (struct siisata_channel *)chp;
674 int i;
675 uint32_t sig;
676 int slot = SIISATA_NON_NCQ_SLOT;
677 struct siisata_prb *prb;
678 bool timed_out;
679
680 SIISATA_DEBUG_PRINT(("%s: %s: port %d start\n", SIISATANAME(sc),
681 __func__, chp->ch_channel), DEBUG_FUNCS);
682
683 /*
684 * disable port interrupt as we're polling for PHY up and
685 * prb completion
686 */
687 siisata_disable_port_interrupt(chp);
688
689 switch(sata_reset_interface(chp, sc->sc_prt, schp->sch_scontrol,
690 schp->sch_sstatus, AT_WAIT)) {
691 case SStatus_DET_DEV:
692 /* clear any interrupts */
693 (void)PRREAD(sc, PRX(chp->ch_channel, PRO_PSS));
694 PRWRITE(sc, PRX(chp->ch_channel, PRO_PIS), 0xffffffff);
695 /* wait for ready */
696 while (!(PRREAD(sc, PRX(chp->ch_channel, PRO_PS))
697 & PR_PS_PORT_READY))
698 DELAY(10);
699 prb = schp->sch_prb[slot];
700 memset(prb, 0, sizeof(struct siisata_prb));
701 prb->prb_control = htole16(PRB_CF_SOFT_RESET);
702 prb->prb_fis[rhd_c] = PMP_PORT_CTL;
703
704 siisata_activate_prb(schp, slot);
705
706 timed_out = 1;
707 for(i = 0; i < 3100; i++) {
708 if ((PRREAD(sc, PRX(chp->ch_channel, PRO_PSS)) &
709 PR_PXSS(slot)) == 0) {
710 /* prb completed */
711 timed_out = 0;
712 break;
713 }
714 if (PRREAD(sc, PRX(chp->ch_channel, PRO_PIS)) &
715 (PR_PIS_CMDERRR << 16)) {
716 /* we got an error; handle as timeout */
717 break;
718 }
719
720 tsleep(schp, PRIBIO, "siiprb", mstohz(10));
721 }
722
723 siisata_deactivate_prb(schp, slot);
724 if (timed_out) {
725 aprint_error_dev(sc->sc_atac.atac_dev,
726 "SOFT_RESET failed on port %d (error %d PSS 0x%x), "
727 "resetting\n", chp->ch_channel,
728 PRREAD(sc, PRX(chp->ch_channel, PRO_PCE)),
729 PRREAD(sc, PRX(chp->ch_channel, PRO_PSS)));
730 siisata_reinit_port(chp);
731 break;
732 }
733
734 /* read the signature out of the FIS */
735 sig = 0;
736 sig |= (PRREAD(sc, PRSX(chp->ch_channel, slot,
737 PRSO_FIS+0x4)) & 0x00ffffff) << 8;
738 sig |= PRREAD(sc, PRSX(chp->ch_channel, slot,
739 PRSO_FIS+0xc)) & 0xff;
740
741 SIISATA_DEBUG_PRINT(("%s: %s: sig=0x%08x\n", SIISATANAME(sc),
742 __func__, sig), DEBUG_PROBE);
743
744 if (sig == 0x96690101)
745 PRWRITE(sc, PRX(chp->ch_channel, PRO_PCS),
746 PR_PC_PMP_ENABLE);
747 sata_interpret_sig(chp, 0, sig);
748 break;
749 default:
750 break;
751 }
752
753 siisata_enable_port_interrupt(chp);
754 SIISATA_DEBUG_PRINT(("%s: %s: port %d done\n", SIISATANAME(sc),
755 __func__, chp->ch_channel), DEBUG_PROBE);
756 return;
757 }
758
759 void
760 siisata_setup_channel(struct ata_channel *chp)
761 {
762 return;
763 }
764
765 int
766 siisata_exec_command(struct ata_drive_datas *drvp, struct ata_command *ata_c)
767 {
768 struct ata_channel *chp = drvp->chnl_softc;
769 struct ata_xfer *xfer;
770 int ret;
771 int s;
772
773 SIISATA_DEBUG_PRINT(("%s: %s begins\n",
774 SIISATANAME((struct siisata_softc *)chp->ch_atac), __func__),
775 DEBUG_FUNCS);
776
777 xfer = ata_get_xfer(ata_c->flags & AT_WAIT ?
778 ATAXF_CANSLEEP : ATAXF_NOSLEEP);
779 if (xfer == NULL)
780 return ATACMD_TRY_AGAIN;
781 if (ata_c->flags & AT_POLL)
782 xfer->c_flags |= C_POLL;
783 if (ata_c->flags & AT_WAIT)
784 xfer->c_flags |= C_WAIT;
785 xfer->c_drive = drvp->drive;
786 xfer->c_databuf = ata_c->data;
787 xfer->c_bcount = ata_c->bcount;
788 xfer->c_cmd = ata_c;
789 xfer->c_start = siisata_cmd_start;
790 xfer->c_intr = siisata_cmd_complete;
791 xfer->c_kill_xfer = siisata_cmd_kill_xfer;
792 s = splbio();
793 ata_exec_xfer(chp, xfer);
794 #ifdef DIAGNOSTIC
795 if ((ata_c->flags & AT_POLL) != 0 &&
796 (ata_c->flags & AT_DONE) == 0)
797 panic("%s: polled command not done", __func__);
798 #endif
799 if (ata_c->flags & AT_DONE) {
800 ret = ATACMD_COMPLETE;
801 } else {
802 if (ata_c->flags & AT_WAIT) {
803 while ((ata_c->flags & AT_DONE) == 0) {
804 SIISATA_DEBUG_PRINT(("%s: %s: sleeping\n",
805 SIISATANAME(
806 (struct siisata_softc *)chp->ch_atac),
807 __func__), DEBUG_FUNCS);
808 tsleep(ata_c, PRIBIO, "siicmd", 0);
809 }
810 ret = ATACMD_COMPLETE;
811 } else {
812 ret = ATACMD_QUEUED;
813 }
814 }
815 splx(s);
816 SIISATA_DEBUG_PRINT( ("%s: %s ends\n",
817 SIISATANAME((struct siisata_softc *)chp->ch_atac), __func__),
818 DEBUG_FUNCS);
819 return ret;
820 }
821
822 void
823 siisata_cmd_start(struct ata_channel *chp, struct ata_xfer *xfer)
824 {
825 struct siisata_channel *schp = (struct siisata_channel *)chp;
826 struct ata_command *ata_c = xfer->c_cmd;
827 int slot = SIISATA_NON_NCQ_SLOT;
828 struct siisata_prb *prb;
829 int i;
830
831 SIISATA_DEBUG_PRINT(("%s: %s port %d drive %d command 0x%x, slot %d\n",
832 SIISATANAME((struct siisata_softc *)chp->ch_atac),
833 __func__, chp->ch_channel, xfer->c_drive,
834 ata_c->r_command, slot),
835 DEBUG_FUNCS|DEBUG_XFERS);
836
837 chp->ch_status = 0;
838 chp->ch_error = 0;
839
840 prb = schp->sch_prb[slot];
841 memset(prb, 0, sizeof(struct siisata_prb));
842
843 satafis_rhd_construct_cmd(ata_c, prb->prb_fis);
844 KASSERT(xfer->c_drive <= PMP_PORT_CTL);
845 prb->prb_fis[rhd_c] |= xfer->c_drive;
846
847 memset(prb->prb_atapi, 0, sizeof(prb->prb_atapi));
848
849 if (ata_c->r_command == ATA_DATA_SET_MANAGEMENT) {
850 prb->prb_control |= htole16(PRB_CF_PROTOCOL_OVERRIDE);
851 prb->prb_protocol_override |= htole16(PRB_PO_WRITE);
852 }
853
854 if (siisata_dma_setup(chp, slot,
855 (ata_c->flags & (AT_READ | AT_WRITE)) ? ata_c->data : NULL,
856 ata_c->bcount,
857 (ata_c->flags & AT_READ) ? BUS_DMA_READ : BUS_DMA_WRITE)) {
858 ata_c->flags |= AT_DF;
859 siisata_cmd_complete(chp, xfer, slot);
860 return;
861 }
862
863 if (xfer->c_flags & C_POLL) {
864 /* polled command, disable interrupts */
865 prb->prb_control = htole16(PRB_CF_INTERRUPT_MASK);
866 siisata_disable_port_interrupt(chp);
867 }
868
869 /* go for it */
870 siisata_activate_prb(schp, slot);
871
872 if ((ata_c->flags & AT_POLL) == 0) {
873 chp->ch_flags |= ATACH_IRQ_WAIT; /* wait for interrupt */
874 callout_reset(&chp->ch_callout, mstohz(ata_c->timeout),
875 siisata_timeout, chp);
876 goto out;
877 }
878
879 /*
880 * polled command
881 */
882 for (i = 0; i < ata_c->timeout / 10; i++) {
883 if (ata_c->flags & AT_DONE)
884 break;
885 siisata_intr_port(schp);
886 DELAY(1000);
887 }
888
889 if ((ata_c->flags & AT_DONE) == 0) {
890 siisata_timeout(chp);
891 }
892
893 /* reenable interrupts */
894 siisata_enable_port_interrupt(chp);
895 out:
896 SIISATA_DEBUG_PRINT(
897 ("%s: %s: done\n", SIISATANAME((struct siisata_softc *)chp->ch_atac), __func__), DEBUG_FUNCS);
898 return;
899 }
900
901 void
902 siisata_cmd_kill_xfer(struct ata_channel *chp, struct ata_xfer *xfer,
903 int reason)
904 {
905 int slot = SIISATA_NON_NCQ_SLOT;
906
907 struct ata_command *ata_c = xfer->c_cmd;
908 switch (reason) {
909 case KILL_GONE:
910 ata_c->flags |= AT_GONE;
911 break;
912 case KILL_RESET:
913 ata_c->flags |= AT_RESET;
914 break;
915 default:
916 panic("%s: port %d: unknown reason %d",
917 __func__, chp->ch_channel, reason);
918 }
919 siisata_cmd_done(chp, xfer, slot);
920 }
921
922 int
923 siisata_cmd_complete(struct ata_channel *chp, struct ata_xfer *xfer, int slot)
924 {
925 struct ata_command *ata_c = xfer->c_cmd;
926 #ifdef SIISATA_DEBUG
927 struct siisata_softc *sc = (struct siisata_softc *)chp->ch_atac;
928 #endif
929
930 SIISATA_DEBUG_PRINT(
931 ("%s: %s\n", SIISATANAME(sc), __func__), DEBUG_FUNCS|DEBUG_XFERS);
932
933 chp->ch_flags &= ~ATACH_IRQ_WAIT;
934 if (xfer->c_flags & C_TIMEOU)
935 ata_c->flags |= AT_TIMEOU;
936 else
937 callout_stop(&chp->ch_callout);
938
939 if (chp->ch_status & WDCS_BSY) {
940 ata_c->flags |= AT_TIMEOU;
941 } else if (chp->ch_status & WDCS_ERR) {
942 ata_c->r_error = chp->ch_error;
943 ata_c->flags |= AT_ERROR;
944 }
945
946 if (chp->ch_drive[xfer->c_drive].drive_flags & ATA_DRIVE_WAITDRAIN) {
947 siisata_cmd_kill_xfer(chp, xfer, KILL_GONE);
948 chp->ch_drive[xfer->c_drive].drive_flags &= ~ATA_DRIVE_WAITDRAIN;
949 wakeup(&chp->ch_queue->active_xfer);
950 return 0;
951 } else
952 siisata_cmd_done(chp, xfer, slot);
953
954 return 0;
955 }
956
957 void
958 siisata_cmd_done(struct ata_channel *chp, struct ata_xfer *xfer, int slot)
959 {
960 uint32_t fis[howmany(RDH_FISLEN,sizeof(uint32_t))];
961 struct siisata_softc *sc = (struct siisata_softc *)chp->ch_atac;
962 struct siisata_channel *schp = (struct siisata_channel *)chp;
963 struct ata_command *ata_c = xfer->c_cmd;
964 uint16_t *idwordbuf;
965 int i;
966
967 SIISATA_DEBUG_PRINT(
968 ("%s: %s flags 0x%x error 0x%x\n", SIISATANAME(sc), __func__,
969 ata_c->flags, ata_c->r_error), DEBUG_FUNCS|DEBUG_XFERS);
970
971 siisata_deactivate_prb(schp, slot);
972
973 if (ata_c->flags & (AT_READ | AT_WRITE)) {
974 bus_dmamap_sync(sc->sc_dmat, schp->sch_datad[slot], 0,
975 schp->sch_datad[slot]->dm_mapsize,
976 (ata_c->flags & AT_READ) ? BUS_DMASYNC_POSTREAD :
977 BUS_DMASYNC_POSTWRITE);
978 bus_dmamap_unload(sc->sc_dmat, schp->sch_datad[slot]);
979 }
980
981 if (ata_c->flags & AT_READREG) {
982 bus_space_read_region_stream_4(sc->sc_prt, sc->sc_prh,
983 PRSX(chp->ch_channel, slot, PRSO_FIS),
984 fis, __arraycount(fis));
985 satafis_rdh_cmd_readreg(ata_c, (uint8_t *)fis);
986 }
987
988 /* correct the endianess of IDENTIFY data */
989 if (ata_c->r_command == WDCC_IDENTIFY ||
990 ata_c->r_command == ATAPI_IDENTIFY_DEVICE) {
991 idwordbuf = xfer->c_databuf;
992 for (i = 0; i < (xfer->c_bcount / sizeof(*idwordbuf)); i++) {
993 idwordbuf[i] = le16toh(idwordbuf[i]);
994 }
995 }
996
997 ata_c->flags |= AT_DONE;
998 if (PRREAD(sc, PRSX(chp->ch_channel, slot, PRSO_RTC)))
999 ata_c->flags |= AT_XFDONE;
1000
1001 chp->ch_queue->active_xfer = NULL;
1002 ata_free_xfer(chp, xfer);
1003 if (ata_c->flags & AT_WAIT)
1004 wakeup(ata_c);
1005 else if (ata_c->callback)
1006 ata_c->callback(ata_c->callback_arg);
1007 atastart(chp);
1008 return;
1009 }
1010
1011 int
1012 siisata_ata_bio(struct ata_drive_datas *drvp, struct ata_bio *ata_bio)
1013 {
1014 struct ata_channel *chp = drvp->chnl_softc;
1015 struct ata_xfer *xfer;
1016
1017 SIISATA_DEBUG_PRINT( ("%s: %s.\n",
1018 SIISATANAME((struct siisata_softc *)chp->ch_atac),
1019 __func__), DEBUG_FUNCS);
1020
1021 xfer = ata_get_xfer(ATAXF_NOSLEEP);
1022 if (xfer == NULL)
1023 return ATACMD_TRY_AGAIN;
1024 if (ata_bio->flags & ATA_POLL)
1025 xfer->c_flags |= C_POLL;
1026 xfer->c_drive = drvp->drive;
1027 xfer->c_cmd = ata_bio;
1028 xfer->c_databuf = ata_bio->databuf;
1029 xfer->c_bcount = ata_bio->bcount;
1030 xfer->c_start = siisata_bio_start;
1031 xfer->c_intr = siisata_bio_complete;
1032 xfer->c_kill_xfer = siisata_bio_kill_xfer;
1033 ata_exec_xfer(chp, xfer);
1034 return (ata_bio->flags & ATA_ITSDONE) ?
1035 ATACMD_COMPLETE : ATACMD_QUEUED;
1036 }
1037
1038 void
1039 siisata_bio_start(struct ata_channel *chp, struct ata_xfer *xfer)
1040 {
1041 struct siisata_channel *schp = (struct siisata_channel *)chp;
1042 struct siisata_prb *prb;
1043 struct ata_bio *ata_bio = xfer->c_cmd;
1044 int slot = SIISATA_NON_NCQ_SLOT;
1045 int i;
1046
1047 SIISATA_DEBUG_PRINT(
1048 ("%s: %s port %d, slot %d\n",
1049 SIISATANAME((struct siisata_softc *)chp->ch_atac), __func__, chp->ch_channel, slot),
1050 DEBUG_FUNCS);
1051
1052 chp->ch_status = 0;
1053 chp->ch_error = 0;
1054
1055 prb = schp->sch_prb[slot];
1056 memset(prb, 0, sizeof(struct siisata_prb));
1057
1058 satafis_rhd_construct_bio(xfer, prb->prb_fis);
1059 KASSERT(xfer->c_drive <= PMP_PORT_CTL);
1060 prb->prb_fis[rhd_c] |= xfer->c_drive;
1061
1062 memset(prb->prb_atapi, 0, sizeof(prb->prb_atapi));
1063
1064 if (siisata_dma_setup(chp, slot, ata_bio->databuf, ata_bio->bcount,
1065 (ata_bio->flags & ATA_READ) ? BUS_DMA_READ : BUS_DMA_WRITE)) {
1066 ata_bio->error = ERR_DMA;
1067 ata_bio->r_error = 0;
1068 siisata_bio_complete(chp, xfer, slot);
1069 return;
1070 }
1071
1072 if (xfer->c_flags & C_POLL) {
1073 /* polled command, disable interrupts */
1074 prb->prb_control = htole16(PRB_CF_INTERRUPT_MASK);
1075 siisata_disable_port_interrupt(chp);
1076 }
1077
1078 siisata_activate_prb(schp, slot);
1079
1080 if ((ata_bio->flags & ATA_POLL) == 0) {
1081 chp->ch_flags |= ATACH_IRQ_WAIT; /* wait for interrupt */
1082 callout_reset(&chp->ch_callout, mstohz(ATA_DELAY),
1083 siisata_timeout, chp);
1084 goto out;
1085 }
1086
1087 /*
1088 * polled command
1089 */
1090 for (i = 0; i < ATA_DELAY / 10; i++) {
1091 if (ata_bio->flags & ATA_ITSDONE)
1092 break;
1093 siisata_intr_port(schp);
1094 DELAY(1000);
1095 }
1096
1097 siisata_enable_port_interrupt(chp);
1098 out:
1099 SIISATA_DEBUG_PRINT(
1100 ("%s: %s: done\n", SIISATANAME((struct siisata_softc *)chp->ch_atac), __func__), DEBUG_FUNCS);
1101 return;
1102 }
1103
1104 void
1105 siisata_bio_kill_xfer(struct ata_channel *chp, struct ata_xfer *xfer,
1106 int reason)
1107 {
1108 struct siisata_channel *schp = (struct siisata_channel *)chp;
1109 struct ata_bio *ata_bio = xfer->c_cmd;
1110 int drive = xfer->c_drive;
1111 int slot = SIISATA_NON_NCQ_SLOT;
1112
1113 SIISATA_DEBUG_PRINT(("%s: %s: port %d\n",
1114 SIISATANAME((struct siisata_softc *)chp->ch_atac),
1115 __func__, chp->ch_channel), DEBUG_FUNCS);
1116
1117 siisata_deactivate_prb(schp, slot);
1118
1119 ata_free_xfer(chp, xfer);
1120 ata_bio->flags |= ATA_ITSDONE;
1121 switch (reason) {
1122 case KILL_GONE:
1123 ata_bio->error = ERR_NODEV;
1124 break;
1125 case KILL_RESET:
1126 ata_bio->error = ERR_RESET;
1127 break;
1128 default:
1129 panic("%s: port %d: unknown reason %d",
1130 __func__, chp->ch_channel, reason);
1131 }
1132 ata_bio->r_error = WDCE_ABRT;
1133 (*chp->ch_drive[drive].drv_done)(chp->ch_drive[drive].drv_softc);
1134 }
1135
1136 int
1137 siisata_bio_complete(struct ata_channel *chp, struct ata_xfer *xfer, int slot)
1138 {
1139 struct siisata_softc *sc = (struct siisata_softc *)chp->ch_atac;
1140 struct siisata_channel *schp = (struct siisata_channel *)chp;
1141 struct ata_bio *ata_bio = xfer->c_cmd;
1142 int drive = xfer->c_drive;
1143
1144 schp->sch_active_slots &= ~__BIT(slot);
1145 chp->ch_flags &= ~ATACH_IRQ_WAIT;
1146 if (xfer->c_flags & C_TIMEOU) {
1147 ata_bio->error = TIMEOUT;
1148 } else {
1149 callout_stop(&chp->ch_callout);
1150 ata_bio->error = NOERROR;
1151 }
1152
1153 bus_dmamap_sync(sc->sc_dmat, schp->sch_datad[slot], 0,
1154 schp->sch_datad[slot]->dm_mapsize,
1155 (ata_bio->flags & ATA_READ) ? BUS_DMASYNC_POSTREAD :
1156 BUS_DMASYNC_POSTWRITE);
1157 bus_dmamap_unload(sc->sc_dmat, schp->sch_datad[slot]);
1158
1159 if (chp->ch_drive[xfer->c_drive].drive_flags & ATA_DRIVE_WAITDRAIN) {
1160 siisata_bio_kill_xfer(chp, xfer, KILL_GONE);
1161 chp->ch_drive[xfer->c_drive].drive_flags &= ~ATA_DRIVE_WAITDRAIN;
1162 wakeup(&chp->ch_queue->active_xfer);
1163 return 0;
1164 }
1165
1166 chp->ch_queue->active_xfer = NULL;
1167 ata_free_xfer(chp, xfer);
1168 ata_bio->flags |= ATA_ITSDONE;
1169 if (chp->ch_status & WDCS_DWF) {
1170 ata_bio->error = ERR_DF;
1171 } else if (chp->ch_status & WDCS_ERR) {
1172 ata_bio->error = ERROR;
1173 ata_bio->r_error = chp->ch_error;
1174 } else if (chp->ch_status & WDCS_CORR)
1175 ata_bio->flags |= ATA_CORR;
1176
1177 SIISATA_DEBUG_PRINT(("%s: %s bcount: %ld", SIISATANAME(sc),
1178 __func__, ata_bio->bcount), DEBUG_XFERS);
1179 if (ata_bio->error == NOERROR) {
1180 if (ata_bio->flags & ATA_READ)
1181 ata_bio->bcount -=
1182 PRREAD(sc, PRSX(chp->ch_channel, slot, PRSO_RTC));
1183 else
1184 ata_bio->bcount = 0;
1185 }
1186 SIISATA_DEBUG_PRINT((" now %ld\n", ata_bio->bcount), DEBUG_XFERS);
1187 if (ata_bio->flags & ATA_POLL)
1188 return 1;
1189 (*chp->ch_drive[drive].drv_done)(chp->ch_drive[drive].drv_softc);
1190 atastart(chp);
1191 return 0;
1192 }
1193
1194 void
1195 siisata_timeout(void *v)
1196 {
1197 struct ata_channel *chp = (struct ata_channel *)v;
1198 struct ata_xfer *xfer = chp->ch_queue->active_xfer;
1199 int slot = SIISATA_NON_NCQ_SLOT;
1200 int s = splbio();
1201 SIISATA_DEBUG_PRINT(("%s: %p\n", __func__, xfer), DEBUG_INTR);
1202 siisata_device_reset(chp);
1203 if ((chp->ch_flags & ATACH_IRQ_WAIT) != 0) {
1204 xfer->c_flags |= C_TIMEOU;
1205 xfer->c_intr(chp, xfer, slot);
1206 }
1207 splx(s);
1208 }
1209
1210 static int
1211 siisata_dma_setup(struct ata_channel *chp, int slot, void *data,
1212 size_t count, int op)
1213 {
1214
1215 int error, seg;
1216 struct siisata_softc *sc = (struct siisata_softc *)chp->ch_atac;
1217 struct siisata_channel *schp = (struct siisata_channel *)chp;
1218
1219 struct siisata_prb *prbp;
1220
1221 prbp = schp->sch_prb[slot];
1222
1223 if (data == NULL) {
1224 goto end;
1225 }
1226
1227 error = bus_dmamap_load(sc->sc_dmat, schp->sch_datad[slot],
1228 data, count, NULL, BUS_DMA_NOWAIT | BUS_DMA_STREAMING | op);
1229 if (error) {
1230 aprint_error("%s port %d: "
1231 "failed to load xfer in slot %d: error %d\n",
1232 SIISATANAME(sc), chp->ch_channel, slot, error);
1233 return error;
1234 }
1235
1236 bus_dmamap_sync(sc->sc_dmat, schp->sch_datad[slot], 0,
1237 schp->sch_datad[slot]->dm_mapsize,
1238 (op == BUS_DMA_READ) ? BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
1239
1240 /* make sure it's clean */
1241 memset(prbp->prb_sge, 0, SIISATA_NSGE * sizeof(struct siisata_prb));
1242
1243 SIISATA_DEBUG_PRINT(("%s: %d segs, %ld count\n", __func__,
1244 schp->sch_datad[slot]->dm_nsegs, (long unsigned int) count),
1245 DEBUG_FUNCS | DEBUG_DEBUG);
1246
1247 for (seg = 0; seg < schp->sch_datad[slot]->dm_nsegs; seg++) {
1248 prbp->prb_sge[seg].sge_da =
1249 htole64(schp->sch_datad[slot]->dm_segs[seg].ds_addr);
1250 prbp->prb_sge[seg].sge_dc =
1251 htole32(schp->sch_datad[slot]->dm_segs[seg].ds_len);
1252 prbp->prb_sge[seg].sge_flags = htole32(0);
1253 }
1254 prbp->prb_sge[seg - 1].sge_flags |= htole32(SGE_FLAG_TRM);
1255 end:
1256 return 0;
1257 }
1258
1259 static void
1260 siisata_activate_prb(struct siisata_channel *schp, int slot)
1261 {
1262 struct siisata_softc *sc;
1263 bus_size_t offset;
1264 uint64_t pprb;
1265
1266 sc = (struct siisata_softc *)schp->ata_channel.ch_atac;
1267
1268 KASSERTMSG((schp->sch_active_slots & __BIT(slot)) != __BIT(slot),
1269 "%s: trying to activate active slot %d", SIISATANAME(sc), slot);
1270
1271 SIISATA_PRB_SYNC(sc, schp, slot, BUS_DMASYNC_PREWRITE);
1272 /* keep track of what's going on */
1273 schp->sch_active_slots |= __BIT(slot);
1274
1275 offset = PRO_CARX(schp->ata_channel.ch_channel, slot);
1276
1277 pprb = schp->sch_bus_prb[slot];
1278
1279 PRWRITE(sc, offset + 0, pprb >> 0);
1280 PRWRITE(sc, offset + 4, pprb >> 32);
1281 }
1282
1283 static void
1284 siisata_deactivate_prb(struct siisata_channel *schp, int slot)
1285 {
1286 struct siisata_softc *sc;
1287
1288 sc = (struct siisata_softc *)schp->ata_channel.ch_atac;
1289
1290 KASSERTMSG((schp->sch_active_slots & __BIT(slot)) != 0,
1291 "%s: trying to deactivate inactive slot %d", SIISATANAME(sc),
1292 slot);
1293
1294 schp->sch_active_slots &= ~__BIT(slot); /* mark free */
1295 SIISATA_PRB_SYNC(sc, schp, slot, BUS_DMASYNC_POSTWRITE);
1296 }
1297
1298 static void
1299 siisata_reinit_port(struct ata_channel *chp)
1300 {
1301 struct siisata_softc *sc = (struct siisata_softc *)chp->ch_atac;
1302
1303 PRWRITE(sc, PRX(chp->ch_channel, PRO_PCS), PR_PC_PORT_INITIALIZE);
1304 while (!(PRREAD(sc, PRX(chp->ch_channel, PRO_PS)) & PR_PS_PORT_READY))
1305 DELAY(10);
1306 if (chp->ch_ndrives > 1)
1307 PRWRITE(sc, PRX(chp->ch_channel, PRO_PCS), PR_PC_PMP_ENABLE);
1308 }
1309
1310 static void
1311 siisata_device_reset(struct ata_channel *chp)
1312 {
1313 struct siisata_softc *sc = (struct siisata_softc *)chp->ch_atac;
1314
1315 PRWRITE(sc, PRX(chp->ch_channel, PRO_PCS), PR_PC_DEVICE_RESET);
1316 while (!(PRREAD(sc, PRX(chp->ch_channel, PRO_PS)) & PR_PS_PORT_READY))
1317 DELAY(10);
1318 }
1319
1320
1321 #if NATAPIBUS > 0
1322 void
1323 siisata_atapibus_attach(struct atabus_softc *ata_sc)
1324 {
1325 struct ata_channel *chp = ata_sc->sc_chan;
1326 struct atac_softc *atac = chp->ch_atac;
1327 struct scsipi_adapter *adapt = &atac->atac_atapi_adapter._generic;
1328 struct scsipi_channel *chan = &chp->ch_atapi_channel;
1329
1330 /*
1331 * Fill in the scsipi_adapter.
1332 */
1333 adapt->adapt_dev = atac->atac_dev;
1334 adapt->adapt_nchannels = atac->atac_nchannels;
1335 adapt->adapt_request = siisata_atapi_scsipi_request;
1336 adapt->adapt_minphys = siisata_atapi_minphys;
1337 atac->atac_atapi_adapter.atapi_probe_device =
1338 siisata_atapi_probe_device;
1339
1340 /*
1341 * Fill in the scsipi_channel.
1342 */
1343 memset(chan, 0, sizeof(*chan));
1344 chan->chan_adapter = adapt;
1345 chan->chan_bustype = &siisata_atapi_bustype;
1346 chan->chan_channel = chp->ch_channel;
1347 chan->chan_flags = SCSIPI_CHAN_OPENINGS;
1348 chan->chan_openings = 1;
1349 chan->chan_max_periph = 1;
1350 chan->chan_ntargets = 1;
1351 chan->chan_nluns = 1;
1352
1353 chp->atapibus = config_found_ia(ata_sc->sc_dev, "atapi", chan,
1354 atapiprint);
1355 }
1356
1357 void
1358 siisata_atapi_minphys(struct buf *bp)
1359 {
1360 if (bp->b_bcount > MAXPHYS)
1361 bp->b_bcount = MAXPHYS;
1362 minphys(bp);
1363 }
1364
1365 /*
1366 * Kill off all pending xfers for a periph.
1367 *
1368 * Must be called at splbio().
1369 */
1370 void
1371 siisata_atapi_kill_pending(struct scsipi_periph *periph)
1372 {
1373 struct atac_softc *atac =
1374 device_private(periph->periph_channel->chan_adapter->adapt_dev);
1375 struct ata_channel *chp =
1376 atac->atac_channels[periph->periph_channel->chan_channel];
1377
1378 ata_kill_pending(&chp->ch_drive[periph->periph_target]);
1379 }
1380
1381 void
1382 siisata_atapi_kill_xfer(struct ata_channel *chp, struct ata_xfer *xfer,
1383 int reason)
1384 {
1385 struct scsipi_xfer *sc_xfer = xfer->c_cmd;
1386
1387 /* remove this command from xfer queue */
1388 switch (reason) {
1389 case KILL_GONE:
1390 sc_xfer->error = XS_DRIVER_STUFFUP;
1391 break;
1392 case KILL_RESET:
1393 sc_xfer->error = XS_RESET;
1394 break;
1395 default:
1396 panic("%s: port %d: unknown reason %d",
1397 __func__, chp->ch_channel, reason);
1398 }
1399 ata_free_xfer(chp, xfer);
1400 scsipi_done(sc_xfer);
1401 }
1402
1403 void
1404 siisata_atapi_probe_device(struct atapibus_softc *sc, int target)
1405 {
1406 struct scsipi_channel *chan = sc->sc_channel;
1407 struct scsipi_periph *periph;
1408 struct ataparams ids;
1409 struct ataparams *id = &ids;
1410 struct siisata_softc *siic =
1411 device_private(chan->chan_adapter->adapt_dev);
1412 struct atac_softc *atac = &siic->sc_atac;
1413 struct ata_channel *chp = atac->atac_channels[chan->chan_channel];
1414 struct ata_drive_datas *drvp = &chp->ch_drive[target];
1415 struct scsipibus_attach_args sa;
1416 char serial_number[21], model[41], firmware_revision[9];
1417 int s;
1418
1419 /* skip if already attached */
1420 if (scsipi_lookup_periph(chan, target, 0) != NULL)
1421 return;
1422
1423 /* if no ATAPI device detected at attach time, skip */
1424 if (drvp->drive_type != ATA_DRIVET_ATAPI) {
1425 SIISATA_DEBUG_PRINT(("%s: drive %d "
1426 "not present\n", __func__, target), DEBUG_PROBE);
1427 return;
1428 }
1429
1430 /* Some ATAPI devices need a bit more time after software reset. */
1431 DELAY(5000);
1432 if (ata_get_params(drvp, AT_WAIT, id) == 0) {
1433 #ifdef ATAPI_DEBUG_PROBE
1434 log(LOG_DEBUG, "%s drive %d: cmdsz 0x%x drqtype 0x%x\n",
1435 device_xname(sc->sc_dev), target,
1436 id->atap_config & ATAPI_CFG_CMD_MASK,
1437 id->atap_config & ATAPI_CFG_DRQ_MASK);
1438 #endif
1439 periph = scsipi_alloc_periph(M_NOWAIT);
1440 if (periph == NULL) {
1441 aprint_error_dev(sc->sc_dev,
1442 "%s: unable to allocate periph for "
1443 "channel %d drive %d\n", __func__,
1444 chp->ch_channel, target);
1445 return;
1446 }
1447 periph->periph_dev = NULL;
1448 periph->periph_channel = chan;
1449 periph->periph_switch = &atapi_probe_periphsw;
1450 periph->periph_target = target;
1451 periph->periph_lun = 0;
1452 periph->periph_quirks = PQUIRK_ONLYBIG;
1453
1454 #ifdef SCSIPI_DEBUG
1455 if (SCSIPI_DEBUG_TYPE == SCSIPI_BUSTYPE_ATAPI &&
1456 SCSIPI_DEBUG_TARGET == target)
1457 periph->periph_dbflags |= SCSIPI_DEBUG_FLAGS;
1458 #endif
1459 periph->periph_type = ATAPI_CFG_TYPE(id->atap_config);
1460 if (id->atap_config & ATAPI_CFG_REMOV)
1461 periph->periph_flags |= PERIPH_REMOVABLE;
1462 sa.sa_periph = periph;
1463 sa.sa_inqbuf.type = ATAPI_CFG_TYPE(id->atap_config);
1464 sa.sa_inqbuf.removable = id->atap_config & ATAPI_CFG_REMOV ?
1465 T_REMOV : T_FIXED;
1466 strnvisx(model, sizeof(model), id->atap_model, 40,
1467 VIS_TRIM|VIS_SAFE|VIS_OCTAL);
1468 strnvisx(serial_number, sizeof(serial_number),
1469 id->atap_serial, 20, VIS_TRIM|VIS_SAFE|VIS_OCTAL);
1470 strnvisx(firmware_revision, sizeof(firmware_revision),
1471 id->atap_revision, 8, VIS_TRIM|VIS_SAFE|VIS_OCTAL);
1472 sa.sa_inqbuf.vendor = model;
1473 sa.sa_inqbuf.product = serial_number;
1474 sa.sa_inqbuf.revision = firmware_revision;
1475
1476 /*
1477 * Determine the operating mode capabilities of the device.
1478 */
1479 if ((id->atap_config & ATAPI_CFG_CMD_MASK)
1480 == ATAPI_CFG_CMD_16) {
1481 periph->periph_cap |= PERIPH_CAP_CMD16;
1482
1483 /* configure port for packet length */
1484 PRWRITE(siic, PRX(chp->ch_channel, PRO_PCS),
1485 PR_PC_PACKET_LENGTH);
1486 } else {
1487 PRWRITE(siic, PRX(chp->ch_channel, PRO_PCC),
1488 PR_PC_PACKET_LENGTH);
1489 }
1490
1491 /* XXX This is gross. */
1492 periph->periph_cap |= (id->atap_config & ATAPI_CFG_DRQ_MASK);
1493
1494 drvp->drv_softc = atapi_probe_device(sc, target, periph, &sa);
1495
1496 if (drvp->drv_softc)
1497 ata_probe_caps(drvp);
1498 else {
1499 s = splbio();
1500 drvp->drive_type &= ATA_DRIVET_NONE;
1501 splx(s);
1502 }
1503 } else {
1504 SIISATA_DEBUG_PRINT(("%s: ATAPI_IDENTIFY_DEVICE "
1505 "failed for drive %s:%d:%d: error 0x%x\n",
1506 __func__, SIISATANAME(siic), chp->ch_channel, target,
1507 chp->ch_error), DEBUG_PROBE);
1508 s = splbio();
1509 drvp->drive_type &= ATA_DRIVET_NONE;
1510 splx(s);
1511 }
1512 }
1513
1514 void
1515 siisata_atapi_scsipi_request(struct scsipi_channel *chan,
1516 scsipi_adapter_req_t req, void *arg)
1517 {
1518 struct scsipi_adapter *adapt = chan->chan_adapter;
1519 struct scsipi_periph *periph;
1520 struct scsipi_xfer *sc_xfer;
1521 struct siisata_softc *sc = device_private(adapt->adapt_dev);
1522 struct atac_softc *atac = &sc->sc_atac;
1523 struct ata_xfer *xfer;
1524 int channel = chan->chan_channel;
1525 int drive, s;
1526
1527 switch (req) {
1528 case ADAPTER_REQ_RUN_XFER:
1529 sc_xfer = arg;
1530 periph = sc_xfer->xs_periph;
1531 drive = periph->periph_target;
1532
1533 SIISATA_DEBUG_PRINT(("%s: %s:%d:%d\n", __func__,
1534 device_xname(atac->atac_dev), channel, drive),
1535 DEBUG_XFERS);
1536
1537 if (!device_is_active(atac->atac_dev)) {
1538 sc_xfer->error = XS_DRIVER_STUFFUP;
1539 scsipi_done(sc_xfer);
1540 return;
1541 }
1542 xfer = ata_get_xfer(ATAXF_NOSLEEP);
1543 if (xfer == NULL) {
1544 sc_xfer->error = XS_RESOURCE_SHORTAGE;
1545 scsipi_done(sc_xfer);
1546 return;
1547 }
1548
1549 if (sc_xfer->xs_control & XS_CTL_POLL)
1550 xfer->c_flags |= C_POLL;
1551 xfer->c_drive = drive;
1552 xfer->c_flags |= C_ATAPI;
1553 xfer->c_cmd = sc_xfer;
1554 xfer->c_databuf = sc_xfer->data;
1555 xfer->c_bcount = sc_xfer->datalen;
1556 xfer->c_start = siisata_atapi_start;
1557 xfer->c_intr = siisata_atapi_complete;
1558 xfer->c_kill_xfer = siisata_atapi_kill_xfer;
1559 xfer->c_dscpoll = 0;
1560 s = splbio();
1561 ata_exec_xfer(atac->atac_channels[channel], xfer);
1562 #ifdef DIAGNOSTIC
1563 if ((sc_xfer->xs_control & XS_CTL_POLL) != 0 &&
1564 (sc_xfer->xs_status & XS_STS_DONE) == 0)
1565 panic("%s: polled command not done", __func__);
1566 #endif
1567 splx(s);
1568 return;
1569
1570 default:
1571 /* Not supported, nothing to do. */
1572 ;
1573 }
1574 }
1575
1576 void
1577 siisata_atapi_start(struct ata_channel *chp, struct ata_xfer *xfer)
1578 {
1579 struct siisata_channel *schp = (struct siisata_channel *)chp;
1580 struct siisata_prb *prbp;
1581
1582 struct scsipi_xfer *sc_xfer = xfer->c_cmd;
1583
1584 int slot = SIISATA_NON_NCQ_SLOT;
1585 int i;
1586
1587 SIISATA_DEBUG_PRINT( ("%s: %s:%d:%d, scsi flags 0x%x\n", __func__,
1588 SIISATANAME((struct siisata_softc *)chp->ch_atac), chp->ch_channel,
1589 chp->ch_drive[xfer->c_drive].drive, sc_xfer->xs_control),
1590 DEBUG_XFERS);
1591
1592 chp->ch_status = 0;
1593 chp->ch_error = 0;
1594
1595 prbp = schp->sch_prb[slot];
1596 memset(prbp, 0, sizeof(struct siisata_prb));
1597
1598
1599 /* fill in direction for ATAPI command */
1600 if ((sc_xfer->xs_control & XS_CTL_DATA_IN))
1601 prbp->prb_control |= htole16(PRB_CF_PACKET_READ);
1602 if ((sc_xfer->xs_control & XS_CTL_DATA_OUT))
1603 prbp->prb_control |= htole16(PRB_CF_PACKET_WRITE);
1604
1605 satafis_rhd_construct_atapi(xfer, prbp->prb_fis);
1606 KASSERT(xfer->c_drive <= PMP_PORT_CTL);
1607 prbp->prb_fis[rhd_c] |= xfer->c_drive;
1608
1609 /* copy over ATAPI command */
1610 memcpy(prbp->prb_atapi, sc_xfer->cmd, sc_xfer->cmdlen);
1611
1612 if (siisata_dma_setup(chp, slot,
1613 (sc_xfer->xs_control & (XS_CTL_DATA_IN | XS_CTL_DATA_OUT)) ?
1614 xfer->c_databuf : NULL,
1615 xfer->c_bcount,
1616 (sc_xfer->xs_control & XS_CTL_DATA_IN) ?
1617 BUS_DMA_READ : BUS_DMA_WRITE)
1618 )
1619 panic("%s", __func__);
1620
1621 if (xfer->c_flags & C_POLL) {
1622 /* polled command, disable interrupts */
1623 prbp->prb_control = htole16(PRB_CF_INTERRUPT_MASK);
1624 siisata_disable_port_interrupt(chp);
1625 }
1626
1627 siisata_activate_prb(schp, slot);
1628
1629 if ((xfer->c_flags & C_POLL) == 0) {
1630 chp->ch_flags |= ATACH_IRQ_WAIT; /* wait for interrupt */
1631 callout_reset(&chp->ch_callout, mstohz(sc_xfer->timeout),
1632 siisata_timeout, chp);
1633 goto out;
1634 }
1635
1636 /*
1637 * polled command
1638 */
1639 for (i = 0; i < ATA_DELAY / 10; i++) {
1640 if (sc_xfer->xs_status & XS_STS_DONE)
1641 break;
1642 siisata_intr_port(schp);
1643 DELAY(1000);
1644 }
1645 if ((sc_xfer->xs_status & XS_STS_DONE) == 0) {
1646 siisata_timeout(chp);
1647 }
1648 /* reenable interrupts */
1649 siisata_enable_port_interrupt(chp);
1650 out:
1651 SIISATA_DEBUG_PRINT(
1652 ("%s: %s: done\n", SIISATANAME((struct siisata_softc *)chp->ch_atac), __func__), DEBUG_FUNCS);
1653 return;
1654 }
1655
1656 int
1657 siisata_atapi_complete(struct ata_channel *chp, struct ata_xfer *xfer,
1658 int slot)
1659 {
1660 struct siisata_softc *sc = (struct siisata_softc *)chp->ch_atac;
1661 struct siisata_channel *schp = (struct siisata_channel *)chp;
1662 struct scsipi_xfer *sc_xfer = xfer->c_cmd;
1663
1664 SIISATA_DEBUG_PRINT(
1665 ("%s: %s()\n", SIISATANAME(sc), __func__), DEBUG_INTR);
1666
1667 /* this comamnd is not active any more */
1668 schp->sch_active_slots &= ~__BIT(slot);
1669 chp->ch_flags &= ~ATACH_IRQ_WAIT;
1670 if (xfer->c_flags & C_TIMEOU) {
1671 sc_xfer->error = XS_TIMEOUT;
1672 } else {
1673 callout_stop(&chp->ch_callout);
1674 sc_xfer->error = XS_NOERROR;
1675 }
1676
1677 bus_dmamap_sync(sc->sc_dmat, schp->sch_datad[slot], 0,
1678 schp->sch_datad[slot]->dm_mapsize,
1679 (sc_xfer->xs_control & XS_CTL_DATA_IN) ?
1680 BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
1681 bus_dmamap_unload(sc->sc_dmat, schp->sch_datad[slot]);
1682
1683 if (chp->ch_drive[xfer->c_drive].drive_flags & ATA_DRIVE_WAITDRAIN) {
1684 siisata_atapi_kill_xfer(chp, xfer, KILL_GONE);
1685 chp->ch_drive[xfer->c_drive].drive_flags &= ~ATA_DRIVE_WAITDRAIN;
1686 wakeup(&chp->ch_queue->active_xfer);
1687 return 0; /* XXX verify */
1688 }
1689
1690 chp->ch_queue->active_xfer = NULL;
1691 ata_free_xfer(chp, xfer);
1692 sc_xfer->resid = sc_xfer->datalen;
1693 sc_xfer->resid -= PRREAD(sc, PRSX(chp->ch_channel, slot, PRSO_RTC));
1694 SIISATA_DEBUG_PRINT(("%s: %s datalen %d resid %d\n", SIISATANAME(sc),
1695 __func__, sc_xfer->datalen, sc_xfer->resid), DEBUG_XFERS);
1696 if ((chp->ch_status & WDCS_ERR) &&
1697 ((sc_xfer->xs_control & XS_CTL_REQSENSE) == 0 ||
1698 sc_xfer->resid == sc_xfer->datalen)) {
1699 sc_xfer->error = XS_SHORTSENSE;
1700 sc_xfer->sense.atapi_sense = chp->ch_error;
1701 if ((sc_xfer->xs_periph->periph_quirks &
1702 PQUIRK_NOSENSE) == 0) {
1703 /* request sense */
1704 sc_xfer->error = XS_BUSY;
1705 sc_xfer->status = SCSI_CHECK;
1706 }
1707 }
1708 scsipi_done(sc_xfer);
1709 atastart(chp);
1710 return 0; /* XXX verify */
1711 }
1712
1713 #endif /* NATAPIBUS */
1714