Home | History | Annotate | Line # | Download | only in ic
ninjaata32.c revision 1.6.2.5
      1  1.6.2.5  yamt /*	$NetBSD: ninjaata32.c,v 1.6.2.5 2008/03/24 09:38:50 yamt Exp $	*/
      2  1.6.2.2  yamt 
      3  1.6.2.2  yamt /*
      4  1.6.2.2  yamt  * Copyright (c) 2006 ITOH Yasufumi <itohy (at) NetBSD.org>.
      5  1.6.2.2  yamt  * All rights reserved.
      6  1.6.2.2  yamt  *
      7  1.6.2.2  yamt  * Redistribution and use in source and binary forms, with or without
      8  1.6.2.2  yamt  * modification, are permitted provided that the following conditions
      9  1.6.2.2  yamt  * are met:
     10  1.6.2.2  yamt  * 1. Redistributions of source code must retain the above copyright
     11  1.6.2.2  yamt  *    notice, this list of conditions and the following disclaimer.
     12  1.6.2.2  yamt  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.6.2.2  yamt  *    notice, this list of conditions and the following disclaimer in the
     14  1.6.2.2  yamt  *    documentation and/or other materials provided with the distribution.
     15  1.6.2.2  yamt  *
     16  1.6.2.2  yamt  * THIS SOFTWARE IS PROVIDED BY THE AUTHORS AND CONTRIBUTORS ``AS IS''
     17  1.6.2.2  yamt  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
     18  1.6.2.2  yamt  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  1.6.2.2  yamt  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS
     20  1.6.2.2  yamt  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  1.6.2.2  yamt  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  1.6.2.2  yamt  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  1.6.2.2  yamt  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  1.6.2.2  yamt  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  1.6.2.2  yamt  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
     26  1.6.2.2  yamt  * THE POSSIBILITY OF SUCH DAMAGE.
     27  1.6.2.2  yamt  */
     28  1.6.2.2  yamt 
     29  1.6.2.2  yamt #include <sys/cdefs.h>
     30  1.6.2.5  yamt __KERNEL_RCSID(0, "$NetBSD: ninjaata32.c,v 1.6.2.5 2008/03/24 09:38:50 yamt Exp $");
     31  1.6.2.2  yamt 
     32  1.6.2.2  yamt #include <sys/param.h>
     33  1.6.2.2  yamt #include <sys/kernel.h>
     34  1.6.2.2  yamt #include <sys/device.h>
     35  1.6.2.3  yamt #include <sys/proc.h>
     36  1.6.2.2  yamt 
     37  1.6.2.4  yamt #include <sys/bus.h>
     38  1.6.2.4  yamt #include <sys/intr.h>
     39  1.6.2.2  yamt 
     40  1.6.2.2  yamt #include <uvm/uvm_extern.h>
     41  1.6.2.2  yamt 
     42  1.6.2.2  yamt #include <dev/ata/atavar.h>
     43  1.6.2.2  yamt #include <dev/ic/wdcreg.h>
     44  1.6.2.2  yamt #include <dev/ic/wdcvar.h>
     45  1.6.2.2  yamt 
     46  1.6.2.2  yamt #include <dev/ic/ninjaata32reg.h>
     47  1.6.2.2  yamt #include <dev/ic/ninjaata32var.h>
     48  1.6.2.2  yamt 
     49  1.6.2.2  yamt #ifdef NJATA32_DEBUG
     50  1.6.2.2  yamt #define DPRINTF(x)	printf x
     51  1.6.2.2  yamt #else
     52  1.6.2.2  yamt #define DPRINTF(x)
     53  1.6.2.2  yamt #endif
     54  1.6.2.2  yamt 
     55  1.6.2.2  yamt static void	njata32_init(struct njata32_softc *, int nosleep);
     56  1.6.2.2  yamt static void	njata32_irqack(struct ata_channel *);
     57  1.6.2.2  yamt static void	njata32_clearirq(struct ata_channel *, int);
     58  1.6.2.2  yamt static void	njata32_setup_channel(struct ata_channel *);
     59  1.6.2.2  yamt static int	njata32_dma_init(void *, int channel, int drive,
     60  1.6.2.2  yamt 		    void *databuf, size_t datalen, int flags);
     61  1.6.2.2  yamt static void	njata32_piobm_start(void *, int channel, int drive, int skip,
     62  1.6.2.2  yamt 		    int xferlen, int flags);
     63  1.6.2.2  yamt static int	njata32_dma_finish(void *, int channel, int drive, int force);
     64  1.6.2.2  yamt static void	njata32_piobm_done(void *, int channel, int drive);
     65  1.6.2.2  yamt 
     66  1.6.2.2  yamt #if 0	/* ATA DMA is currently unused */
     67  1.6.2.2  yamt static const uint8_t njata32_timing_dma[NJATA32_MODE_MAX_DMA + 1] = {
     68  1.6.2.2  yamt 	NJATA32_TIMING_DMA0, NJATA32_TIMING_DMA1, NJATA32_TIMING_DMA2
     69  1.6.2.2  yamt };
     70  1.6.2.2  yamt #endif
     71  1.6.2.2  yamt static const uint8_t njata32_timing_pio[NJATA32_MODE_MAX_PIO + 1] = {
     72  1.6.2.2  yamt 	NJATA32_TIMING_PIO0, NJATA32_TIMING_PIO1, NJATA32_TIMING_PIO2,
     73  1.6.2.2  yamt 	NJATA32_TIMING_PIO3, NJATA32_TIMING_PIO4
     74  1.6.2.2  yamt };
     75  1.6.2.2  yamt 
     76  1.6.2.2  yamt static void
     77  1.6.2.5  yamt njata32_init(struct njata32_softc *sc, int nosleep)
     78  1.6.2.2  yamt {
     79  1.6.2.2  yamt 
     80  1.6.2.2  yamt 	/* disable interrupts */
     81  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
     82  1.6.2.2  yamt 	    NJATA32_REG_IRQ_SELECT, 0);
     83  1.6.2.2  yamt 
     84  1.6.2.2  yamt 	/* bus reset */
     85  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_AS,
     86  1.6.2.2  yamt 	    NJATA32_AS_WAIT0 | NJATA32_AS_BUS_RESET);
     87  1.6.2.2  yamt 	if (nosleep)
     88  1.6.2.2  yamt 		delay(50000);
     89  1.6.2.2  yamt 	else
     90  1.6.2.2  yamt 		tsleep(sc, PRIBIO, "njaini", mstohz(50));
     91  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_AS,
     92  1.6.2.2  yamt 	    NJATA32_AS_WAIT0);
     93  1.6.2.2  yamt 
     94  1.6.2.2  yamt 	/* initial transfer speed */
     95  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
     96  1.6.2.2  yamt 	    NJATA32_REG_TIMING, NJATA32_TIMING_PIO0 + sc->sc_atawait);
     97  1.6.2.2  yamt 
     98  1.6.2.2  yamt 	/* setup busmaster mode */
     99  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_IOBM,
    100  1.6.2.2  yamt 	    NJATA32_IOBM_DEFAULT);
    101  1.6.2.2  yamt 
    102  1.6.2.2  yamt 	/* enable interrupts */
    103  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    104  1.6.2.2  yamt 	    NJATA32_REG_IRQ_SELECT, NJATA32_IRQ_XFER | NJATA32_IRQ_DEV);
    105  1.6.2.2  yamt }
    106  1.6.2.2  yamt 
    107  1.6.2.2  yamt void
    108  1.6.2.5  yamt njata32_attach(struct njata32_softc *sc)
    109  1.6.2.2  yamt {
    110  1.6.2.2  yamt 	bus_addr_t dmaaddr;
    111  1.6.2.2  yamt 	int i, devno, error;
    112  1.6.2.2  yamt 	struct wdc_regs *wdr;
    113  1.6.2.2  yamt 
    114  1.6.2.2  yamt 	/*
    115  1.6.2.2  yamt 	 * allocate DMA resource
    116  1.6.2.2  yamt 	 */
    117  1.6.2.2  yamt 	if ((error = bus_dmamem_alloc(sc->sc_dmat,
    118  1.6.2.2  yamt 	    sizeof(struct njata32_dma_page), PAGE_SIZE, 0,
    119  1.6.2.2  yamt 	    &sc->sc_sgt_seg, 1, &sc->sc_sgt_nsegs, BUS_DMA_NOWAIT)) != 0) {
    120  1.6.2.5  yamt 		aprint_error("%s: unable to allocate sgt page, error = %d\n",
    121  1.6.2.2  yamt 		    NJATA32NAME(sc), error);
    122  1.6.2.2  yamt 		return;
    123  1.6.2.2  yamt 	}
    124  1.6.2.2  yamt 	if ((error = bus_dmamem_map(sc->sc_dmat, &sc->sc_sgt_seg,
    125  1.6.2.2  yamt 	    sc->sc_sgt_nsegs, sizeof(struct njata32_dma_page),
    126  1.6.2.3  yamt 	    (void **)&sc->sc_sgtpg,
    127  1.6.2.2  yamt 	    BUS_DMA_NOWAIT | BUS_DMA_COHERENT)) != 0) {
    128  1.6.2.5  yamt 		aprint_error("%s: unable to map sgt page, error = %d\n",
    129  1.6.2.2  yamt 		    NJATA32NAME(sc), error);
    130  1.6.2.2  yamt 		goto fail1;
    131  1.6.2.2  yamt 	}
    132  1.6.2.2  yamt 	if ((error = bus_dmamap_create(sc->sc_dmat,
    133  1.6.2.2  yamt 	    sizeof(struct njata32_dma_page), 1,
    134  1.6.2.2  yamt 	    sizeof(struct njata32_dma_page), 0, BUS_DMA_NOWAIT,
    135  1.6.2.2  yamt 	    &sc->sc_dmamap_sgt)) != 0) {
    136  1.6.2.5  yamt 		aprint_error("%s: unable to create sgt DMA map, error = %d\n",
    137  1.6.2.2  yamt 		    NJATA32NAME(sc), error);
    138  1.6.2.2  yamt 		goto fail2;
    139  1.6.2.2  yamt 	}
    140  1.6.2.2  yamt 	if ((error = bus_dmamap_load(sc->sc_dmat, sc->sc_dmamap_sgt,
    141  1.6.2.2  yamt 	    sc->sc_sgtpg, sizeof(struct njata32_dma_page),
    142  1.6.2.2  yamt 	    NULL, BUS_DMA_NOWAIT)) != 0) {
    143  1.6.2.5  yamt 		aprint_error("%s: unable to load sgt DMA map, error = %d\n",
    144  1.6.2.2  yamt 		    NJATA32NAME(sc), error);
    145  1.6.2.2  yamt 		goto fail3;
    146  1.6.2.2  yamt 	}
    147  1.6.2.2  yamt 
    148  1.6.2.2  yamt 	dmaaddr = sc->sc_dmamap_sgt->dm_segs[0].ds_addr;
    149  1.6.2.2  yamt 
    150  1.6.2.2  yamt 	for (devno = 0; devno < NJATA32_NUM_DEV; devno++) {
    151  1.6.2.2  yamt 		sc->sc_dev[devno].d_sgt = sc->sc_sgtpg->dp_sg[devno];
    152  1.6.2.2  yamt 		sc->sc_dev[devno].d_sgt_dma = dmaaddr +
    153  1.6.2.2  yamt 		    offsetof(struct njata32_dma_page, dp_sg[devno]);
    154  1.6.2.2  yamt 
    155  1.6.2.2  yamt 		error = bus_dmamap_create(sc->sc_dmat,
    156  1.6.2.2  yamt 		    NJATA32_MAX_XFER,		/* max total map size */
    157  1.6.2.2  yamt 		    NJATA32_NUM_SG,		/* max number of segments */
    158  1.6.2.2  yamt 		    NJATA32_SGT_MAXSEGLEN,	/* max size of a segment */
    159  1.6.2.2  yamt 		    0,				/* boundary */
    160  1.6.2.2  yamt 		    BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
    161  1.6.2.2  yamt 		    &sc->sc_dev[devno].d_dmamap_xfer);
    162  1.6.2.2  yamt 		if (error) {
    163  1.6.2.5  yamt 			aprint_error("%s: failed to create DMA map "
    164  1.6.2.5  yamt 			    "(error = %d)\n", NJATA32NAME(sc), error);
    165  1.6.2.2  yamt 			goto fail4;
    166  1.6.2.2  yamt 		}
    167  1.6.2.2  yamt 	}
    168  1.6.2.2  yamt 
    169  1.6.2.2  yamt 	/* device properties */
    170  1.6.2.2  yamt 	sc->sc_wdcdev.sc_atac.atac_cap =
    171  1.6.2.2  yamt 	    ATAC_CAP_DATA16 | ATAC_CAP_DATA32 | ATAC_CAP_PIOBM;
    172  1.6.2.2  yamt 	sc->sc_wdcdev.irqack = njata32_irqack;
    173  1.6.2.2  yamt 	sc->sc_wdcdev.sc_atac.atac_channels = sc->sc_wdc_chanarray;
    174  1.6.2.2  yamt 	sc->sc_wdcdev.sc_atac.atac_nchannels = NJATA32_NCHAN;	/* 1 */
    175  1.6.2.2  yamt 	sc->sc_wdcdev.sc_atac.atac_pio_cap = NJATA32_MODE_MAX_PIO;
    176  1.6.2.2  yamt #if 0	/* ATA DMA is currently unused */
    177  1.6.2.2  yamt 	sc->sc_wdcdev.sc_atac.atac_dma_cap = NJATA32_MODE_MAX_DMA;
    178  1.6.2.2  yamt #endif
    179  1.6.2.2  yamt 	sc->sc_wdcdev.sc_atac.atac_set_modes = njata32_setup_channel;
    180  1.6.2.2  yamt 
    181  1.6.2.2  yamt 	/* DMA control functions */
    182  1.6.2.2  yamt 	sc->sc_wdcdev.dma_arg = sc;
    183  1.6.2.2  yamt 	sc->sc_wdcdev.dma_init = njata32_dma_init;
    184  1.6.2.2  yamt 	sc->sc_wdcdev.piobm_start = njata32_piobm_start;
    185  1.6.2.2  yamt 	sc->sc_wdcdev.dma_finish = njata32_dma_finish;
    186  1.6.2.2  yamt 	sc->sc_wdcdev.piobm_done = njata32_piobm_done;
    187  1.6.2.2  yamt 
    188  1.6.2.2  yamt 	sc->sc_wdcdev.cap |= WDC_CAPABILITY_NO_EXTRA_RESETS;
    189  1.6.2.2  yamt 
    190  1.6.2.2  yamt 	sc->sc_wdcdev.regs = wdr = &sc->sc_wdc_regs;
    191  1.6.2.2  yamt 
    192  1.6.2.2  yamt 	/* only one channel */
    193  1.6.2.2  yamt 	sc->sc_wdc_chanarray[0] = &sc->sc_ch[0].ch_ata_channel;
    194  1.6.2.2  yamt 	sc->sc_ch[0].ch_ata_channel.ch_channel = 0;
    195  1.6.2.2  yamt 	sc->sc_ch[0].ch_ata_channel.ch_atac = &sc->sc_wdcdev.sc_atac;
    196  1.6.2.2  yamt 	sc->sc_ch[0].ch_ata_channel.ch_queue = &sc->sc_wdc_chqueue;
    197  1.6.2.2  yamt 	sc->sc_ch[0].ch_ata_channel.ch_ndrive = 2; /* max number of drives */
    198  1.6.2.2  yamt 
    199  1.6.2.2  yamt 	/* map ATA registers */
    200  1.6.2.2  yamt 	for (i = 0; i < WDC_NREG; i++) {
    201  1.6.2.2  yamt 		if (bus_space_subregion(NJATA32_REGT(sc), NJATA32_REGH(sc),
    202  1.6.2.2  yamt 		    NJATA32_OFFSET_WDCREGS + i,
    203  1.6.2.2  yamt 		    i == wd_data ? 4 : 1, &wdr->cmd_iohs[i]) != 0) {
    204  1.6.2.2  yamt 			aprint_error("%s: couldn't subregion cmd regs\n",
    205  1.6.2.2  yamt 			    NJATA32NAME(sc));
    206  1.6.2.2  yamt 			goto fail4;
    207  1.6.2.2  yamt 		}
    208  1.6.2.2  yamt 	}
    209  1.6.2.2  yamt 	wdc_init_shadow_regs(&sc->sc_ch[0].ch_ata_channel);
    210  1.6.2.2  yamt 	wdr->data32iot = NJATA32_REGT(sc);
    211  1.6.2.2  yamt 	wdr->data32ioh = wdr->cmd_iohs[wd_data];
    212  1.6.2.2  yamt 
    213  1.6.2.2  yamt 	/* map ATA ctl reg */
    214  1.6.2.2  yamt 	wdr->ctl_iot = NJATA32_REGT(sc);
    215  1.6.2.2  yamt 	if (bus_space_subregion(NJATA32_REGT(sc), NJATA32_REGH(sc),
    216  1.6.2.2  yamt 	    NJATA32_REG_WD_ALTSTATUS, 1, &wdr->ctl_ioh) != 0) {
    217  1.6.2.2  yamt 		aprint_error("%s: couldn't subregion ctl regs\n",
    218  1.6.2.2  yamt 		    NJATA32NAME(sc));
    219  1.6.2.2  yamt 		goto fail4;
    220  1.6.2.2  yamt 	}
    221  1.6.2.2  yamt 
    222  1.6.2.2  yamt 	sc->sc_flags |= NJATA32_CMDPG_MAPPED;
    223  1.6.2.2  yamt 
    224  1.6.2.2  yamt 	/* use flags value as busmaster wait */
    225  1.6.2.2  yamt 	if ((sc->sc_atawait =
    226  1.6.2.5  yamt 	    (uint8_t)device_cfdata(sc->sc_wdcdev.sc_atac.atac_dev)->cf_flags))
    227  1.6.2.2  yamt 		aprint_normal("%s: ATA wait = %#x\n",
    228  1.6.2.2  yamt 		    NJATA32NAME(sc), sc->sc_atawait);
    229  1.6.2.2  yamt 
    230  1.6.2.2  yamt 	njata32_init(sc, cold);
    231  1.6.2.2  yamt 
    232  1.6.2.2  yamt 	wdcattach(&sc->sc_ch[0].ch_ata_channel);
    233  1.6.2.2  yamt 
    234  1.6.2.2  yamt 	return;
    235  1.6.2.2  yamt 
    236  1.6.2.2  yamt 	/*
    237  1.6.2.2  yamt 	 * cleanup
    238  1.6.2.2  yamt 	 */
    239  1.6.2.2  yamt fail4:	while (--devno >= 0) {
    240  1.6.2.2  yamt 		bus_dmamap_destroy(sc->sc_dmat,
    241  1.6.2.2  yamt 		    sc->sc_dev[devno].d_dmamap_xfer);
    242  1.6.2.2  yamt 	}
    243  1.6.2.2  yamt 	bus_dmamap_unload(sc->sc_dmat, sc->sc_dmamap_sgt);
    244  1.6.2.2  yamt fail3:	bus_dmamap_destroy(sc->sc_dmat, sc->sc_dmamap_sgt);
    245  1.6.2.3  yamt fail2:	bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_sgtpg,
    246  1.6.2.2  yamt 	    sizeof(struct njata32_dma_page));
    247  1.6.2.2  yamt fail1:	bus_dmamem_free(sc->sc_dmat, &sc->sc_sgt_seg, sc->sc_sgt_nsegs);
    248  1.6.2.2  yamt }
    249  1.6.2.2  yamt 
    250  1.6.2.2  yamt int
    251  1.6.2.5  yamt njata32_detach(struct njata32_softc *sc, int flags)
    252  1.6.2.2  yamt {
    253  1.6.2.2  yamt 	int rv, devno;
    254  1.6.2.2  yamt 
    255  1.6.2.2  yamt 	if (sc->sc_flags & NJATA32_CMDPG_MAPPED) {
    256  1.6.2.5  yamt 		if ((rv = wdcdetach(sc->sc_wdcdev.sc_atac.atac_dev, flags)))
    257  1.6.2.2  yamt 			return rv;
    258  1.6.2.2  yamt 
    259  1.6.2.2  yamt 		/* free DMA resource */
    260  1.6.2.2  yamt 		for (devno = 0; devno < NJATA32_NUM_DEV; devno++) {
    261  1.6.2.2  yamt 			bus_dmamap_destroy(sc->sc_dmat,
    262  1.6.2.2  yamt 			    sc->sc_dev[devno].d_dmamap_xfer);
    263  1.6.2.2  yamt 		}
    264  1.6.2.2  yamt 		bus_dmamap_unload(sc->sc_dmat, sc->sc_dmamap_sgt);
    265  1.6.2.2  yamt 		bus_dmamap_destroy(sc->sc_dmat, sc->sc_dmamap_sgt);
    266  1.6.2.3  yamt 		bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_sgtpg,
    267  1.6.2.2  yamt 		    sizeof(struct njata32_dma_page));
    268  1.6.2.2  yamt 		bus_dmamem_free(sc->sc_dmat, &sc->sc_sgt_seg, sc->sc_sgt_nsegs);
    269  1.6.2.2  yamt 	}
    270  1.6.2.2  yamt 
    271  1.6.2.2  yamt 	return 0;
    272  1.6.2.2  yamt }
    273  1.6.2.2  yamt 
    274  1.6.2.2  yamt static void
    275  1.6.2.5  yamt njata32_irqack(struct ata_channel *chp)
    276  1.6.2.2  yamt {
    277  1.6.2.2  yamt 	struct njata32_softc *sc = (void *)chp->ch_atac;
    278  1.6.2.2  yamt 
    279  1.6.2.2  yamt 	/* disable busmaster */
    280  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    281  1.6.2.2  yamt 	    NJATA32_REG_BM, NJATA32_BM_WAIT0);
    282  1.6.2.2  yamt }
    283  1.6.2.2  yamt 
    284  1.6.2.2  yamt static void
    285  1.6.2.5  yamt njata32_clearirq(struct ata_channel *chp, int irq)
    286  1.6.2.2  yamt {
    287  1.6.2.2  yamt 	struct njata32_softc *sc = (void *)chp->ch_atac;
    288  1.6.2.2  yamt 
    289  1.6.2.5  yamt 	aprint_error("%s: unhandled intr: irq %#x, bm %#x, ",
    290  1.6.2.2  yamt 	    NJATA32NAME(sc), irq,
    291  1.6.2.2  yamt 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    292  1.6.2.2  yamt 		NJATA32_REG_BM));
    293  1.6.2.2  yamt 
    294  1.6.2.2  yamt 	/* disable busmaster */
    295  1.6.2.2  yamt 	njata32_irqack(chp);
    296  1.6.2.2  yamt 
    297  1.6.2.2  yamt 	/* clear device interrupt */
    298  1.6.2.5  yamt 	aprint_normal("err %#x, seccnt %#x, cyl %#x, sdh %#x, ",
    299  1.6.2.2  yamt 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    300  1.6.2.2  yamt 		NJATA32_REG_WD_ERROR),
    301  1.6.2.2  yamt 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    302  1.6.2.2  yamt 		NJATA32_REG_WD_SECCNT),
    303  1.6.2.2  yamt 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    304  1.6.2.2  yamt 		NJATA32_REG_WD_CYL_LO) |
    305  1.6.2.2  yamt 	    (bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    306  1.6.2.2  yamt 		NJATA32_REG_WD_CYL_HI) << 8),
    307  1.6.2.2  yamt 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    308  1.6.2.2  yamt 		NJATA32_REG_WD_SDH));
    309  1.6.2.5  yamt 	aprint_normal("status %#x\n",
    310  1.6.2.2  yamt 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    311  1.6.2.2  yamt 	    NJATA32_REG_WD_STATUS));
    312  1.6.2.2  yamt }
    313  1.6.2.2  yamt 
    314  1.6.2.2  yamt static void
    315  1.6.2.5  yamt njata32_setup_channel(struct ata_channel *chp)
    316  1.6.2.2  yamt {
    317  1.6.2.2  yamt 	struct njata32_softc *sc = (void *)chp->ch_atac;
    318  1.6.2.2  yamt 	struct ata_drive_datas *drvp;
    319  1.6.2.2  yamt 	int drive;
    320  1.6.2.2  yamt 	uint8_t mode;
    321  1.6.2.2  yamt 
    322  1.6.2.2  yamt 	KASSERT(chp->ch_ndrive != 0);
    323  1.6.2.2  yamt 
    324  1.6.2.2  yamt 	sc->sc_timing_pio = 0;
    325  1.6.2.2  yamt #if 0	/* ATA DMA is currently unused */
    326  1.6.2.2  yamt 	sc->sc_timing_dma = 0;
    327  1.6.2.2  yamt #endif
    328  1.6.2.2  yamt 
    329  1.6.2.2  yamt 	for (drive = 0; drive < chp->ch_ndrive; drive++) {
    330  1.6.2.2  yamt 		drvp = &chp->ch_drive[drive];
    331  1.6.2.2  yamt 		if ((drvp->drive_flags & DRIVE) == 0)
    332  1.6.2.2  yamt 			continue;	/* no drive */
    333  1.6.2.2  yamt 
    334  1.6.2.2  yamt #if 0	/* ATA DMA is currently unused */
    335  1.6.2.2  yamt 		if ((drvp->drive_flags & DRIVE_DMA) != 0) {
    336  1.6.2.2  yamt 			/*
    337  1.6.2.2  yamt 			 * Multiword DMA
    338  1.6.2.2  yamt 			 */
    339  1.6.2.2  yamt 			if ((mode = drvp->DMA_mode) > NJATA32_MODE_MAX_DMA)
    340  1.6.2.2  yamt 				mode = NJATA32_MODE_MAX_DMA;
    341  1.6.2.2  yamt 			if (sc->sc_timing_dma < njata32_timing_dma[mode])
    342  1.6.2.2  yamt 				sc->sc_timing_dma = njata32_timing_dma[mode];
    343  1.6.2.2  yamt 		}
    344  1.6.2.2  yamt #endif
    345  1.6.2.2  yamt 		/*
    346  1.6.2.2  yamt 		 * PIO
    347  1.6.2.2  yamt 		 */
    348  1.6.2.2  yamt 		if ((mode = drvp->PIO_mode) > NJATA32_MODE_MAX_PIO)
    349  1.6.2.2  yamt 			mode = NJATA32_MODE_MAX_PIO;
    350  1.6.2.2  yamt 		if (sc->sc_timing_pio < njata32_timing_pio[mode])
    351  1.6.2.2  yamt 			sc->sc_timing_pio = njata32_timing_pio[mode];
    352  1.6.2.2  yamt 	}
    353  1.6.2.2  yamt 
    354  1.6.2.2  yamt 	sc->sc_timing_pio += sc->sc_atawait;
    355  1.6.2.2  yamt 
    356  1.6.2.2  yamt 	/* set timing for PIO */
    357  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    358  1.6.2.2  yamt 	    NJATA32_REG_TIMING, sc->sc_timing_pio);
    359  1.6.2.2  yamt }
    360  1.6.2.2  yamt 
    361  1.6.2.2  yamt /*
    362  1.6.2.2  yamt  * map DMA buffer
    363  1.6.2.2  yamt  */
    364  1.6.2.2  yamt int
    365  1.6.2.2  yamt njata32_dma_init(void *v, int channel, int drive, void *databuf,
    366  1.6.2.2  yamt 		 size_t datalen, int flags)
    367  1.6.2.2  yamt {
    368  1.6.2.2  yamt 	struct njata32_softc *sc = v;
    369  1.6.2.2  yamt 	int error;
    370  1.6.2.2  yamt 	struct njata32_device *dev = &sc->sc_dev[drive];
    371  1.6.2.2  yamt 
    372  1.6.2.2  yamt 	KASSERT(channel == 0);
    373  1.6.2.2  yamt 	KASSERT((dev->d_flags & NJATA32_DEV_DMA_MAPPED) == 0);
    374  1.6.2.2  yamt 	KASSERT((dev->d_flags & NJATA32_DEV_DMA_STARTED) == 0);
    375  1.6.2.2  yamt 
    376  1.6.2.2  yamt 	KASSERT(flags & (WDC_DMA_PIOBM_ATA | WDC_DMA_PIOBM_ATAPI));
    377  1.6.2.2  yamt 
    378  1.6.2.2  yamt 	/* use PIO for short transfer */
    379  1.6.2.2  yamt 	if (datalen < 64 /* needs tune */) {
    380  1.6.2.2  yamt 		DPRINTF(("%s: njata32_dma_init: short transfer (%u)\n",
    381  1.6.2.2  yamt 		    NJATA32NAME(sc), (unsigned)datalen));
    382  1.6.2.2  yamt 		bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    383  1.6.2.2  yamt 		    NJATA32_REG_TIMING, sc->sc_timing_pio);
    384  1.6.2.2  yamt 		return EINVAL;
    385  1.6.2.2  yamt 	}
    386  1.6.2.2  yamt 
    387  1.6.2.2  yamt 	/* use PIO for unaligned transfer (word alignment seems OK) */
    388  1.6.2.2  yamt 	if (((uintptr_t)databuf & 1) || (datalen & 1)) {
    389  1.6.2.2  yamt 		DPRINTF(("%s: njata32_dma_init: unaligned: buf %p, len %u\n",
    390  1.6.2.2  yamt 		    NJATA32NAME(sc), databuf, (unsigned)datalen));
    391  1.6.2.2  yamt 		return EINVAL;
    392  1.6.2.2  yamt 	}
    393  1.6.2.2  yamt 
    394  1.6.2.2  yamt 	DPRINTF(("%s: njata32_dma_init: %s: databuf %p, datalen %u\n",
    395  1.6.2.2  yamt 	    NJATA32NAME(sc), (flags & WDC_DMA_READ) ? "read" : "write",
    396  1.6.2.2  yamt 	    databuf, (unsigned)datalen));
    397  1.6.2.2  yamt 
    398  1.6.2.2  yamt 	error = bus_dmamap_load(sc->sc_dmat, dev->d_dmamap_xfer,
    399  1.6.2.2  yamt 	    databuf, datalen, NULL, BUS_DMA_NOWAIT | BUS_DMA_STREAMING |
    400  1.6.2.2  yamt 	    ((flags & WDC_DMA_READ) ? BUS_DMA_READ : BUS_DMA_WRITE));
    401  1.6.2.2  yamt 	if (error) {
    402  1.6.2.2  yamt 		printf("%s: load xfer failed, error %d\n",
    403  1.6.2.2  yamt 		    NJATA32NAME(sc), error);
    404  1.6.2.2  yamt 		return error;
    405  1.6.2.2  yamt 	}
    406  1.6.2.2  yamt 
    407  1.6.2.2  yamt 	bus_dmamap_sync(sc->sc_dmat, dev->d_dmamap_xfer, 0,
    408  1.6.2.2  yamt 	    dev->d_dmamap_xfer->dm_mapsize,
    409  1.6.2.2  yamt 	    (flags & WDC_DMA_READ) ?
    410  1.6.2.2  yamt 		BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
    411  1.6.2.2  yamt 
    412  1.6.2.2  yamt 	dev->d_flags =
    413  1.6.2.2  yamt 	    ((flags & WDC_DMA_READ) ? NJATA32_DEV_DMA_READ : 0) |
    414  1.6.2.2  yamt 	    ((flags & WDC_DMA_PIOBM_ATAPI) ? NJATA32_DEV_DMA_ATAPI : 0) |
    415  1.6.2.2  yamt 	    NJATA32_DEV_DMA_MAPPED;
    416  1.6.2.2  yamt 
    417  1.6.2.2  yamt 	return 0;
    418  1.6.2.2  yamt }
    419  1.6.2.2  yamt 
    420  1.6.2.2  yamt /*
    421  1.6.2.2  yamt  * start DMA
    422  1.6.2.2  yamt  *
    423  1.6.2.2  yamt  * top:  databuf + skip
    424  1.6.2.2  yamt  * size: xferlen
    425  1.6.2.2  yamt  */
    426  1.6.2.2  yamt void
    427  1.6.2.2  yamt njata32_piobm_start(void *v, int channel, int drive,
    428  1.6.2.2  yamt 		    int skip, int xferlen, int flags)
    429  1.6.2.2  yamt {
    430  1.6.2.2  yamt 	struct njata32_softc *sc = v;
    431  1.6.2.2  yamt 	struct njata32_device *dev = &sc->sc_dev[drive];
    432  1.6.2.2  yamt 	int i, nsegs, seglen;
    433  1.6.2.2  yamt 	uint8_t bmreg;
    434  1.6.2.2  yamt 
    435  1.6.2.2  yamt 	DPRINTF(("%s: njata32_piobm_start: ch%d, dv%d, skip %d, xferlen %d\n",
    436  1.6.2.2  yamt 	    NJATA32NAME(sc), channel, drive, skip, xferlen));
    437  1.6.2.2  yamt 
    438  1.6.2.2  yamt 	KASSERT(channel == 0);
    439  1.6.2.2  yamt 	KASSERT(dev->d_flags & NJATA32_DEV_DMA_MAPPED);
    440  1.6.2.2  yamt 	KASSERT((dev->d_flags & NJATA32_DEV_DMA_STARTED) == 0);
    441  1.6.2.2  yamt 
    442  1.6.2.2  yamt 	/*
    443  1.6.2.2  yamt 	 * create scatter/gather table
    444  1.6.2.2  yamt 	 * XXX this code may be slow
    445  1.6.2.2  yamt 	 */
    446  1.6.2.2  yamt 	for (i = nsegs = 0;
    447  1.6.2.2  yamt 	    i < dev->d_dmamap_xfer->dm_nsegs && xferlen > 0; i++) {
    448  1.6.2.2  yamt 		if (dev->d_dmamap_xfer->dm_segs[i].ds_len <= skip) {
    449  1.6.2.2  yamt 			skip -= dev->d_dmamap_xfer->dm_segs[i].ds_len;
    450  1.6.2.2  yamt 			continue;
    451  1.6.2.2  yamt 		}
    452  1.6.2.2  yamt 
    453  1.6.2.2  yamt 		seglen = dev->d_dmamap_xfer->dm_segs[i].ds_len - skip;
    454  1.6.2.2  yamt 		if (seglen > xferlen)
    455  1.6.2.2  yamt 			seglen = xferlen;
    456  1.6.2.2  yamt 
    457  1.6.2.2  yamt 		dev->d_sgt[nsegs].sg_addr =
    458  1.6.2.2  yamt 		    htole32(dev->d_dmamap_xfer->dm_segs[i].ds_addr + skip);
    459  1.6.2.2  yamt 		dev->d_sgt[nsegs].sg_len = htole32(seglen);
    460  1.6.2.2  yamt 
    461  1.6.2.2  yamt 		xferlen -= seglen;
    462  1.6.2.2  yamt 		nsegs++;
    463  1.6.2.2  yamt 		skip = 0;
    464  1.6.2.2  yamt 	}
    465  1.6.2.2  yamt 	sc->sc_piobm_nsegs = nsegs;
    466  1.6.2.2  yamt 	/* end mark */
    467  1.6.2.2  yamt 	dev->d_sgt[nsegs - 1].sg_len |= htole32(NJATA32_SGT_ENDMARK);
    468  1.6.2.2  yamt 
    469  1.6.2.2  yamt #ifdef DIAGNOSTIC
    470  1.6.2.2  yamt 	if (xferlen)
    471  1.6.2.2  yamt 		panic("%s: njata32_piobm_start: xferlen residue %d\n",
    472  1.6.2.2  yamt 		    NJATA32NAME(sc), xferlen);
    473  1.6.2.2  yamt #endif
    474  1.6.2.2  yamt 
    475  1.6.2.2  yamt 	bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_sgt,
    476  1.6.2.2  yamt 	    (char *)dev->d_sgt - (char *)sc->sc_sgtpg,
    477  1.6.2.2  yamt 	    sizeof(struct njata32_sgtable) * nsegs,
    478  1.6.2.2  yamt 	    BUS_DMASYNC_PREWRITE);
    479  1.6.2.2  yamt 
    480  1.6.2.2  yamt 	/* set timing for PIO */
    481  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    482  1.6.2.2  yamt 	    NJATA32_REG_TIMING, sc->sc_timing_pio);
    483  1.6.2.2  yamt 
    484  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_IOBM,
    485  1.6.2.2  yamt 	    NJATA32_IOBM_DEFAULT);
    486  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_AS,
    487  1.6.2.2  yamt 	    NJATA32_AS_WAIT0);
    488  1.6.2.2  yamt 
    489  1.6.2.2  yamt 	/*
    490  1.6.2.2  yamt 	 * interrupt configuration
    491  1.6.2.2  yamt 	 */
    492  1.6.2.2  yamt 	if ((dev->d_flags & (NJATA32_DEV_DMA_READ | NJATA32_DEV_DMA_ATAPI)) ==
    493  1.6.2.2  yamt 	    NJATA32_DEV_DMA_READ) {
    494  1.6.2.2  yamt 		/*
    495  1.6.2.2  yamt 		 * ATA piobm read is executed while device interrupt is active,
    496  1.6.2.2  yamt 		 * so disable device interrupt here
    497  1.6.2.2  yamt 		 */
    498  1.6.2.2  yamt 		bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    499  1.6.2.2  yamt 		    NJATA32_REG_IRQ_SELECT, NJATA32_IRQ_XFER);
    500  1.6.2.2  yamt 	}
    501  1.6.2.2  yamt 
    502  1.6.2.2  yamt 	/* enable scatter/gather busmaster transfer */
    503  1.6.2.2  yamt 	bmreg = NJATA32_BM_EN | NJATA32_BM_SG | NJATA32_BM_WAIT0 |
    504  1.6.2.2  yamt 	    ((dev->d_flags & NJATA32_DEV_DMA_READ) ? NJATA32_BM_RD : 0);
    505  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_BM,
    506  1.6.2.2  yamt 	    bmreg);
    507  1.6.2.2  yamt 
    508  1.6.2.2  yamt 	/* load scatter/gather table */
    509  1.6.2.2  yamt 	bus_space_write_4(NJATA32_REGT(sc), NJATA32_REGH(sc),
    510  1.6.2.2  yamt 	    NJATA32_REG_DMAADDR, dev->d_sgt_dma);
    511  1.6.2.2  yamt 	bus_space_write_4(NJATA32_REGT(sc), NJATA32_REGH(sc),
    512  1.6.2.2  yamt 	    NJATA32_REG_DMALENGTH, sizeof(struct njata32_sgtable) * nsegs);
    513  1.6.2.2  yamt 
    514  1.6.2.2  yamt 	/* start transfer */
    515  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_BM,
    516  1.6.2.2  yamt 	    (bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    517  1.6.2.2  yamt 		NJATA32_REG_BM)
    518  1.6.2.2  yamt 	     & ~(NJATA32_BM_RD|NJATA32_BM_SG|NJATA32_BM_WAIT_MASK)) |
    519  1.6.2.2  yamt 	    bmreg | NJATA32_BM_GO);
    520  1.6.2.2  yamt 
    521  1.6.2.2  yamt 	sc->sc_devflags = dev->d_flags;
    522  1.6.2.2  yamt 	if (flags & WDC_PIOBM_XFER_IRQ)
    523  1.6.2.2  yamt 		sc->sc_devflags |= NJATA32_DEV_XFER_INTR;
    524  1.6.2.2  yamt #ifdef DIAGNOSTIC
    525  1.6.2.2  yamt 	dev->d_flags |= NJATA32_DEV_DMA_STARTED;
    526  1.6.2.2  yamt #endif
    527  1.6.2.2  yamt }
    528  1.6.2.2  yamt 
    529  1.6.2.2  yamt /*
    530  1.6.2.2  yamt  * end of DMA
    531  1.6.2.2  yamt  */
    532  1.6.2.2  yamt int
    533  1.6.2.2  yamt njata32_dma_finish(void *v, int channel, int drive,
    534  1.6.2.2  yamt 		   int force)
    535  1.6.2.2  yamt {
    536  1.6.2.2  yamt 	struct njata32_softc *sc = v;
    537  1.6.2.2  yamt 	struct njata32_device *dev = &sc->sc_dev[drive];
    538  1.6.2.2  yamt 	int bm;
    539  1.6.2.2  yamt 	int error = 0;
    540  1.6.2.2  yamt 
    541  1.6.2.2  yamt 	DPRINTF(("%s: njata32_dma_finish: bm = %#x\n", NJATA32NAME(sc),
    542  1.6.2.2  yamt 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    543  1.6.2.2  yamt 		NJATA32_REG_BM)));
    544  1.6.2.2  yamt 
    545  1.6.2.2  yamt 	KASSERT(channel == 0);
    546  1.6.2.2  yamt 	KASSERT(dev->d_flags & NJATA32_DEV_DMA_MAPPED);
    547  1.6.2.2  yamt 	KASSERT(dev->d_flags & NJATA32_DEV_DMA_STARTED);
    548  1.6.2.2  yamt 
    549  1.6.2.2  yamt 	bm = bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    550  1.6.2.2  yamt 	    NJATA32_REG_BM);
    551  1.6.2.2  yamt 
    552  1.6.2.2  yamt #ifdef NJATA32_DEBUG
    553  1.6.2.2  yamt 	printf("%s: irq %#x, bm %#x, 18 %#x, 1c %#x\n", NJATA32NAME(sc),
    554  1.6.2.2  yamt 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    555  1.6.2.2  yamt 		NJATA32_REG_IRQ_STAT),
    556  1.6.2.2  yamt 	    bm,
    557  1.6.2.2  yamt 	    bus_space_read_4(NJATA32_REGT(sc), NJATA32_REGH(sc), 0x18),
    558  1.6.2.2  yamt 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc), 0x1c));
    559  1.6.2.2  yamt #endif
    560  1.6.2.2  yamt 
    561  1.6.2.2  yamt 	bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_sgt,
    562  1.6.2.2  yamt 	    (char *)dev->d_sgt - (char *)sc->sc_sgtpg,
    563  1.6.2.2  yamt 	    sizeof(struct njata32_sgtable) * sc->sc_piobm_nsegs,
    564  1.6.2.2  yamt 	    BUS_DMASYNC_POSTWRITE);
    565  1.6.2.2  yamt 
    566  1.6.2.2  yamt 	/* check if DMA is active */
    567  1.6.2.2  yamt 	if (bm & NJATA32_BM_GO) {
    568  1.6.2.2  yamt 		error = WDC_DMAST_NOIRQ;
    569  1.6.2.2  yamt 
    570  1.6.2.2  yamt 		switch (force) {
    571  1.6.2.2  yamt 		case WDC_DMAEND_END:
    572  1.6.2.2  yamt 			return error;
    573  1.6.2.2  yamt 
    574  1.6.2.2  yamt 		case WDC_DMAEND_ABRT:
    575  1.6.2.2  yamt 			printf("%s: aborting DMA\n", NJATA32NAME(sc));
    576  1.6.2.2  yamt 			break;
    577  1.6.2.2  yamt 		}
    578  1.6.2.2  yamt 	}
    579  1.6.2.2  yamt 
    580  1.6.2.2  yamt 	/*
    581  1.6.2.2  yamt 	 * ???
    582  1.6.2.2  yamt 	 * For unknown reason, PIOBM transfer sometimes fails in the middle,
    583  1.6.2.2  yamt 	 * in which case the bit #7 of BM register becomes 0.
    584  1.6.2.2  yamt 	 * Increasing the wait value seems to improve the situation.
    585  1.6.2.2  yamt 	 *
    586  1.6.2.2  yamt 	 * XXX
    587  1.6.2.2  yamt 	 * PIO transfer may also fail, but it seems it can't be detected.
    588  1.6.2.2  yamt 	 */
    589  1.6.2.2  yamt 	if ((bm & NJATA32_BM_DONE) == 0) {
    590  1.6.2.2  yamt 		error |= WDC_DMAST_ERR;
    591  1.6.2.2  yamt 		printf("%s: busmaster error", NJATA32NAME(sc));
    592  1.6.2.2  yamt 		if (sc->sc_atawait < 0x11) {
    593  1.6.2.2  yamt 			if ((sc->sc_atawait & 0xf) == 0)
    594  1.6.2.2  yamt 				sc->sc_atawait++;
    595  1.6.2.2  yamt 			else
    596  1.6.2.2  yamt 				sc->sc_atawait += 0x10;
    597  1.6.2.2  yamt 			printf(", new ATA wait = %#x", sc->sc_atawait);
    598  1.6.2.2  yamt 			njata32_setup_channel(&sc->sc_ch[0].ch_ata_channel);
    599  1.6.2.2  yamt 		}
    600  1.6.2.2  yamt 		printf("\n");
    601  1.6.2.2  yamt 	}
    602  1.6.2.2  yamt 
    603  1.6.2.2  yamt 	/* stop command */
    604  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_AS,
    605  1.6.2.2  yamt 	    NJATA32_AS_WAIT0);
    606  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_BM,
    607  1.6.2.2  yamt 	    NJATA32_BM_WAIT0);
    608  1.6.2.2  yamt 
    609  1.6.2.2  yamt 	/* set timing for PIO */
    610  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    611  1.6.2.2  yamt 	    NJATA32_REG_TIMING, sc->sc_timing_pio);
    612  1.6.2.2  yamt 
    613  1.6.2.2  yamt 	/*
    614  1.6.2.2  yamt 	 * reenable device interrupt in case it was disabled for
    615  1.6.2.2  yamt 	 * this transfer
    616  1.6.2.2  yamt 	 */
    617  1.6.2.2  yamt 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    618  1.6.2.2  yamt 	    NJATA32_REG_IRQ_SELECT, NJATA32_IRQ_XFER | NJATA32_IRQ_DEV);
    619  1.6.2.2  yamt 
    620  1.6.2.2  yamt #if 1	/* should be? */
    621  1.6.2.2  yamt 	if ((sc->sc_devflags & NJATA32_DEV_GOT_XFER_INTR) == 0)
    622  1.6.2.2  yamt 		error |= WDC_DMAST_ERR;
    623  1.6.2.2  yamt #endif
    624  1.6.2.2  yamt 	sc->sc_devflags = 0;
    625  1.6.2.2  yamt 
    626  1.6.2.2  yamt #ifdef DIAGNOSTIC
    627  1.6.2.2  yamt 	dev->d_flags &= ~NJATA32_DEV_DMA_STARTED;
    628  1.6.2.2  yamt #endif
    629  1.6.2.2  yamt 
    630  1.6.2.2  yamt 	return error;
    631  1.6.2.2  yamt }
    632  1.6.2.2  yamt 
    633  1.6.2.2  yamt /*
    634  1.6.2.2  yamt  * unmap DMA buffer
    635  1.6.2.2  yamt  */
    636  1.6.2.2  yamt void
    637  1.6.2.2  yamt njata32_piobm_done(void *v, int channel, int drive)
    638  1.6.2.2  yamt {
    639  1.6.2.2  yamt 	struct njata32_softc *sc = v;
    640  1.6.2.2  yamt 	struct njata32_device *dev = &sc->sc_dev[drive];
    641  1.6.2.2  yamt 
    642  1.6.2.2  yamt 	DPRINTF(("%s: njata32_piobm_done: ch%d dv%d\n",
    643  1.6.2.2  yamt 	    NJATA32NAME(sc), channel, drive));
    644  1.6.2.2  yamt 
    645  1.6.2.2  yamt 	KASSERT(channel == 0);
    646  1.6.2.2  yamt 	KASSERT(dev->d_flags & NJATA32_DEV_DMA_MAPPED);
    647  1.6.2.2  yamt 	KASSERT((dev->d_flags & NJATA32_DEV_DMA_STARTED) == 0);
    648  1.6.2.2  yamt 
    649  1.6.2.2  yamt 	/* unload dma map */
    650  1.6.2.2  yamt 	bus_dmamap_sync(sc->sc_dmat, dev->d_dmamap_xfer,
    651  1.6.2.2  yamt 	    0, dev->d_dmamap_xfer->dm_mapsize,
    652  1.6.2.2  yamt 	    (dev->d_flags & NJATA32_DEV_DMA_READ) ?
    653  1.6.2.2  yamt 		BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
    654  1.6.2.2  yamt 
    655  1.6.2.2  yamt 	bus_dmamap_unload(sc->sc_dmat, dev->d_dmamap_xfer);
    656  1.6.2.2  yamt 	dev->d_flags &= ~NJATA32_DEV_DMA_MAPPED;
    657  1.6.2.2  yamt }
    658  1.6.2.2  yamt 
    659  1.6.2.2  yamt int
    660  1.6.2.2  yamt njata32_intr(arg)
    661  1.6.2.2  yamt 	void *arg;
    662  1.6.2.2  yamt {
    663  1.6.2.2  yamt 	struct njata32_softc *sc = arg;
    664  1.6.2.2  yamt 	struct ata_channel *chp;
    665  1.6.2.2  yamt 	int irq;
    666  1.6.2.2  yamt 
    667  1.6.2.2  yamt 	irq = bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    668  1.6.2.2  yamt 	    NJATA32_REG_IRQ_STAT);
    669  1.6.2.2  yamt 	if ((irq & (NJATA32_IRQ_XFER | NJATA32_IRQ_DEV)) == 0)
    670  1.6.2.2  yamt 		return 0;	/* not mine */
    671  1.6.2.2  yamt 
    672  1.6.2.2  yamt 	DPRINTF(("%s: njata32_intr: irq = %#x, altstatus = %#x\n",
    673  1.6.2.2  yamt 	    NJATA32NAME(sc), irq,
    674  1.6.2.2  yamt 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    675  1.6.2.2  yamt 		NJATA32_REG_WD_ALTSTATUS)));
    676  1.6.2.2  yamt 
    677  1.6.2.2  yamt 	chp = &sc->sc_ch[0].ch_ata_channel;
    678  1.6.2.2  yamt 
    679  1.6.2.2  yamt 	if (irq & NJATA32_IRQ_XFER)
    680  1.6.2.2  yamt 		sc->sc_devflags |= NJATA32_DEV_GOT_XFER_INTR;
    681  1.6.2.2  yamt 
    682  1.6.2.2  yamt 	if ((irq & (NJATA32_IRQ_XFER | NJATA32_IRQ_DEV)) == NJATA32_IRQ_XFER &&
    683  1.6.2.2  yamt 	    (sc->sc_devflags & NJATA32_DEV_XFER_INTR) == 0) {
    684  1.6.2.2  yamt 		/*
    685  1.6.2.2  yamt 		 * transfer done, wait for device interrupt
    686  1.6.2.2  yamt 		 */
    687  1.6.2.2  yamt 		bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    688  1.6.2.2  yamt 		    NJATA32_REG_BM, NJATA32_BM_WAIT0);
    689  1.6.2.2  yamt 		return 1;
    690  1.6.2.2  yamt 	}
    691  1.6.2.2  yamt 
    692  1.6.2.2  yamt 	/*
    693  1.6.2.2  yamt 	 * If both transfer done interrupt and device interrupt are
    694  1.6.2.2  yamt 	 * active for ATAPI transfer, call wdcintr() twice.
    695  1.6.2.2  yamt 	 */
    696  1.6.2.2  yamt 	if ((sc->sc_devflags & NJATA32_DEV_DMA_ATAPI) &&
    697  1.6.2.2  yamt 	    (irq & (NJATA32_IRQ_XFER | NJATA32_IRQ_DEV)) ==
    698  1.6.2.2  yamt 		(NJATA32_IRQ_XFER | NJATA32_IRQ_DEV) &&
    699  1.6.2.2  yamt 	    (sc->sc_devflags & NJATA32_DEV_XFER_INTR)) {
    700  1.6.2.2  yamt 		if (wdcintr(chp) == 0) {
    701  1.6.2.2  yamt 			njata32_clearirq(&sc->sc_ch[0].ch_ata_channel, irq);
    702  1.6.2.2  yamt 		}
    703  1.6.2.2  yamt 	}
    704  1.6.2.2  yamt 
    705  1.6.2.2  yamt 	if (wdcintr(chp) == 0) {
    706  1.6.2.2  yamt 		njata32_clearirq(&sc->sc_ch[0].ch_ata_channel, irq);
    707  1.6.2.2  yamt 	}
    708  1.6.2.2  yamt 
    709  1.6.2.2  yamt 	return 1;
    710  1.6.2.2  yamt }
    711