Home | History | Annotate | Line # | Download | only in dev
wdc_obio.c revision 1.5
      1  1.5  tsubai /*	$NetBSD: wdc_obio.c,v 1.5 1999/10/04 22:58:10 tsubai 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.1  tsubai #include <vm/vm.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.1  tsubai #include <dev/ata/atavar.h>
     50  1.1  tsubai #include <dev/ic/wdcvar.h>
     51  1.1  tsubai 
     52  1.1  tsubai #include <macppc/dev/dbdma.h>
     53  1.1  tsubai 
     54  1.1  tsubai #define WDC_REG_NPORTS		8
     55  1.1  tsubai #define WDC_AUXREG_OFFSET	0x16
     56  1.1  tsubai #define WDC_DEFAULT_PIO_IRQ	13	/* XXX */
     57  1.1  tsubai #define WDC_DEFAULT_DMA_IRQ	2	/* XXX */
     58  1.1  tsubai 
     59  1.1  tsubai #define WDC_OPTIONS_DMA 0x01
     60  1.1  tsubai 
     61  1.1  tsubai /*
     62  1.1  tsubai  * XXX This code currently doesn't even try to allow 32-bit data port use.
     63  1.1  tsubai  */
     64  1.1  tsubai 
     65  1.1  tsubai struct wdc_obio_softc {
     66  1.1  tsubai 	struct wdc_softc sc_wdcdev;
     67  1.1  tsubai 	struct channel_softc *wdc_chanptr;
     68  1.1  tsubai 	struct channel_softc wdc_channel;
     69  1.1  tsubai 	dbdma_regmap_t *sc_dmareg;
     70  1.1  tsubai 	dbdma_command_t	*sc_dmacmd;
     71  1.5  tsubai 	void *sc_ih;
     72  1.1  tsubai };
     73  1.1  tsubai 
     74  1.5  tsubai int	wdc_obio_probe __P((struct device *, struct cfdata *, void *));
     75  1.5  tsubai void	wdc_obio_attach __P((struct device *, struct device *, void *));
     76  1.5  tsubai int	wdc_obio_detach __P((struct device *, int));
     77  1.1  tsubai 
     78  1.1  tsubai struct cfattach wdc_obio_ca = {
     79  1.5  tsubai 	sizeof(struct wdc_obio_softc), wdc_obio_probe, wdc_obio_attach,
     80  1.5  tsubai 	wdc_obio_detach, wdcactivate
     81  1.1  tsubai };
     82  1.1  tsubai 
     83  1.1  tsubai static int	wdc_obio_dma_init __P((void *, int, int, void *, size_t, int));
     84  1.1  tsubai static void 	wdc_obio_dma_start __P((void *, int, int, int));
     85  1.1  tsubai static int	wdc_obio_dma_finish __P((void *, int, int, int));
     86  1.1  tsubai 
     87  1.1  tsubai int
     88  1.1  tsubai wdc_obio_probe(parent, match, aux)
     89  1.1  tsubai 	struct device *parent;
     90  1.1  tsubai 	struct cfdata *match;
     91  1.1  tsubai 	void *aux;
     92  1.1  tsubai {
     93  1.1  tsubai 	struct confargs *ca = aux;
     94  1.3  tsubai 	char compat[32];
     95  1.1  tsubai 
     96  1.3  tsubai 	/* XXX should not use name */
     97  1.1  tsubai 	if (strcmp(ca->ca_name, "ATA") == 0 ||
     98  1.1  tsubai 	    strcmp(ca->ca_name, "ata") == 0 ||
     99  1.2  tsubai 	    strcmp(ca->ca_name, "ata0") == 0 ||
    100  1.1  tsubai 	    strcmp(ca->ca_name, "ide") == 0)
    101  1.3  tsubai 		return 1;
    102  1.3  tsubai 
    103  1.3  tsubai 	bzero(compat, sizeof(compat));
    104  1.3  tsubai 	OF_getprop(ca->ca_node, "compatible", compat, sizeof(compat));
    105  1.3  tsubai 	if (strcmp(compat, "heathrow-ata") == 0)
    106  1.1  tsubai 		return 1;
    107  1.1  tsubai 
    108  1.1  tsubai 	return 0;
    109  1.1  tsubai }
    110  1.1  tsubai 
    111  1.1  tsubai void
    112  1.1  tsubai wdc_obio_attach(parent, self, aux)
    113  1.1  tsubai 	struct device *parent, *self;
    114  1.1  tsubai 	void *aux;
    115  1.1  tsubai {
    116  1.1  tsubai 	struct wdc_obio_softc *sc = (void *)self;
    117  1.1  tsubai 	struct confargs *ca = aux;
    118  1.1  tsubai 	struct channel_softc *chp = &sc->wdc_channel;
    119  1.4  tsubai 	int intr;
    120  1.1  tsubai 	int use_dma = 0;
    121  1.1  tsubai 
    122  1.1  tsubai 	if (sc->sc_wdcdev.sc_dev.dv_cfdata->cf_flags & WDC_OPTIONS_DMA) {
    123  1.1  tsubai 		if (ca->ca_nreg >= 16 || ca->ca_nintr == -1)
    124  1.1  tsubai 			use_dma = 1;	/* XXX Don't work yet. */
    125  1.1  tsubai 	}
    126  1.1  tsubai 
    127  1.1  tsubai 	if (ca->ca_nintr >= 4 && ca->ca_nreg >= 8) {
    128  1.4  tsubai 		intr = ca->ca_intr[0];
    129  1.4  tsubai 		printf(" irq %d", intr);
    130  1.4  tsubai 	} else if (ca->ca_nintr == -1) {
    131  1.4  tsubai 		intr = WDC_DEFAULT_PIO_IRQ;
    132  1.4  tsubai 		printf(" irq property not found; using %d", intr);
    133  1.4  tsubai 	} else {
    134  1.1  tsubai 		printf(": couldn't get irq property\n");
    135  1.1  tsubai 		return;
    136  1.1  tsubai 	}
    137  1.1  tsubai 
    138  1.1  tsubai 	if (use_dma)
    139  1.1  tsubai 		printf(": DMA transfer");
    140  1.1  tsubai 
    141  1.1  tsubai 	printf("\n");
    142  1.1  tsubai 
    143  1.1  tsubai 	chp->cmd_iot = chp->ctl_iot =
    144  1.1  tsubai 		macppc_make_bus_space_tag(ca->ca_baseaddr + ca->ca_reg[0], 4);
    145  1.1  tsubai 
    146  1.1  tsubai 	if (bus_space_map(chp->cmd_iot, 0, WDC_REG_NPORTS, 0, &chp->cmd_ioh) ||
    147  1.1  tsubai 	    bus_space_subregion(chp->cmd_iot, chp->cmd_ioh,
    148  1.1  tsubai 			WDC_AUXREG_OFFSET, 1, &chp->ctl_ioh)) {
    149  1.1  tsubai 		printf("%s: couldn't map registers\n",
    150  1.1  tsubai 			sc->sc_wdcdev.sc_dev.dv_xname);
    151  1.1  tsubai 		return;
    152  1.1  tsubai 	}
    153  1.1  tsubai #if 0
    154  1.1  tsubai 	chp->data32iot = chp->cmd_iot;
    155  1.1  tsubai 	chp->data32ioh = chp->cmd_ioh;
    156  1.1  tsubai #endif
    157  1.1  tsubai 
    158  1.5  tsubai 	sc->sc_ih = intr_establish(intr, IST_LEVEL, IPL_BIO, wdcintr, chp);
    159  1.1  tsubai 
    160  1.1  tsubai 	if (use_dma) {
    161  1.1  tsubai 		sc->sc_dmacmd = dbdma_alloc(sizeof(dbdma_command_t) * 20);
    162  1.1  tsubai 		sc->sc_dmareg = mapiodev(ca->ca_baseaddr + ca->ca_reg[2],
    163  1.1  tsubai 					 ca->ca_reg[3]);
    164  1.1  tsubai 		sc->sc_wdcdev.cap |= WDC_CAPABILITY_DMA;
    165  1.1  tsubai 	}
    166  1.1  tsubai 	sc->sc_wdcdev.cap |= WDC_CAPABILITY_DATA16;
    167  1.1  tsubai 	sc->sc_wdcdev.PIO_cap = 0;
    168  1.1  tsubai 	sc->wdc_chanptr = chp;
    169  1.1  tsubai 	sc->sc_wdcdev.channels = &sc->wdc_chanptr;
    170  1.1  tsubai 	sc->sc_wdcdev.nchannels = 1;
    171  1.1  tsubai 	sc->sc_wdcdev.dma_arg = sc;
    172  1.1  tsubai 	sc->sc_wdcdev.dma_init = wdc_obio_dma_init;
    173  1.1  tsubai 	sc->sc_wdcdev.dma_start = wdc_obio_dma_start;
    174  1.1  tsubai 	sc->sc_wdcdev.dma_finish = wdc_obio_dma_finish;
    175  1.1  tsubai 	chp->channel = 0;
    176  1.1  tsubai 	chp->wdc = &sc->sc_wdcdev;
    177  1.1  tsubai 	chp->ch_queue = malloc(sizeof(struct channel_queue),
    178  1.1  tsubai 		M_DEVBUF, M_NOWAIT);
    179  1.1  tsubai 	if (chp->ch_queue == NULL) {
    180  1.1  tsubai 		printf("%s: can't allocate memory for command queue",
    181  1.1  tsubai 		sc->sc_wdcdev.sc_dev.dv_xname);
    182  1.1  tsubai 		return;
    183  1.1  tsubai 	}
    184  1.1  tsubai 
    185  1.1  tsubai 	wdcattach(chp);
    186  1.5  tsubai }
    187  1.5  tsubai 
    188  1.5  tsubai int
    189  1.5  tsubai wdc_obio_detach(self, flags)
    190  1.5  tsubai 	struct device *self;
    191  1.5  tsubai 	int flags;
    192  1.5  tsubai {
    193  1.5  tsubai 	struct wdc_obio_softc *sc = (void *)self;
    194  1.5  tsubai 	struct channel_softc *chp = &sc->wdc_channel;
    195  1.5  tsubai 	int error;
    196  1.5  tsubai 
    197  1.5  tsubai 	if ((error = wdcdetach(self, flags)) != 0)
    198  1.5  tsubai 		return error;
    199  1.5  tsubai 
    200  1.5  tsubai 	intr_disestablish(sc->sc_ih);
    201  1.5  tsubai 
    202  1.5  tsubai 	free(sc->wdc_channel.ch_queue, M_DEVBUF);
    203  1.5  tsubai 
    204  1.5  tsubai 	/* Unmap our i/o space. */
    205  1.5  tsubai 	bus_space_unmap(chp->cmd_iot, chp->cmd_ioh, WDC_REG_NPORTS);
    206  1.5  tsubai 
    207  1.5  tsubai 	/* Unmap DMA registers. */
    208  1.5  tsubai 	/* XXX unmapiodev(sc->sc_dmareg); */
    209  1.5  tsubai 	/* XXX free(sc->sc_dmacmd); */
    210  1.5  tsubai 
    211  1.5  tsubai 	return 0;
    212  1.1  tsubai }
    213  1.1  tsubai 
    214  1.1  tsubai static int
    215  1.1  tsubai wdc_obio_dma_init(v, channel, drive, databuf, datalen, read)
    216  1.1  tsubai 	void *v;
    217  1.1  tsubai 	void *databuf;
    218  1.1  tsubai 	size_t datalen;
    219  1.1  tsubai 	int read;
    220  1.1  tsubai {
    221  1.1  tsubai 	struct wdc_obio_softc *sc = v;
    222  1.1  tsubai 	vaddr_t va = (vaddr_t)databuf;
    223  1.1  tsubai 	dbdma_command_t *cmdp;
    224  1.4  tsubai 	u_int cmd, offset;
    225  1.1  tsubai 
    226  1.1  tsubai 	cmdp = sc->sc_dmacmd;
    227  1.1  tsubai 	cmd = read ? DBDMA_CMD_IN_MORE : DBDMA_CMD_OUT_MORE;
    228  1.4  tsubai 
    229  1.4  tsubai 	offset = va & PGOFSET;
    230  1.4  tsubai 
    231  1.4  tsubai 	/* if va is not page-aligned, setup the first page */
    232  1.4  tsubai 	if (offset != 0) {
    233  1.4  tsubai 		int rest = NBPG - offset;	/* the rest of the page */
    234  1.4  tsubai 
    235  1.4  tsubai 		if (datalen > rest) {		/* if continues to next page */
    236  1.4  tsubai 			DBDMA_BUILD(cmdp, cmd, 0, rest, vtophys(va),
    237  1.4  tsubai 				DBDMA_INT_NEVER, DBDMA_WAIT_NEVER,
    238  1.4  tsubai 				DBDMA_BRANCH_NEVER);
    239  1.4  tsubai 			datalen -= rest;
    240  1.4  tsubai 			va += rest;
    241  1.4  tsubai 			cmdp++;
    242  1.4  tsubai 		}
    243  1.4  tsubai 	}
    244  1.4  tsubai 
    245  1.4  tsubai 	/* now va is page-aligned */
    246  1.1  tsubai 	while (datalen > NBPG) {
    247  1.1  tsubai 		DBDMA_BUILD(cmdp, cmd, 0, NBPG, vtophys(va),
    248  1.1  tsubai 			DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
    249  1.1  tsubai 		datalen -= NBPG;
    250  1.1  tsubai 		va += NBPG;
    251  1.1  tsubai 		cmdp++;
    252  1.1  tsubai 	}
    253  1.1  tsubai 
    254  1.1  tsubai 	/* the last page (datalen <= NBPG here) */
    255  1.1  tsubai 	cmd = read ? DBDMA_CMD_IN_LAST : DBDMA_CMD_OUT_LAST;
    256  1.1  tsubai 	DBDMA_BUILD(cmdp, cmd, 0, datalen, vtophys(va),
    257  1.4  tsubai 		DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
    258  1.1  tsubai 	cmdp++;
    259  1.1  tsubai 
    260  1.1  tsubai 	DBDMA_BUILD(cmdp, DBDMA_CMD_STOP, 0, 0, 0,
    261  1.1  tsubai 		DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
    262  1.1  tsubai 
    263  1.1  tsubai 	return 0;
    264  1.1  tsubai }
    265  1.1  tsubai 
    266  1.1  tsubai static void
    267  1.1  tsubai wdc_obio_dma_start(v, channel, drive, read)
    268  1.1  tsubai 	void *v;
    269  1.1  tsubai 	int channel, drive;
    270  1.1  tsubai {
    271  1.1  tsubai 	struct wdc_obio_softc *sc = v;
    272  1.1  tsubai 
    273  1.1  tsubai 	dbdma_start(sc->sc_dmareg, sc->sc_dmacmd);
    274  1.1  tsubai }
    275  1.1  tsubai 
    276  1.1  tsubai static int
    277  1.1  tsubai wdc_obio_dma_finish(v, channel, drive, read)
    278  1.1  tsubai 	void *v;
    279  1.1  tsubai 	int channel, drive;
    280  1.1  tsubai 	int read;
    281  1.1  tsubai {
    282  1.4  tsubai 	struct wdc_obio_softc *sc = v;
    283  1.4  tsubai 
    284  1.4  tsubai 	dbdma_stop(sc->sc_dmareg);
    285  1.1  tsubai 	return 0;
    286  1.1  tsubai }
    287