Home | History | Annotate | Line # | Download | only in dev
wdc_obio.c revision 1.17
      1  1.17    bouyer /*	$NetBSD: wdc_obio.c,v 1.17 2001/09/09 16:08:49 bouyer Exp $	*/
      2   1.1    tsubai 
      3   1.1    tsubai /*-
      4   1.1    tsubai  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      5   1.1    tsubai  * All rights reserved.
      6   1.1    tsubai  *
      7   1.1    tsubai  * This code is derived from software contributed to The NetBSD Foundation
      8   1.1    tsubai  * by Charles M. Hannum and by Onno van der Linden.
      9   1.1    tsubai  *
     10   1.1    tsubai  * Redistribution and use in source and binary forms, with or without
     11   1.1    tsubai  * modification, are permitted provided that the following conditions
     12   1.1    tsubai  * are met:
     13   1.1    tsubai  * 1. Redistributions of source code must retain the above copyright
     14   1.1    tsubai  *    notice, this list of conditions and the following disclaimer.
     15   1.1    tsubai  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1    tsubai  *    notice, this list of conditions and the following disclaimer in the
     17   1.1    tsubai  *    documentation and/or other materials provided with the distribution.
     18   1.1    tsubai  * 3. All advertising materials mentioning features or use of this software
     19   1.1    tsubai  *    must display the following acknowledgement:
     20   1.1    tsubai  *        This product includes software developed by the NetBSD
     21   1.1    tsubai  *        Foundation, Inc. and its contributors.
     22   1.1    tsubai  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23   1.1    tsubai  *    contributors may be used to endorse or promote products derived
     24   1.1    tsubai  *    from this software without specific prior written permission.
     25   1.1    tsubai  *
     26   1.1    tsubai  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27   1.1    tsubai  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28   1.1    tsubai  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29   1.1    tsubai  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30   1.1    tsubai  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31   1.1    tsubai  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32   1.1    tsubai  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33   1.1    tsubai  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34   1.1    tsubai  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35   1.1    tsubai  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36   1.1    tsubai  * POSSIBILITY OF SUCH DAMAGE.
     37   1.1    tsubai  */
     38   1.1    tsubai 
     39   1.1    tsubai #include <sys/param.h>
     40   1.1    tsubai #include <sys/systm.h>
     41   1.1    tsubai #include <sys/device.h>
     42   1.1    tsubai #include <sys/malloc.h>
     43   1.1    tsubai 
     44  1.10       mrg #include <uvm/uvm_extern.h>
     45   1.1    tsubai 
     46   1.1    tsubai #include <machine/bus.h>
     47   1.1    tsubai #include <machine/autoconf.h>
     48   1.1    tsubai 
     49   1.9    tsubai #include <dev/ata/atareg.h>
     50   1.1    tsubai #include <dev/ata/atavar.h>
     51   1.1    tsubai #include <dev/ic/wdcvar.h>
     52   1.1    tsubai 
     53  1.12      matt #include <dev/ofw/openfirm.h>
     54  1.12      matt 
     55   1.1    tsubai #include <macppc/dev/dbdma.h>
     56   1.1    tsubai 
     57   1.1    tsubai #define WDC_REG_NPORTS		8
     58   1.1    tsubai #define WDC_AUXREG_OFFSET	0x16
     59   1.1    tsubai #define WDC_DEFAULT_PIO_IRQ	13	/* XXX */
     60   1.1    tsubai #define WDC_DEFAULT_DMA_IRQ	2	/* XXX */
     61   1.1    tsubai 
     62   1.1    tsubai #define WDC_OPTIONS_DMA 0x01
     63   1.1    tsubai 
     64   1.1    tsubai /*
     65   1.1    tsubai  * XXX This code currently doesn't even try to allow 32-bit data port use.
     66   1.1    tsubai  */
     67   1.1    tsubai 
     68   1.1    tsubai struct wdc_obio_softc {
     69   1.1    tsubai 	struct wdc_softc sc_wdcdev;
     70   1.1    tsubai 	struct channel_softc *wdc_chanptr;
     71   1.1    tsubai 	struct channel_softc wdc_channel;
     72   1.1    tsubai 	dbdma_regmap_t *sc_dmareg;
     73   1.1    tsubai 	dbdma_command_t	*sc_dmacmd;
     74   1.5    tsubai 	void *sc_ih;
     75   1.1    tsubai };
     76   1.1    tsubai 
     77   1.9    tsubai int wdc_obio_probe __P((struct device *, struct cfdata *, void *));
     78   1.9    tsubai void wdc_obio_attach __P((struct device *, struct device *, void *));
     79   1.9    tsubai int wdc_obio_detach __P((struct device *, int));
     80   1.9    tsubai int wdc_obio_dma_init __P((void *, int, int, void *, size_t, int));
     81   1.9    tsubai void wdc_obio_dma_start __P((void *, int, int));
     82   1.9    tsubai int wdc_obio_dma_finish __P((void *, int, int, int));
     83   1.9    tsubai static void adjust_timing __P((struct channel_softc *));
     84  1.16    bouyer static void ata4_adjust_timing __P((struct channel_softc *));
     85   1.1    tsubai 
     86   1.1    tsubai struct cfattach wdc_obio_ca = {
     87   1.5    tsubai 	sizeof(struct wdc_obio_softc), wdc_obio_probe, wdc_obio_attach,
     88   1.5    tsubai 	wdc_obio_detach, wdcactivate
     89   1.1    tsubai };
     90   1.1    tsubai 
     91   1.1    tsubai 
     92   1.1    tsubai int
     93   1.1    tsubai wdc_obio_probe(parent, match, aux)
     94   1.1    tsubai 	struct device *parent;
     95   1.1    tsubai 	struct cfdata *match;
     96   1.1    tsubai 	void *aux;
     97   1.1    tsubai {
     98   1.1    tsubai 	struct confargs *ca = aux;
     99   1.3    tsubai 	char compat[32];
    100   1.1    tsubai 
    101   1.3    tsubai 	/* XXX should not use name */
    102   1.1    tsubai 	if (strcmp(ca->ca_name, "ATA") == 0 ||
    103   1.1    tsubai 	    strcmp(ca->ca_name, "ata") == 0 ||
    104   1.2    tsubai 	    strcmp(ca->ca_name, "ata0") == 0 ||
    105   1.1    tsubai 	    strcmp(ca->ca_name, "ide") == 0)
    106   1.3    tsubai 		return 1;
    107   1.3    tsubai 
    108  1.14       wiz 	memset(compat, 0, sizeof(compat));
    109   1.3    tsubai 	OF_getprop(ca->ca_node, "compatible", compat, sizeof(compat));
    110   1.6    tsubai 	if (strcmp(compat, "heathrow-ata") == 0 ||
    111   1.6    tsubai 	    strcmp(compat, "keylargo-ata") == 0)
    112   1.1    tsubai 		return 1;
    113   1.1    tsubai 
    114   1.1    tsubai 	return 0;
    115   1.1    tsubai }
    116   1.1    tsubai 
    117   1.1    tsubai void
    118   1.1    tsubai wdc_obio_attach(parent, self, aux)
    119   1.1    tsubai 	struct device *parent, *self;
    120   1.1    tsubai 	void *aux;
    121   1.1    tsubai {
    122   1.1    tsubai 	struct wdc_obio_softc *sc = (void *)self;
    123   1.1    tsubai 	struct confargs *ca = aux;
    124   1.1    tsubai 	struct channel_softc *chp = &sc->wdc_channel;
    125   1.4    tsubai 	int intr;
    126   1.1    tsubai 	int use_dma = 0;
    127   1.7    tsubai 	char path[80];
    128   1.1    tsubai 
    129   1.1    tsubai 	if (sc->sc_wdcdev.sc_dev.dv_cfdata->cf_flags & WDC_OPTIONS_DMA) {
    130   1.1    tsubai 		if (ca->ca_nreg >= 16 || ca->ca_nintr == -1)
    131   1.1    tsubai 			use_dma = 1;	/* XXX Don't work yet. */
    132   1.1    tsubai 	}
    133   1.1    tsubai 
    134   1.1    tsubai 	if (ca->ca_nintr >= 4 && ca->ca_nreg >= 8) {
    135   1.4    tsubai 		intr = ca->ca_intr[0];
    136   1.4    tsubai 		printf(" irq %d", intr);
    137   1.4    tsubai 	} else if (ca->ca_nintr == -1) {
    138   1.4    tsubai 		intr = WDC_DEFAULT_PIO_IRQ;
    139   1.4    tsubai 		printf(" irq property not found; using %d", intr);
    140   1.4    tsubai 	} else {
    141   1.1    tsubai 		printf(": couldn't get irq property\n");
    142   1.1    tsubai 		return;
    143   1.1    tsubai 	}
    144   1.1    tsubai 
    145   1.1    tsubai 	if (use_dma)
    146   1.1    tsubai 		printf(": DMA transfer");
    147   1.1    tsubai 
    148   1.1    tsubai 	printf("\n");
    149   1.1    tsubai 
    150   1.1    tsubai 	chp->cmd_iot = chp->ctl_iot =
    151   1.1    tsubai 		macppc_make_bus_space_tag(ca->ca_baseaddr + ca->ca_reg[0], 4);
    152   1.1    tsubai 
    153   1.1    tsubai 	if (bus_space_map(chp->cmd_iot, 0, WDC_REG_NPORTS, 0, &chp->cmd_ioh) ||
    154   1.1    tsubai 	    bus_space_subregion(chp->cmd_iot, chp->cmd_ioh,
    155   1.1    tsubai 			WDC_AUXREG_OFFSET, 1, &chp->ctl_ioh)) {
    156   1.1    tsubai 		printf("%s: couldn't map registers\n",
    157   1.1    tsubai 			sc->sc_wdcdev.sc_dev.dv_xname);
    158   1.1    tsubai 		return;
    159   1.1    tsubai 	}
    160   1.1    tsubai #if 0
    161   1.1    tsubai 	chp->data32iot = chp->cmd_iot;
    162   1.1    tsubai 	chp->data32ioh = chp->cmd_ioh;
    163   1.1    tsubai #endif
    164   1.1    tsubai 
    165   1.5    tsubai 	sc->sc_ih = intr_establish(intr, IST_LEVEL, IPL_BIO, wdcintr, chp);
    166   1.1    tsubai 
    167   1.1    tsubai 	if (use_dma) {
    168   1.1    tsubai 		sc->sc_dmacmd = dbdma_alloc(sizeof(dbdma_command_t) * 20);
    169   1.1    tsubai 		sc->sc_dmareg = mapiodev(ca->ca_baseaddr + ca->ca_reg[2],
    170   1.1    tsubai 					 ca->ca_reg[3]);
    171   1.1    tsubai 		sc->sc_wdcdev.cap |= WDC_CAPABILITY_DMA;
    172  1.13    bouyer 		sc->sc_wdcdev.DMA_cap = 2;
    173  1.16    bouyer 		if (strcmp(ca->ca_name, "ata-4") == 0) {
    174  1.16    bouyer 			sc->sc_wdcdev.cap |= WDC_CAPABILITY_UDMA;
    175  1.16    bouyer 			sc->sc_wdcdev.UDMA_cap = 4;
    176  1.16    bouyer 			sc->sc_wdcdev.set_modes = ata4_adjust_timing;
    177  1.16    bouyer 		} else {
    178  1.16    bouyer 			sc->sc_wdcdev.set_modes = adjust_timing;
    179  1.16    bouyer 		}
    180  1.13    bouyer #ifdef notyet
    181  1.13    bouyer 		/* Minimum cycle time is 150ns (DMA MODE 1) on ohare. */
    182  1.13    bouyer 		if (ohare) {
    183  1.13    bouyer 			sc->sc_wdcdev.PIO_cap = 3;
    184  1.13    bouyer 			sc->sc_wdcdev.DMA_cap = 1;
    185  1.13    bouyer 		}
    186  1.13    bouyer #endif
    187  1.17    bouyer 	} else {
    188  1.17    bouyer 		/* all non-dma controllers can use adjust_timing */
    189  1.17    bouyer 		sc->sc_wdcdev.set_modes = adjust_timing;
    190   1.1    tsubai 	}
    191  1.17    bouyer 
    192  1.13    bouyer 	sc->sc_wdcdev.PIO_cap = 4;
    193  1.13    bouyer 	sc->sc_wdcdev.cap |= WDC_CAPABILITY_DATA16 | WDC_CAPABILITY_MODE;
    194   1.1    tsubai 	sc->wdc_chanptr = chp;
    195   1.1    tsubai 	sc->sc_wdcdev.channels = &sc->wdc_chanptr;
    196   1.1    tsubai 	sc->sc_wdcdev.nchannels = 1;
    197   1.1    tsubai 	sc->sc_wdcdev.dma_arg = sc;
    198   1.1    tsubai 	sc->sc_wdcdev.dma_init = wdc_obio_dma_init;
    199   1.1    tsubai 	sc->sc_wdcdev.dma_start = wdc_obio_dma_start;
    200   1.1    tsubai 	sc->sc_wdcdev.dma_finish = wdc_obio_dma_finish;
    201   1.1    tsubai 	chp->channel = 0;
    202   1.1    tsubai 	chp->wdc = &sc->sc_wdcdev;
    203   1.1    tsubai 	chp->ch_queue = malloc(sizeof(struct channel_queue),
    204   1.1    tsubai 		M_DEVBUF, M_NOWAIT);
    205   1.1    tsubai 	if (chp->ch_queue == NULL) {
    206   1.1    tsubai 		printf("%s: can't allocate memory for command queue",
    207   1.1    tsubai 		sc->sc_wdcdev.sc_dev.dv_xname);
    208   1.1    tsubai 		return;
    209   1.7    tsubai 	}
    210   1.7    tsubai 
    211   1.7    tsubai #define OHARE_FEATURE_REG	0xf3000038
    212   1.7    tsubai 
    213   1.7    tsubai 	/* XXX Enable wdc1 by feature reg. */
    214  1.14       wiz 	memset(path, 0, sizeof(path));
    215   1.7    tsubai 	OF_package_to_path(ca->ca_node, path, sizeof(path));
    216   1.7    tsubai 	if (strcmp(path, "/bandit@F2000000/ohare@10/ata@21000") == 0) {
    217   1.7    tsubai 		u_int x;
    218   1.7    tsubai 
    219   1.7    tsubai 		x = in32rb(OHARE_FEATURE_REG);
    220   1.7    tsubai 		x |= 8;
    221   1.7    tsubai 		out32rb(OHARE_FEATURE_REG, x);
    222   1.1    tsubai 	}
    223   1.1    tsubai 
    224   1.1    tsubai 	wdcattach(chp);
    225  1.16    bouyer 	sc->sc_wdcdev.set_modes(chp);
    226  1.11  wrstuden 
    227   1.9    tsubai }
    228   1.9    tsubai 
    229   1.9    tsubai /* Multiword DMA transfer timings */
    230  1.13    bouyer struct ide_timings {
    231   1.9    tsubai 	int cycle;	/* minimum cycle time [ns] */
    232   1.9    tsubai 	int active;	/* minimum command active time [ns] */
    233  1.13    bouyer };
    234  1.13    bouyer static struct ide_timings pio_timing[5] = {
    235  1.13    bouyer 	{ 600, 165 },    /* Mode 0 */
    236  1.13    bouyer 	{ 383, 125 },    /*      1 */
    237  1.13    bouyer 	{ 240, 100 },    /*      2 */
    238  1.13    bouyer 	{ 180,  80 },    /*      3 */
    239  1.13    bouyer 	{ 120,  70 }     /*      4 */
    240  1.13    bouyer };
    241  1.13    bouyer static struct ide_timings dma_timing[3] = {
    242  1.12      matt 	{ 480, 215 },	/* Mode 0 */
    243  1.12      matt 	{ 150,  80 },	/* Mode 1 */
    244  1.12      matt 	{ 120,  70 },	/* Mode 2 */
    245   1.9    tsubai };
    246   1.9    tsubai 
    247  1.16    bouyer static struct ide_timings udma_timing[5] = {
    248  1.16    bouyer 	{114,   0},	/* Mode 0 */
    249  1.16    bouyer 	{ 75,   0},	/* Mode 1 */
    250  1.16    bouyer 	{ 55,   0},	/* Mode 2 */
    251  1.16    bouyer 	{ 45, 100},	/* Mode 3 */
    252  1.16    bouyer 	{ 25, 100}	/* Mode 4 */
    253  1.16    bouyer };
    254  1.16    bouyer 
    255   1.9    tsubai #define TIME_TO_TICK(time) howmany((time), 30)
    256  1.16    bouyer #define PIO_REC_OFFSET 4
    257  1.16    bouyer #define PIO_REC_MIN 1
    258  1.16    bouyer #define PIO_ACT_MIN 1
    259  1.16    bouyer #define DMA_REC_OFFSET 1
    260  1.16    bouyer #define DMA_REC_MIN 1
    261  1.16    bouyer #define DMA_ACT_MIN 1
    262  1.16    bouyer 
    263  1.16    bouyer #define ATA4_TIME_TO_TICK(time)  howmany((time) * 1000, 7500)
    264  1.16    bouyer 
    265   1.9    tsubai 
    266   1.9    tsubai #define CONFIG_REG (0x200 >> 4)		/* IDE access timing register */
    267   1.9    tsubai 
    268   1.9    tsubai void
    269   1.9    tsubai adjust_timing(chp)
    270   1.9    tsubai 	struct channel_softc *chp;
    271   1.9    tsubai {
    272  1.13    bouyer 	struct ata_drive_datas *drvp;
    273   1.9    tsubai 	u_int conf;
    274  1.13    bouyer 	int drive;
    275  1.13    bouyer 	int piomode = -1, dmamode = -1;
    276  1.13    bouyer 	int min_cycle, min_active;
    277   1.9    tsubai 	int cycle_tick, act_tick, inact_tick, half_tick;
    278   1.9    tsubai 
    279   1.9    tsubai 
    280  1.13    bouyer 	for (drive = 0; drive < 2; drive++) {
    281  1.13    bouyer 		drvp = &chp->ch_drive[drive];
    282  1.13    bouyer 		if ((drvp->drive_flags & DRIVE) == 0)
    283  1.13    bouyer 			continue;
    284  1.13    bouyer 		if (piomode == -1 || piomode > drvp->PIO_mode)
    285  1.13    bouyer 			piomode = drvp->PIO_mode;
    286  1.13    bouyer 		if (drvp->drive_flags & DRIVE_DMA) {
    287  1.13    bouyer 			if (dmamode == -1 || dmamode > drvp->DMA_mode)
    288  1.13    bouyer 				dmamode = drvp->DMA_mode;
    289  1.13    bouyer 		}
    290  1.13    bouyer 	}
    291  1.15    bouyer 	if (piomode == -1)
    292  1.15    bouyer 		return; /* No drive */
    293  1.13    bouyer 	for (drive = 0; drive < 2; drive++) {
    294  1.13    bouyer 		drvp = &chp->ch_drive[drive];
    295  1.13    bouyer 		if (drvp->drive_flags & DRIVE) {
    296  1.13    bouyer 			drvp->PIO_mode = piomode;
    297  1.13    bouyer 			if (drvp->drive_flags & DRIVE_DMA)
    298  1.13    bouyer 				drvp->DMA_mode = dmamode;
    299  1.13    bouyer 		}
    300  1.13    bouyer 	}
    301  1.13    bouyer 	min_cycle = pio_timing[piomode].cycle;
    302  1.13    bouyer 	min_active = pio_timing[piomode].active;
    303   1.9    tsubai 
    304  1.13    bouyer 	cycle_tick = TIME_TO_TICK(min_cycle);
    305  1.13    bouyer 	act_tick = TIME_TO_TICK(min_active);
    306  1.16    bouyer 	if (act_tick < PIO_ACT_MIN)
    307  1.16    bouyer 		act_tick = PIO_ACT_MIN;
    308  1.16    bouyer 	inact_tick = cycle_tick - act_tick - PIO_REC_OFFSET;
    309  1.16    bouyer 	if (inact_tick < PIO_REC_MIN)
    310  1.16    bouyer 		inact_tick = PIO_REC_MIN;
    311  1.16    bouyer 	/* mask: 0x000007ff */
    312  1.13    bouyer 	conf = (inact_tick << 5) | act_tick;
    313  1.13    bouyer 	if (dmamode != -1) {
    314  1.13    bouyer 		/* there are active  DMA mode */
    315  1.13    bouyer 
    316  1.13    bouyer 		min_cycle = dma_timing[dmamode].cycle;
    317  1.13    bouyer 		min_active = dma_timing[dmamode].active;
    318  1.13    bouyer 		cycle_tick = TIME_TO_TICK(min_cycle);
    319  1.13    bouyer 		act_tick = TIME_TO_TICK(min_active);
    320  1.16    bouyer 		inact_tick = cycle_tick - act_tick - DMA_REC_OFFSET;
    321  1.16    bouyer 		if (inact_tick < DMA_REC_MIN)
    322  1.16    bouyer 			inact_tick = DMA_REC_MIN;
    323  1.13    bouyer 		half_tick = 0;	/* XXX */
    324  1.16    bouyer 		/* mask: 0xfffff800 */
    325  1.13    bouyer 		conf |=
    326  1.16    bouyer 		    (half_tick << 21) |
    327  1.16    bouyer 		    (inact_tick << 16) | (act_tick << 11);
    328  1.13    bouyer 	}
    329   1.9    tsubai 	bus_space_write_4(chp->cmd_iot, chp->cmd_ioh, CONFIG_REG, conf);
    330   1.9    tsubai 	printf("conf = 0x%x, cyc = %d (%d ns), act = %d (%d ns), inact = %d\n",
    331  1.13    bouyer 	    conf, cycle_tick, min_cycle, act_tick, min_active, inact_tick);
    332  1.16    bouyer 	wdc_print_modes(chp);
    333  1.16    bouyer }
    334  1.16    bouyer 
    335  1.16    bouyer void
    336  1.16    bouyer ata4_adjust_timing(chp)
    337  1.16    bouyer 	struct channel_softc *chp;
    338  1.16    bouyer {
    339  1.16    bouyer 	struct ata_drive_datas *drvp;
    340  1.16    bouyer 	u_int conf;
    341  1.16    bouyer 	int drive;
    342  1.16    bouyer 	int piomode = -1, dmamode = -1;
    343  1.16    bouyer 	int min_cycle, min_active;
    344  1.16    bouyer 	int cycle_tick, act_tick, inact_tick;
    345  1.16    bouyer 	int udmamode = -1;
    346  1.16    bouyer 
    347  1.16    bouyer 
    348  1.16    bouyer 	for (drive = 0; drive < 2; drive++) {
    349  1.16    bouyer 		drvp = &chp->ch_drive[drive];
    350  1.16    bouyer 		if ((drvp->drive_flags & DRIVE) == 0)
    351  1.16    bouyer 			continue;
    352  1.16    bouyer 		if (piomode == -1 || piomode > drvp->PIO_mode)
    353  1.16    bouyer 			piomode = drvp->PIO_mode;
    354  1.16    bouyer 		if (drvp->drive_flags & DRIVE_DMA) {
    355  1.16    bouyer 			if (dmamode == -1 || dmamode > drvp->DMA_mode)
    356  1.16    bouyer 				dmamode = drvp->DMA_mode;
    357  1.16    bouyer 		}
    358  1.16    bouyer 		if (drvp->drive_flags & DRIVE_UDMA) {
    359  1.16    bouyer 			if (udmamode == -1 || udmamode > drvp->UDMA_mode)
    360  1.16    bouyer 				udmamode = drvp->UDMA_mode;
    361  1.16    bouyer 		}
    362  1.16    bouyer 	}
    363  1.16    bouyer 	if (piomode == -1)
    364  1.16    bouyer 		return; /* No drive */
    365  1.16    bouyer 	for (drive = 0; drive < 2; drive++) {
    366  1.16    bouyer 		drvp = &chp->ch_drive[drive];
    367  1.16    bouyer 		if (drvp->drive_flags & DRIVE) {
    368  1.16    bouyer 			drvp->PIO_mode = piomode;
    369  1.16    bouyer 			if (drvp->drive_flags & DRIVE_DMA)
    370  1.16    bouyer 				drvp->DMA_mode = dmamode;
    371  1.16    bouyer 			if (drvp->drive_flags & DRIVE_UDMA)
    372  1.16    bouyer 				drvp->UDMA_mode = udmamode;
    373  1.16    bouyer 		}
    374  1.16    bouyer 	}
    375  1.16    bouyer 	min_cycle = pio_timing[piomode].cycle;
    376  1.16    bouyer 	min_active = pio_timing[piomode].active;
    377  1.16    bouyer 
    378  1.16    bouyer 	cycle_tick = ATA4_TIME_TO_TICK(min_cycle);
    379  1.16    bouyer 	act_tick = ATA4_TIME_TO_TICK(min_active);
    380  1.16    bouyer 	inact_tick = cycle_tick - act_tick;
    381  1.16    bouyer 	/* mask: 0x000003ff */
    382  1.16    bouyer 	conf = (inact_tick << 5) | act_tick;
    383  1.16    bouyer 	if (dmamode != -1) {
    384  1.16    bouyer 		/* there are active  DMA mode */
    385  1.16    bouyer 
    386  1.16    bouyer 		min_cycle = dma_timing[dmamode].cycle;
    387  1.16    bouyer 		min_active = dma_timing[dmamode].active;
    388  1.16    bouyer 		cycle_tick = ATA4_TIME_TO_TICK(min_cycle);
    389  1.16    bouyer 		act_tick = ATA4_TIME_TO_TICK(min_active);
    390  1.16    bouyer 		inact_tick = cycle_tick - act_tick;
    391  1.16    bouyer 		/* mask: 0x001ffc00 */
    392  1.16    bouyer 		conf |= (act_tick << 10) | (inact_tick << 15);
    393  1.16    bouyer 	}
    394  1.16    bouyer 	if (udmamode != -1) {
    395  1.16    bouyer 		min_cycle = udma_timing[udmamode].cycle;
    396  1.16    bouyer 		min_active = udma_timing[udmamode].active;
    397  1.16    bouyer 		act_tick = ATA4_TIME_TO_TICK(min_active);
    398  1.16    bouyer 		cycle_tick = ATA4_TIME_TO_TICK(min_cycle);
    399  1.16    bouyer 		/* mask: 0x1ff00000 */
    400  1.16    bouyer 		conf |= (cycle_tick << 21) | (act_tick << 25) | 0x100000;
    401  1.16    bouyer 	}
    402  1.16    bouyer 
    403  1.16    bouyer 	bus_space_write_4(chp->cmd_iot, chp->cmd_ioh, CONFIG_REG, conf);
    404  1.16    bouyer 	printf("ata4 conf = 0x%x, cyc = %d (%d ns), act = %d (%d ns), inact = %d\n",
    405  1.16    bouyer 	    conf, cycle_tick, min_cycle, act_tick, min_active, inact_tick);
    406  1.13    bouyer 	wdc_print_modes(chp);
    407   1.5    tsubai }
    408   1.5    tsubai 
    409   1.5    tsubai int
    410   1.5    tsubai wdc_obio_detach(self, flags)
    411   1.5    tsubai 	struct device *self;
    412   1.5    tsubai 	int flags;
    413   1.5    tsubai {
    414   1.5    tsubai 	struct wdc_obio_softc *sc = (void *)self;
    415   1.5    tsubai 	int error;
    416   1.5    tsubai 
    417   1.5    tsubai 	if ((error = wdcdetach(self, flags)) != 0)
    418   1.5    tsubai 		return error;
    419   1.5    tsubai 
    420   1.5    tsubai 	intr_disestablish(sc->sc_ih);
    421   1.5    tsubai 
    422   1.5    tsubai 	free(sc->wdc_channel.ch_queue, M_DEVBUF);
    423   1.5    tsubai 
    424   1.5    tsubai 	/* Unmap our i/o space. */
    425   1.5    tsubai 	bus_space_unmap(chp->cmd_iot, chp->cmd_ioh, WDC_REG_NPORTS);
    426   1.5    tsubai 
    427   1.5    tsubai 	/* Unmap DMA registers. */
    428   1.5    tsubai 	/* XXX unmapiodev(sc->sc_dmareg); */
    429   1.5    tsubai 	/* XXX free(sc->sc_dmacmd); */
    430   1.5    tsubai 
    431   1.5    tsubai 	return 0;
    432   1.1    tsubai }
    433   1.1    tsubai 
    434   1.9    tsubai int
    435   1.1    tsubai wdc_obio_dma_init(v, channel, drive, databuf, datalen, read)
    436   1.1    tsubai 	void *v;
    437   1.1    tsubai 	void *databuf;
    438   1.1    tsubai 	size_t datalen;
    439   1.1    tsubai 	int read;
    440   1.1    tsubai {
    441   1.1    tsubai 	struct wdc_obio_softc *sc = v;
    442   1.1    tsubai 	vaddr_t va = (vaddr_t)databuf;
    443   1.1    tsubai 	dbdma_command_t *cmdp;
    444   1.4    tsubai 	u_int cmd, offset;
    445   1.1    tsubai 
    446   1.1    tsubai 	cmdp = sc->sc_dmacmd;
    447   1.1    tsubai 	cmd = read ? DBDMA_CMD_IN_MORE : DBDMA_CMD_OUT_MORE;
    448   1.4    tsubai 
    449   1.4    tsubai 	offset = va & PGOFSET;
    450   1.4    tsubai 
    451   1.4    tsubai 	/* if va is not page-aligned, setup the first page */
    452   1.4    tsubai 	if (offset != 0) {
    453   1.4    tsubai 		int rest = NBPG - offset;	/* the rest of the page */
    454   1.4    tsubai 
    455   1.4    tsubai 		if (datalen > rest) {		/* if continues to next page */
    456   1.4    tsubai 			DBDMA_BUILD(cmdp, cmd, 0, rest, vtophys(va),
    457   1.4    tsubai 				DBDMA_INT_NEVER, DBDMA_WAIT_NEVER,
    458   1.4    tsubai 				DBDMA_BRANCH_NEVER);
    459   1.4    tsubai 			datalen -= rest;
    460   1.4    tsubai 			va += rest;
    461   1.4    tsubai 			cmdp++;
    462   1.4    tsubai 		}
    463   1.4    tsubai 	}
    464   1.4    tsubai 
    465   1.4    tsubai 	/* now va is page-aligned */
    466   1.1    tsubai 	while (datalen > NBPG) {
    467   1.1    tsubai 		DBDMA_BUILD(cmdp, cmd, 0, NBPG, vtophys(va),
    468   1.1    tsubai 			DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
    469   1.1    tsubai 		datalen -= NBPG;
    470   1.1    tsubai 		va += NBPG;
    471   1.1    tsubai 		cmdp++;
    472   1.1    tsubai 	}
    473   1.1    tsubai 
    474   1.1    tsubai 	/* the last page (datalen <= NBPG here) */
    475   1.1    tsubai 	cmd = read ? DBDMA_CMD_IN_LAST : DBDMA_CMD_OUT_LAST;
    476   1.1    tsubai 	DBDMA_BUILD(cmdp, cmd, 0, datalen, vtophys(va),
    477   1.4    tsubai 		DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
    478   1.1    tsubai 	cmdp++;
    479   1.1    tsubai 
    480   1.1    tsubai 	DBDMA_BUILD(cmdp, DBDMA_CMD_STOP, 0, 0, 0,
    481   1.1    tsubai 		DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
    482   1.1    tsubai 
    483   1.1    tsubai 	return 0;
    484   1.1    tsubai }
    485   1.1    tsubai 
    486   1.9    tsubai void
    487   1.8    tsubai wdc_obio_dma_start(v, channel, drive)
    488   1.1    tsubai 	void *v;
    489   1.1    tsubai 	int channel, drive;
    490   1.1    tsubai {
    491   1.1    tsubai 	struct wdc_obio_softc *sc = v;
    492   1.1    tsubai 
    493   1.1    tsubai 	dbdma_start(sc->sc_dmareg, sc->sc_dmacmd);
    494   1.1    tsubai }
    495   1.1    tsubai 
    496   1.9    tsubai int
    497   1.1    tsubai wdc_obio_dma_finish(v, channel, drive, read)
    498   1.1    tsubai 	void *v;
    499   1.1    tsubai 	int channel, drive;
    500   1.1    tsubai 	int read;
    501   1.1    tsubai {
    502   1.4    tsubai 	struct wdc_obio_softc *sc = v;
    503   1.4    tsubai 
    504   1.4    tsubai 	dbdma_stop(sc->sc_dmareg);
    505   1.1    tsubai 	return 0;
    506   1.1    tsubai }
    507