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