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