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