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