Home | History | Annotate | Line # | Download | only in ic
      1  1.20  jdolecek /*	$NetBSD: ninjaata32.c,v 1.20 2017/10/20 07:06:07 jdolecek 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.20  jdolecek __KERNEL_RCSID(0, "$NetBSD: ninjaata32.c,v 1.20 2017/10/20 07:06:07 jdolecek 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.18    bouyer 	sc->sc_wdcdev.wdc_maxdrives = 2; /* max number of drives per channel */
    195   1.1     itohy 
    196   1.1     itohy 	/* map ATA registers */
    197   1.1     itohy 	for (i = 0; i < WDC_NREG; i++) {
    198   1.1     itohy 		if (bus_space_subregion(NJATA32_REGT(sc), NJATA32_REGH(sc),
    199   1.1     itohy 		    NJATA32_OFFSET_WDCREGS + i,
    200   1.1     itohy 		    i == wd_data ? 4 : 1, &wdr->cmd_iohs[i]) != 0) {
    201   1.1     itohy 			aprint_error("%s: couldn't subregion cmd regs\n",
    202   1.1     itohy 			    NJATA32NAME(sc));
    203   1.1     itohy 			goto fail4;
    204   1.1     itohy 		}
    205   1.1     itohy 	}
    206  1.19  jdolecek 	wdc_init_shadow_regs(wdr);
    207   1.1     itohy 	wdr->data32iot = NJATA32_REGT(sc);
    208   1.1     itohy 	wdr->data32ioh = wdr->cmd_iohs[wd_data];
    209   1.1     itohy 
    210   1.1     itohy 	/* map ATA ctl reg */
    211   1.1     itohy 	wdr->ctl_iot = NJATA32_REGT(sc);
    212   1.1     itohy 	if (bus_space_subregion(NJATA32_REGT(sc), NJATA32_REGH(sc),
    213   1.1     itohy 	    NJATA32_REG_WD_ALTSTATUS, 1, &wdr->ctl_ioh) != 0) {
    214   1.1     itohy 		aprint_error("%s: couldn't subregion ctl regs\n",
    215   1.1     itohy 		    NJATA32NAME(sc));
    216   1.1     itohy 		goto fail4;
    217   1.1     itohy 	}
    218   1.1     itohy 
    219   1.1     itohy 	sc->sc_flags |= NJATA32_CMDPG_MAPPED;
    220   1.1     itohy 
    221   1.1     itohy 	/* use flags value as busmaster wait */
    222   1.2     itohy 	if ((sc->sc_atawait =
    223  1.10      cube 	    (uint8_t)device_cfdata(sc->sc_wdcdev.sc_atac.atac_dev)->cf_flags))
    224   1.2     itohy 		aprint_normal("%s: ATA wait = %#x\n",
    225   1.2     itohy 		    NJATA32NAME(sc), sc->sc_atawait);
    226   1.1     itohy 
    227   1.1     itohy 	njata32_init(sc, cold);
    228   1.1     itohy 
    229   1.1     itohy 	wdcattach(&sc->sc_ch[0].ch_ata_channel);
    230   1.1     itohy 
    231   1.1     itohy 	return;
    232   1.1     itohy 
    233   1.1     itohy 	/*
    234   1.1     itohy 	 * cleanup
    235   1.1     itohy 	 */
    236   1.1     itohy fail4:	while (--devno >= 0) {
    237   1.1     itohy 		bus_dmamap_destroy(sc->sc_dmat,
    238   1.1     itohy 		    sc->sc_dev[devno].d_dmamap_xfer);
    239   1.1     itohy 	}
    240   1.1     itohy 	bus_dmamap_unload(sc->sc_dmat, sc->sc_dmamap_sgt);
    241   1.1     itohy fail3:	bus_dmamap_destroy(sc->sc_dmat, sc->sc_dmamap_sgt);
    242   1.7  christos fail2:	bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_sgtpg,
    243   1.1     itohy 	    sizeof(struct njata32_dma_page));
    244   1.1     itohy fail1:	bus_dmamem_free(sc->sc_dmat, &sc->sc_sgt_seg, sc->sc_sgt_nsegs);
    245   1.1     itohy }
    246   1.1     itohy 
    247   1.1     itohy int
    248  1.10      cube njata32_detach(struct njata32_softc *sc, int flags)
    249   1.1     itohy {
    250   1.1     itohy 	int rv, devno;
    251   1.1     itohy 
    252   1.1     itohy 	if (sc->sc_flags & NJATA32_CMDPG_MAPPED) {
    253  1.10      cube 		if ((rv = wdcdetach(sc->sc_wdcdev.sc_atac.atac_dev, flags)))
    254   1.1     itohy 			return rv;
    255   1.1     itohy 
    256   1.1     itohy 		/* free DMA resource */
    257   1.1     itohy 		for (devno = 0; devno < NJATA32_NUM_DEV; devno++) {
    258   1.1     itohy 			bus_dmamap_destroy(sc->sc_dmat,
    259   1.1     itohy 			    sc->sc_dev[devno].d_dmamap_xfer);
    260   1.1     itohy 		}
    261   1.1     itohy 		bus_dmamap_unload(sc->sc_dmat, sc->sc_dmamap_sgt);
    262   1.1     itohy 		bus_dmamap_destroy(sc->sc_dmat, sc->sc_dmamap_sgt);
    263   1.7  christos 		bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_sgtpg,
    264   1.1     itohy 		    sizeof(struct njata32_dma_page));
    265   1.1     itohy 		bus_dmamem_free(sc->sc_dmat, &sc->sc_sgt_seg, sc->sc_sgt_nsegs);
    266   1.1     itohy 	}
    267   1.1     itohy 
    268   1.1     itohy 	return 0;
    269   1.1     itohy }
    270   1.1     itohy 
    271   1.1     itohy static void
    272  1.10      cube njata32_irqack(struct ata_channel *chp)
    273   1.1     itohy {
    274   1.1     itohy 	struct njata32_softc *sc = (void *)chp->ch_atac;
    275   1.1     itohy 
    276   1.1     itohy 	/* disable busmaster */
    277   1.1     itohy 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    278   1.2     itohy 	    NJATA32_REG_BM, NJATA32_BM_WAIT0);
    279   1.1     itohy }
    280   1.1     itohy 
    281   1.1     itohy static void
    282  1.10      cube njata32_clearirq(struct ata_channel *chp, int irq)
    283   1.1     itohy {
    284   1.1     itohy 	struct njata32_softc *sc = (void *)chp->ch_atac;
    285   1.1     itohy 
    286  1.10      cube 	aprint_error("%s: unhandled intr: irq %#x, bm %#x, ",
    287   1.1     itohy 	    NJATA32NAME(sc), irq,
    288   1.1     itohy 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    289   1.1     itohy 		NJATA32_REG_BM));
    290   1.1     itohy 
    291   1.1     itohy 	/* disable busmaster */
    292   1.1     itohy 	njata32_irqack(chp);
    293   1.1     itohy 
    294   1.1     itohy 	/* clear device interrupt */
    295  1.10      cube 	aprint_normal("err %#x, seccnt %#x, cyl %#x, sdh %#x, ",
    296   1.1     itohy 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    297   1.1     itohy 		NJATA32_REG_WD_ERROR),
    298   1.1     itohy 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    299   1.1     itohy 		NJATA32_REG_WD_SECCNT),
    300   1.1     itohy 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    301   1.1     itohy 		NJATA32_REG_WD_CYL_LO) |
    302   1.1     itohy 	    (bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    303   1.1     itohy 		NJATA32_REG_WD_CYL_HI) << 8),
    304   1.1     itohy 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    305   1.1     itohy 		NJATA32_REG_WD_SDH));
    306  1.10      cube 	aprint_normal("status %#x\n",
    307   1.1     itohy 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    308   1.1     itohy 	    NJATA32_REG_WD_STATUS));
    309   1.1     itohy }
    310   1.1     itohy 
    311   1.1     itohy static void
    312  1.10      cube njata32_setup_channel(struct ata_channel *chp)
    313   1.1     itohy {
    314   1.1     itohy 	struct njata32_softc *sc = (void *)chp->ch_atac;
    315   1.1     itohy 	struct ata_drive_datas *drvp;
    316   1.1     itohy 	int drive;
    317   1.1     itohy 	uint8_t mode;
    318   1.1     itohy 
    319  1.18    bouyer 	KASSERT(chp->ch_ndrives != 0);
    320   1.1     itohy 
    321   1.1     itohy 	sc->sc_timing_pio = 0;
    322   1.1     itohy #if 0	/* ATA DMA is currently unused */
    323   1.1     itohy 	sc->sc_timing_dma = 0;
    324   1.1     itohy #endif
    325   1.1     itohy 
    326  1.18    bouyer 	for (drive = 0; drive < chp->ch_ndrives; drive++) {
    327   1.1     itohy 		drvp = &chp->ch_drive[drive];
    328  1.18    bouyer 		if (drvp->drive_type == ATA_DRIVET_NONE)
    329   1.1     itohy 			continue;	/* no drive */
    330   1.1     itohy 
    331   1.1     itohy #if 0	/* ATA DMA is currently unused */
    332  1.18    bouyer 		if ((drvp->drive_flags & ATA_DRIVE_DMA) != 0) {
    333   1.1     itohy 			/*
    334   1.1     itohy 			 * Multiword DMA
    335   1.1     itohy 			 */
    336   1.1     itohy 			if ((mode = drvp->DMA_mode) > NJATA32_MODE_MAX_DMA)
    337   1.1     itohy 				mode = NJATA32_MODE_MAX_DMA;
    338   1.1     itohy 			if (sc->sc_timing_dma < njata32_timing_dma[mode])
    339   1.1     itohy 				sc->sc_timing_dma = njata32_timing_dma[mode];
    340   1.1     itohy 		}
    341   1.1     itohy #endif
    342   1.1     itohy 		/*
    343   1.1     itohy 		 * PIO
    344   1.1     itohy 		 */
    345   1.1     itohy 		if ((mode = drvp->PIO_mode) > NJATA32_MODE_MAX_PIO)
    346   1.1     itohy 			mode = NJATA32_MODE_MAX_PIO;
    347   1.1     itohy 		if (sc->sc_timing_pio < njata32_timing_pio[mode])
    348   1.1     itohy 			sc->sc_timing_pio = njata32_timing_pio[mode];
    349   1.1     itohy 	}
    350   1.1     itohy 
    351   1.2     itohy 	sc->sc_timing_pio += sc->sc_atawait;
    352   1.2     itohy 
    353   1.1     itohy 	/* set timing for PIO */
    354   1.1     itohy 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    355   1.1     itohy 	    NJATA32_REG_TIMING, sc->sc_timing_pio);
    356   1.1     itohy }
    357   1.1     itohy 
    358   1.1     itohy /*
    359   1.1     itohy  * map DMA buffer
    360   1.1     itohy  */
    361   1.1     itohy int
    362   1.5  christos njata32_dma_init(void *v, int channel, int drive, void *databuf,
    363   1.4    dogcow 		 size_t datalen, int flags)
    364   1.1     itohy {
    365   1.1     itohy 	struct njata32_softc *sc = v;
    366   1.1     itohy 	int error;
    367   1.1     itohy 	struct njata32_device *dev = &sc->sc_dev[drive];
    368   1.1     itohy 
    369   1.1     itohy 	KASSERT(channel == 0);
    370   1.1     itohy 	KASSERT((dev->d_flags & NJATA32_DEV_DMA_MAPPED) == 0);
    371   1.1     itohy 	KASSERT((dev->d_flags & NJATA32_DEV_DMA_STARTED) == 0);
    372   1.1     itohy 
    373   1.1     itohy 	KASSERT(flags & (WDC_DMA_PIOBM_ATA | WDC_DMA_PIOBM_ATAPI));
    374   1.1     itohy 
    375   1.1     itohy 	/* use PIO for short transfer */
    376   1.1     itohy 	if (datalen < 64 /* needs tune */) {
    377   1.1     itohy 		DPRINTF(("%s: njata32_dma_init: short transfer (%u)\n",
    378   1.1     itohy 		    NJATA32NAME(sc), (unsigned)datalen));
    379   1.1     itohy 		bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    380   1.1     itohy 		    NJATA32_REG_TIMING, sc->sc_timing_pio);
    381   1.1     itohy 		return EINVAL;
    382   1.1     itohy 	}
    383   1.1     itohy 
    384   1.1     itohy 	/* use PIO for unaligned transfer (word alignment seems OK) */
    385   1.1     itohy 	if (((uintptr_t)databuf & 1) || (datalen & 1)) {
    386   1.1     itohy 		DPRINTF(("%s: njata32_dma_init: unaligned: buf %p, len %u\n",
    387   1.1     itohy 		    NJATA32NAME(sc), databuf, (unsigned)datalen));
    388   1.1     itohy 		return EINVAL;
    389   1.1     itohy 	}
    390   1.1     itohy 
    391   1.1     itohy 	DPRINTF(("%s: njata32_dma_init: %s: databuf %p, datalen %u\n",
    392   1.1     itohy 	    NJATA32NAME(sc), (flags & WDC_DMA_READ) ? "read" : "write",
    393   1.1     itohy 	    databuf, (unsigned)datalen));
    394   1.1     itohy 
    395   1.1     itohy 	error = bus_dmamap_load(sc->sc_dmat, dev->d_dmamap_xfer,
    396   1.1     itohy 	    databuf, datalen, NULL, BUS_DMA_NOWAIT | BUS_DMA_STREAMING |
    397   1.1     itohy 	    ((flags & WDC_DMA_READ) ? BUS_DMA_READ : BUS_DMA_WRITE));
    398   1.1     itohy 	if (error) {
    399   1.1     itohy 		printf("%s: load xfer failed, error %d\n",
    400   1.1     itohy 		    NJATA32NAME(sc), error);
    401   1.1     itohy 		return error;
    402   1.1     itohy 	}
    403   1.1     itohy 
    404   1.1     itohy 	bus_dmamap_sync(sc->sc_dmat, dev->d_dmamap_xfer, 0,
    405   1.1     itohy 	    dev->d_dmamap_xfer->dm_mapsize,
    406   1.1     itohy 	    (flags & WDC_DMA_READ) ?
    407   1.1     itohy 		BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
    408   1.1     itohy 
    409   1.1     itohy 	dev->d_flags =
    410   1.1     itohy 	    ((flags & WDC_DMA_READ) ? NJATA32_DEV_DMA_READ : 0) |
    411   1.1     itohy 	    ((flags & WDC_DMA_PIOBM_ATAPI) ? NJATA32_DEV_DMA_ATAPI : 0) |
    412   1.1     itohy 	    NJATA32_DEV_DMA_MAPPED;
    413   1.1     itohy 
    414   1.1     itohy 	return 0;
    415   1.1     itohy }
    416   1.1     itohy 
    417   1.1     itohy /*
    418   1.1     itohy  * start DMA
    419   1.1     itohy  *
    420   1.1     itohy  * top:  databuf + skip
    421   1.1     itohy  * size: xferlen
    422   1.1     itohy  */
    423   1.1     itohy void
    424   1.5  christos njata32_piobm_start(void *v, int channel, int drive,
    425   1.4    dogcow 		    int skip, int xferlen, int flags)
    426   1.1     itohy {
    427   1.1     itohy 	struct njata32_softc *sc = v;
    428   1.1     itohy 	struct njata32_device *dev = &sc->sc_dev[drive];
    429   1.1     itohy 	int i, nsegs, seglen;
    430   1.1     itohy 	uint8_t bmreg;
    431   1.1     itohy 
    432   1.1     itohy 	DPRINTF(("%s: njata32_piobm_start: ch%d, dv%d, skip %d, xferlen %d\n",
    433   1.1     itohy 	    NJATA32NAME(sc), channel, drive, skip, xferlen));
    434   1.1     itohy 
    435   1.1     itohy 	KASSERT(channel == 0);
    436   1.1     itohy 	KASSERT(dev->d_flags & NJATA32_DEV_DMA_MAPPED);
    437   1.1     itohy 	KASSERT((dev->d_flags & NJATA32_DEV_DMA_STARTED) == 0);
    438   1.1     itohy 
    439   1.1     itohy 	/*
    440   1.1     itohy 	 * create scatter/gather table
    441   1.1     itohy 	 * XXX this code may be slow
    442   1.1     itohy 	 */
    443   1.1     itohy 	for (i = nsegs = 0;
    444   1.1     itohy 	    i < dev->d_dmamap_xfer->dm_nsegs && xferlen > 0; i++) {
    445   1.1     itohy 		if (dev->d_dmamap_xfer->dm_segs[i].ds_len <= skip) {
    446   1.1     itohy 			skip -= dev->d_dmamap_xfer->dm_segs[i].ds_len;
    447   1.1     itohy 			continue;
    448   1.1     itohy 		}
    449   1.1     itohy 
    450   1.1     itohy 		seglen = dev->d_dmamap_xfer->dm_segs[i].ds_len - skip;
    451   1.1     itohy 		if (seglen > xferlen)
    452   1.1     itohy 			seglen = xferlen;
    453   1.1     itohy 
    454   1.1     itohy 		dev->d_sgt[nsegs].sg_addr =
    455   1.1     itohy 		    htole32(dev->d_dmamap_xfer->dm_segs[i].ds_addr + skip);
    456   1.1     itohy 		dev->d_sgt[nsegs].sg_len = htole32(seglen);
    457   1.1     itohy 
    458   1.1     itohy 		xferlen -= seglen;
    459   1.1     itohy 		nsegs++;
    460   1.1     itohy 		skip = 0;
    461   1.1     itohy 	}
    462   1.1     itohy 	sc->sc_piobm_nsegs = nsegs;
    463   1.1     itohy 	/* end mark */
    464   1.1     itohy 	dev->d_sgt[nsegs - 1].sg_len |= htole32(NJATA32_SGT_ENDMARK);
    465   1.1     itohy 
    466   1.1     itohy #ifdef DIAGNOSTIC
    467   1.1     itohy 	if (xferlen)
    468   1.1     itohy 		panic("%s: njata32_piobm_start: xferlen residue %d\n",
    469   1.1     itohy 		    NJATA32NAME(sc), xferlen);
    470   1.1     itohy #endif
    471   1.1     itohy 
    472   1.1     itohy 	bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_sgt,
    473   1.1     itohy 	    (char *)dev->d_sgt - (char *)sc->sc_sgtpg,
    474   1.1     itohy 	    sizeof(struct njata32_sgtable) * nsegs,
    475   1.1     itohy 	    BUS_DMASYNC_PREWRITE);
    476   1.1     itohy 
    477   1.1     itohy 	/* set timing for PIO */
    478   1.1     itohy 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    479   1.1     itohy 	    NJATA32_REG_TIMING, sc->sc_timing_pio);
    480   1.1     itohy 
    481   1.1     itohy 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_IOBM,
    482   1.1     itohy 	    NJATA32_IOBM_DEFAULT);
    483   1.1     itohy 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_AS,
    484   1.1     itohy 	    NJATA32_AS_WAIT0);
    485   1.1     itohy 
    486   1.1     itohy 	/*
    487   1.1     itohy 	 * interrupt configuration
    488   1.1     itohy 	 */
    489   1.1     itohy 	if ((dev->d_flags & (NJATA32_DEV_DMA_READ | NJATA32_DEV_DMA_ATAPI)) ==
    490   1.1     itohy 	    NJATA32_DEV_DMA_READ) {
    491   1.1     itohy 		/*
    492   1.1     itohy 		 * ATA piobm read is executed while device interrupt is active,
    493   1.1     itohy 		 * so disable device interrupt here
    494   1.1     itohy 		 */
    495   1.1     itohy 		bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    496   1.1     itohy 		    NJATA32_REG_IRQ_SELECT, NJATA32_IRQ_XFER);
    497   1.1     itohy 	}
    498   1.1     itohy 
    499   1.1     itohy 	/* enable scatter/gather busmaster transfer */
    500   1.2     itohy 	bmreg = NJATA32_BM_EN | NJATA32_BM_SG | NJATA32_BM_WAIT0 |
    501   1.1     itohy 	    ((dev->d_flags & NJATA32_DEV_DMA_READ) ? NJATA32_BM_RD : 0);
    502   1.1     itohy 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_BM,
    503   1.1     itohy 	    bmreg);
    504   1.1     itohy 
    505   1.1     itohy 	/* load scatter/gather table */
    506   1.1     itohy 	bus_space_write_4(NJATA32_REGT(sc), NJATA32_REGH(sc),
    507   1.1     itohy 	    NJATA32_REG_DMAADDR, dev->d_sgt_dma);
    508   1.1     itohy 	bus_space_write_4(NJATA32_REGT(sc), NJATA32_REGH(sc),
    509   1.1     itohy 	    NJATA32_REG_DMALENGTH, sizeof(struct njata32_sgtable) * nsegs);
    510   1.1     itohy 
    511   1.1     itohy 	/* start transfer */
    512   1.1     itohy 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_BM,
    513   1.1     itohy 	    (bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    514   1.1     itohy 		NJATA32_REG_BM)
    515   1.1     itohy 	     & ~(NJATA32_BM_RD|NJATA32_BM_SG|NJATA32_BM_WAIT_MASK)) |
    516   1.1     itohy 	    bmreg | NJATA32_BM_GO);
    517   1.1     itohy 
    518   1.1     itohy 	sc->sc_devflags = dev->d_flags;
    519   1.1     itohy 	if (flags & WDC_PIOBM_XFER_IRQ)
    520   1.1     itohy 		sc->sc_devflags |= NJATA32_DEV_XFER_INTR;
    521   1.1     itohy #ifdef DIAGNOSTIC
    522   1.1     itohy 	dev->d_flags |= NJATA32_DEV_DMA_STARTED;
    523   1.1     itohy #endif
    524   1.1     itohy }
    525   1.1     itohy 
    526   1.1     itohy /*
    527   1.1     itohy  * end of DMA
    528   1.1     itohy  */
    529   1.1     itohy int
    530   1.5  christos njata32_dma_finish(void *v, int channel, int drive,
    531   1.4    dogcow 		   int force)
    532   1.1     itohy {
    533   1.1     itohy 	struct njata32_softc *sc = v;
    534   1.6     itohy 	struct njata32_device *dev = &sc->sc_dev[drive];
    535   1.1     itohy 	int bm;
    536   1.1     itohy 	int error = 0;
    537   1.1     itohy 
    538   1.1     itohy 	DPRINTF(("%s: njata32_dma_finish: bm = %#x\n", NJATA32NAME(sc),
    539   1.1     itohy 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    540   1.1     itohy 		NJATA32_REG_BM)));
    541   1.1     itohy 
    542   1.1     itohy 	KASSERT(channel == 0);
    543   1.6     itohy 	KASSERT(dev->d_flags & NJATA32_DEV_DMA_MAPPED);
    544   1.6     itohy 	KASSERT(dev->d_flags & NJATA32_DEV_DMA_STARTED);
    545   1.1     itohy 
    546   1.1     itohy 	bm = bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    547   1.1     itohy 	    NJATA32_REG_BM);
    548   1.1     itohy 
    549   1.1     itohy #ifdef NJATA32_DEBUG
    550   1.1     itohy 	printf("%s: irq %#x, bm %#x, 18 %#x, 1c %#x\n", NJATA32NAME(sc),
    551   1.1     itohy 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    552   1.1     itohy 		NJATA32_REG_IRQ_STAT),
    553   1.1     itohy 	    bm,
    554   1.1     itohy 	    bus_space_read_4(NJATA32_REGT(sc), NJATA32_REGH(sc), 0x18),
    555   1.1     itohy 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc), 0x1c));
    556   1.1     itohy #endif
    557   1.1     itohy 
    558   1.6     itohy 	bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_sgt,
    559   1.6     itohy 	    (char *)dev->d_sgt - (char *)sc->sc_sgtpg,
    560   1.6     itohy 	    sizeof(struct njata32_sgtable) * sc->sc_piobm_nsegs,
    561   1.6     itohy 	    BUS_DMASYNC_POSTWRITE);
    562   1.6     itohy 
    563   1.1     itohy 	/* check if DMA is active */
    564   1.1     itohy 	if (bm & NJATA32_BM_GO) {
    565   1.1     itohy 		error = WDC_DMAST_NOIRQ;
    566   1.1     itohy 
    567   1.1     itohy 		switch (force) {
    568   1.1     itohy 		case WDC_DMAEND_END:
    569   1.1     itohy 			return error;
    570   1.1     itohy 
    571   1.1     itohy 		case WDC_DMAEND_ABRT:
    572   1.1     itohy 			printf("%s: aborting DMA\n", NJATA32NAME(sc));
    573   1.1     itohy 			break;
    574   1.1     itohy 		}
    575   1.1     itohy 	}
    576   1.1     itohy 
    577   1.1     itohy 	/*
    578   1.1     itohy 	 * ???
    579   1.1     itohy 	 * For unknown reason, PIOBM transfer sometimes fails in the middle,
    580   1.1     itohy 	 * in which case the bit #7 of BM register becomes 0.
    581   1.1     itohy 	 * Increasing the wait value seems to improve the situation.
    582   1.2     itohy 	 *
    583   1.2     itohy 	 * XXX
    584   1.2     itohy 	 * PIO transfer may also fail, but it seems it can't be detected.
    585   1.1     itohy 	 */
    586   1.1     itohy 	if ((bm & NJATA32_BM_DONE) == 0) {
    587   1.1     itohy 		error |= WDC_DMAST_ERR;
    588   1.1     itohy 		printf("%s: busmaster error", NJATA32NAME(sc));
    589   1.2     itohy 		if (sc->sc_atawait < 0x11) {
    590   1.2     itohy 			if ((sc->sc_atawait & 0xf) == 0)
    591   1.2     itohy 				sc->sc_atawait++;
    592   1.2     itohy 			else
    593   1.2     itohy 				sc->sc_atawait += 0x10;
    594   1.2     itohy 			printf(", new ATA wait = %#x", sc->sc_atawait);
    595   1.2     itohy 			njata32_setup_channel(&sc->sc_ch[0].ch_ata_channel);
    596   1.1     itohy 		}
    597   1.1     itohy 		printf("\n");
    598   1.1     itohy 	}
    599   1.1     itohy 
    600   1.1     itohy 	/* stop command */
    601   1.1     itohy 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_AS,
    602   1.1     itohy 	    NJATA32_AS_WAIT0);
    603   1.1     itohy 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc), NJATA32_REG_BM,
    604   1.2     itohy 	    NJATA32_BM_WAIT0);
    605   1.1     itohy 
    606   1.1     itohy 	/* set timing for PIO */
    607   1.1     itohy 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    608   1.1     itohy 	    NJATA32_REG_TIMING, sc->sc_timing_pio);
    609   1.1     itohy 
    610   1.1     itohy 	/*
    611   1.1     itohy 	 * reenable device interrupt in case it was disabled for
    612   1.1     itohy 	 * this transfer
    613   1.1     itohy 	 */
    614   1.1     itohy 	bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    615   1.1     itohy 	    NJATA32_REG_IRQ_SELECT, NJATA32_IRQ_XFER | NJATA32_IRQ_DEV);
    616   1.1     itohy 
    617   1.1     itohy #if 1	/* should be? */
    618   1.1     itohy 	if ((sc->sc_devflags & NJATA32_DEV_GOT_XFER_INTR) == 0)
    619   1.1     itohy 		error |= WDC_DMAST_ERR;
    620   1.1     itohy #endif
    621   1.1     itohy 	sc->sc_devflags = 0;
    622   1.1     itohy 
    623   1.1     itohy #ifdef DIAGNOSTIC
    624   1.6     itohy 	dev->d_flags &= ~NJATA32_DEV_DMA_STARTED;
    625   1.1     itohy #endif
    626   1.1     itohy 
    627   1.1     itohy 	return error;
    628   1.1     itohy }
    629   1.1     itohy 
    630   1.1     itohy /*
    631   1.1     itohy  * unmap DMA buffer
    632   1.1     itohy  */
    633   1.1     itohy void
    634   1.5  christos njata32_piobm_done(void *v, int channel, int drive)
    635   1.1     itohy {
    636   1.1     itohy 	struct njata32_softc *sc = v;
    637   1.1     itohy 	struct njata32_device *dev = &sc->sc_dev[drive];
    638   1.1     itohy 
    639   1.1     itohy 	DPRINTF(("%s: njata32_piobm_done: ch%d dv%d\n",
    640   1.1     itohy 	    NJATA32NAME(sc), channel, drive));
    641   1.1     itohy 
    642   1.1     itohy 	KASSERT(channel == 0);
    643   1.1     itohy 	KASSERT(dev->d_flags & NJATA32_DEV_DMA_MAPPED);
    644   1.1     itohy 	KASSERT((dev->d_flags & NJATA32_DEV_DMA_STARTED) == 0);
    645   1.1     itohy 
    646   1.1     itohy 	/* unload dma map */
    647   1.1     itohy 	bus_dmamap_sync(sc->sc_dmat, dev->d_dmamap_xfer,
    648   1.1     itohy 	    0, dev->d_dmamap_xfer->dm_mapsize,
    649   1.1     itohy 	    (dev->d_flags & NJATA32_DEV_DMA_READ) ?
    650   1.1     itohy 		BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
    651   1.1     itohy 
    652   1.1     itohy 	bus_dmamap_unload(sc->sc_dmat, dev->d_dmamap_xfer);
    653   1.1     itohy 	dev->d_flags &= ~NJATA32_DEV_DMA_MAPPED;
    654   1.1     itohy }
    655   1.1     itohy 
    656   1.1     itohy int
    657  1.11       dsl njata32_intr(void *arg)
    658   1.1     itohy {
    659   1.1     itohy 	struct njata32_softc *sc = arg;
    660   1.1     itohy 	struct ata_channel *chp;
    661   1.1     itohy 	int irq;
    662   1.1     itohy 
    663   1.1     itohy 	irq = bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    664   1.1     itohy 	    NJATA32_REG_IRQ_STAT);
    665   1.1     itohy 	if ((irq & (NJATA32_IRQ_XFER | NJATA32_IRQ_DEV)) == 0)
    666   1.1     itohy 		return 0;	/* not mine */
    667   1.1     itohy 
    668   1.1     itohy 	DPRINTF(("%s: njata32_intr: irq = %#x, altstatus = %#x\n",
    669   1.1     itohy 	    NJATA32NAME(sc), irq,
    670   1.1     itohy 	    bus_space_read_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    671   1.1     itohy 		NJATA32_REG_WD_ALTSTATUS)));
    672   1.1     itohy 
    673   1.1     itohy 	chp = &sc->sc_ch[0].ch_ata_channel;
    674   1.1     itohy 
    675   1.1     itohy 	if (irq & NJATA32_IRQ_XFER)
    676   1.1     itohy 		sc->sc_devflags |= NJATA32_DEV_GOT_XFER_INTR;
    677   1.1     itohy 
    678   1.1     itohy 	if ((irq & (NJATA32_IRQ_XFER | NJATA32_IRQ_DEV)) == NJATA32_IRQ_XFER &&
    679   1.1     itohy 	    (sc->sc_devflags & NJATA32_DEV_XFER_INTR) == 0) {
    680   1.1     itohy 		/*
    681   1.1     itohy 		 * transfer done, wait for device interrupt
    682   1.1     itohy 		 */
    683   1.1     itohy 		bus_space_write_1(NJATA32_REGT(sc), NJATA32_REGH(sc),
    684   1.2     itohy 		    NJATA32_REG_BM, NJATA32_BM_WAIT0);
    685   1.1     itohy 		return 1;
    686   1.1     itohy 	}
    687   1.1     itohy 
    688   1.1     itohy 	/*
    689   1.1     itohy 	 * If both transfer done interrupt and device interrupt are
    690   1.1     itohy 	 * active for ATAPI transfer, call wdcintr() twice.
    691   1.1     itohy 	 */
    692   1.1     itohy 	if ((sc->sc_devflags & NJATA32_DEV_DMA_ATAPI) &&
    693   1.1     itohy 	    (irq & (NJATA32_IRQ_XFER | NJATA32_IRQ_DEV)) ==
    694   1.1     itohy 		(NJATA32_IRQ_XFER | NJATA32_IRQ_DEV) &&
    695   1.1     itohy 	    (sc->sc_devflags & NJATA32_DEV_XFER_INTR)) {
    696   1.1     itohy 		if (wdcintr(chp) == 0) {
    697   1.1     itohy 			njata32_clearirq(&sc->sc_ch[0].ch_ata_channel, irq);
    698   1.1     itohy 		}
    699   1.1     itohy 	}
    700   1.1     itohy 
    701   1.1     itohy 	if (wdcintr(chp) == 0) {
    702   1.1     itohy 		njata32_clearirq(&sc->sc_ch[0].ch_ata_channel, irq);
    703   1.1     itohy 	}
    704   1.1     itohy 
    705   1.1     itohy 	return 1;
    706   1.1     itohy }
    707