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