wdc_obio.c revision 1.6
1 /* $NetBSD: wdc_obio.c,v 1.6 2000/01/21 18:45:14 tsubai Exp $ */ 2 3 /*- 4 * Copyright (c) 1998 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Charles M. Hannum and by Onno van der Linden. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 3. All advertising materials mentioning features or use of this software 19 * must display the following acknowledgement: 20 * This product includes software developed by the NetBSD 21 * Foundation, Inc. and its contributors. 22 * 4. Neither the name of The NetBSD Foundation nor the names of its 23 * contributors may be used to endorse or promote products derived 24 * from this software without specific prior written permission. 25 * 26 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 27 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 28 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 29 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 30 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 31 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 32 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 33 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 34 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 35 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 36 * POSSIBILITY OF SUCH DAMAGE. 37 */ 38 39 #include <sys/param.h> 40 #include <sys/systm.h> 41 #include <sys/device.h> 42 #include <sys/malloc.h> 43 44 #include <vm/vm.h> 45 46 #include <machine/bus.h> 47 #include <machine/autoconf.h> 48 49 #include <dev/ata/atavar.h> 50 #include <dev/ic/wdcvar.h> 51 52 #include <macppc/dev/dbdma.h> 53 54 #define WDC_REG_NPORTS 8 55 #define WDC_AUXREG_OFFSET 0x16 56 #define WDC_DEFAULT_PIO_IRQ 13 /* XXX */ 57 #define WDC_DEFAULT_DMA_IRQ 2 /* XXX */ 58 59 #define WDC_OPTIONS_DMA 0x01 60 61 /* 62 * XXX This code currently doesn't even try to allow 32-bit data port use. 63 */ 64 65 struct wdc_obio_softc { 66 struct wdc_softc sc_wdcdev; 67 struct channel_softc *wdc_chanptr; 68 struct channel_softc wdc_channel; 69 dbdma_regmap_t *sc_dmareg; 70 dbdma_command_t *sc_dmacmd; 71 void *sc_ih; 72 }; 73 74 int wdc_obio_probe __P((struct device *, struct cfdata *, void *)); 75 void wdc_obio_attach __P((struct device *, struct device *, void *)); 76 int wdc_obio_detach __P((struct device *, int)); 77 78 struct cfattach wdc_obio_ca = { 79 sizeof(struct wdc_obio_softc), wdc_obio_probe, wdc_obio_attach, 80 wdc_obio_detach, wdcactivate 81 }; 82 83 static int wdc_obio_dma_init __P((void *, int, int, void *, size_t, int)); 84 static void wdc_obio_dma_start __P((void *, int, int, int)); 85 static int wdc_obio_dma_finish __P((void *, int, int, int)); 86 87 int 88 wdc_obio_probe(parent, match, aux) 89 struct device *parent; 90 struct cfdata *match; 91 void *aux; 92 { 93 struct confargs *ca = aux; 94 char compat[32]; 95 96 /* XXX should not use name */ 97 if (strcmp(ca->ca_name, "ATA") == 0 || 98 strcmp(ca->ca_name, "ata") == 0 || 99 strcmp(ca->ca_name, "ata0") == 0 || 100 strcmp(ca->ca_name, "ide") == 0) 101 return 1; 102 103 bzero(compat, sizeof(compat)); 104 OF_getprop(ca->ca_node, "compatible", compat, sizeof(compat)); 105 if (strcmp(compat, "heathrow-ata") == 0 || 106 strcmp(compat, "keylargo-ata") == 0) 107 return 1; 108 109 return 0; 110 } 111 112 void 113 wdc_obio_attach(parent, self, aux) 114 struct device *parent, *self; 115 void *aux; 116 { 117 struct wdc_obio_softc *sc = (void *)self; 118 struct confargs *ca = aux; 119 struct channel_softc *chp = &sc->wdc_channel; 120 int intr; 121 int use_dma = 0; 122 123 if (sc->sc_wdcdev.sc_dev.dv_cfdata->cf_flags & WDC_OPTIONS_DMA) { 124 if (ca->ca_nreg >= 16 || ca->ca_nintr == -1) 125 use_dma = 1; /* XXX Don't work yet. */ 126 } 127 128 if (ca->ca_nintr >= 4 && ca->ca_nreg >= 8) { 129 intr = ca->ca_intr[0]; 130 printf(" irq %d", intr); 131 } else if (ca->ca_nintr == -1) { 132 intr = WDC_DEFAULT_PIO_IRQ; 133 printf(" irq property not found; using %d", intr); 134 } else { 135 printf(": couldn't get irq property\n"); 136 return; 137 } 138 139 if (use_dma) 140 printf(": DMA transfer"); 141 142 printf("\n"); 143 144 chp->cmd_iot = chp->ctl_iot = 145 macppc_make_bus_space_tag(ca->ca_baseaddr + ca->ca_reg[0], 4); 146 147 if (bus_space_map(chp->cmd_iot, 0, WDC_REG_NPORTS, 0, &chp->cmd_ioh) || 148 bus_space_subregion(chp->cmd_iot, chp->cmd_ioh, 149 WDC_AUXREG_OFFSET, 1, &chp->ctl_ioh)) { 150 printf("%s: couldn't map registers\n", 151 sc->sc_wdcdev.sc_dev.dv_xname); 152 return; 153 } 154 #if 0 155 chp->data32iot = chp->cmd_iot; 156 chp->data32ioh = chp->cmd_ioh; 157 #endif 158 159 sc->sc_ih = intr_establish(intr, IST_LEVEL, IPL_BIO, wdcintr, chp); 160 161 if (use_dma) { 162 sc->sc_dmacmd = dbdma_alloc(sizeof(dbdma_command_t) * 20); 163 sc->sc_dmareg = mapiodev(ca->ca_baseaddr + ca->ca_reg[2], 164 ca->ca_reg[3]); 165 sc->sc_wdcdev.cap |= WDC_CAPABILITY_DMA; 166 } 167 sc->sc_wdcdev.cap |= WDC_CAPABILITY_DATA16; 168 sc->sc_wdcdev.PIO_cap = 0; 169 sc->wdc_chanptr = chp; 170 sc->sc_wdcdev.channels = &sc->wdc_chanptr; 171 sc->sc_wdcdev.nchannels = 1; 172 sc->sc_wdcdev.dma_arg = sc; 173 sc->sc_wdcdev.dma_init = wdc_obio_dma_init; 174 sc->sc_wdcdev.dma_start = wdc_obio_dma_start; 175 sc->sc_wdcdev.dma_finish = wdc_obio_dma_finish; 176 chp->channel = 0; 177 chp->wdc = &sc->sc_wdcdev; 178 chp->ch_queue = malloc(sizeof(struct channel_queue), 179 M_DEVBUF, M_NOWAIT); 180 if (chp->ch_queue == NULL) { 181 printf("%s: can't allocate memory for command queue", 182 sc->sc_wdcdev.sc_dev.dv_xname); 183 return; 184 } 185 186 wdcattach(chp); 187 } 188 189 int 190 wdc_obio_detach(self, flags) 191 struct device *self; 192 int flags; 193 { 194 struct wdc_obio_softc *sc = (void *)self; 195 struct channel_softc *chp = &sc->wdc_channel; 196 int error; 197 198 if ((error = wdcdetach(self, flags)) != 0) 199 return error; 200 201 intr_disestablish(sc->sc_ih); 202 203 free(sc->wdc_channel.ch_queue, M_DEVBUF); 204 205 /* Unmap our i/o space. */ 206 bus_space_unmap(chp->cmd_iot, chp->cmd_ioh, WDC_REG_NPORTS); 207 208 /* Unmap DMA registers. */ 209 /* XXX unmapiodev(sc->sc_dmareg); */ 210 /* XXX free(sc->sc_dmacmd); */ 211 212 return 0; 213 } 214 215 static int 216 wdc_obio_dma_init(v, channel, drive, databuf, datalen, read) 217 void *v; 218 void *databuf; 219 size_t datalen; 220 int read; 221 { 222 struct wdc_obio_softc *sc = v; 223 vaddr_t va = (vaddr_t)databuf; 224 dbdma_command_t *cmdp; 225 u_int cmd, offset; 226 227 cmdp = sc->sc_dmacmd; 228 cmd = read ? DBDMA_CMD_IN_MORE : DBDMA_CMD_OUT_MORE; 229 230 offset = va & PGOFSET; 231 232 /* if va is not page-aligned, setup the first page */ 233 if (offset != 0) { 234 int rest = NBPG - offset; /* the rest of the page */ 235 236 if (datalen > rest) { /* if continues to next page */ 237 DBDMA_BUILD(cmdp, cmd, 0, rest, vtophys(va), 238 DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, 239 DBDMA_BRANCH_NEVER); 240 datalen -= rest; 241 va += rest; 242 cmdp++; 243 } 244 } 245 246 /* now va is page-aligned */ 247 while (datalen > NBPG) { 248 DBDMA_BUILD(cmdp, cmd, 0, NBPG, vtophys(va), 249 DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER); 250 datalen -= NBPG; 251 va += NBPG; 252 cmdp++; 253 } 254 255 /* the last page (datalen <= NBPG here) */ 256 cmd = read ? DBDMA_CMD_IN_LAST : DBDMA_CMD_OUT_LAST; 257 DBDMA_BUILD(cmdp, cmd, 0, datalen, vtophys(va), 258 DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER); 259 cmdp++; 260 261 DBDMA_BUILD(cmdp, DBDMA_CMD_STOP, 0, 0, 0, 262 DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER); 263 264 return 0; 265 } 266 267 static void 268 wdc_obio_dma_start(v, channel, drive, read) 269 void *v; 270 int channel, drive; 271 { 272 struct wdc_obio_softc *sc = v; 273 274 dbdma_start(sc->sc_dmareg, sc->sc_dmacmd); 275 } 276 277 static int 278 wdc_obio_dma_finish(v, channel, drive, read) 279 void *v; 280 int channel, drive; 281 int read; 282 { 283 struct wdc_obio_softc *sc = v; 284 285 dbdma_stop(sc->sc_dmareg); 286 return 0; 287 } 288
Indexes created Mon Sep 29 18:09:42 GMT 2025