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