1 1.17 thorpej /* $NetBSD: efa.c,v 1.17 2023/12/20 00:40:42 thorpej Exp $ */ 2 1.1 rkujawa 3 1.1 rkujawa /*- 4 1.1 rkujawa * Copyright (c) 2011 The NetBSD Foundation, Inc. 5 1.1 rkujawa * All rights reserved. 6 1.1 rkujawa * 7 1.1 rkujawa * This code is derived from software contributed to The NetBSD Foundation 8 1.1 rkujawa * by Radoslaw Kujawa. 9 1.1 rkujawa * 10 1.1 rkujawa * Redistribution and use in source and binary forms, with or without 11 1.1 rkujawa * modification, are permitted provided that the following conditions 12 1.1 rkujawa * are met: 13 1.1 rkujawa * 1. Redistributions of source code must retain the above copyright 14 1.1 rkujawa * notice, this list of conditions and the following disclaimer. 15 1.1 rkujawa * 2. Redistributions in binary form must reproduce the above copyright 16 1.1 rkujawa * notice, this list of conditions and the following disclaimer in the 17 1.1 rkujawa * documentation and/or other materials provided with the distribution. 18 1.1 rkujawa * 19 1.1 rkujawa * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 1.1 rkujawa * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 1.1 rkujawa * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 1.1 rkujawa * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 1.1 rkujawa * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 1.1 rkujawa * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 1.1 rkujawa * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 1.1 rkujawa * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 1.1 rkujawa * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 1.1 rkujawa * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 1.1 rkujawa * POSSIBILITY OF SUCH DAMAGE. 30 1.1 rkujawa */ 31 1.1 rkujawa 32 1.1 rkujawa /* 33 1.1 rkujawa * Driver for FastATA 1200 EIDE controller, manufactured by ELBOX Computer. 34 1.1 rkujawa * 35 1.1 rkujawa * Gayle-related stuff inspired by wdc_amiga.c written by Michael L. Hitch 36 1.1 rkujawa * and Aymeric Vincent. 37 1.1 rkujawa */ 38 1.1 rkujawa 39 1.1 rkujawa #include <sys/cdefs.h> 40 1.1 rkujawa 41 1.1 rkujawa #include <sys/types.h> 42 1.1 rkujawa #include <sys/param.h> 43 1.1 rkujawa #include <sys/systm.h> 44 1.1 rkujawa #include <sys/device.h> 45 1.1 rkujawa #include <sys/bus.h> 46 1.1 rkujawa #include <sys/proc.h> 47 1.1 rkujawa #include <sys/kernel.h> 48 1.1 rkujawa #include <sys/kthread.h> 49 1.1 rkujawa 50 1.1 rkujawa #include <machine/cpu.h> 51 1.1 rkujawa #include <machine/intr.h> 52 1.1 rkujawa #include <sys/bswap.h> 53 1.1 rkujawa 54 1.1 rkujawa #include <amiga/amiga/cia.h> 55 1.1 rkujawa #include <amiga/amiga/custom.h> 56 1.1 rkujawa #include <amiga/amiga/device.h> 57 1.1 rkujawa #include <amiga/amiga/gayle.h> 58 1.1 rkujawa #include <amiga/dev/zbusvar.h> 59 1.1 rkujawa 60 1.1 rkujawa #include <dev/ata/atavar.h> 61 1.1 rkujawa #include <dev/ic/wdcvar.h> 62 1.1 rkujawa 63 1.1 rkujawa #include <amiga/dev/efareg.h> 64 1.1 rkujawa #include <amiga/dev/efavar.h> 65 1.1 rkujawa 66 1.3 rkujawa #define EFA_32BIT_IO 1 67 1.1 rkujawa /* #define EFA_NO_INTR 1 */ 68 1.1 rkujawa /* #define EFA_DEBUG 1 */ 69 1.1 rkujawa 70 1.1 rkujawa int efa_probe(device_t, cfdata_t, void *); 71 1.1 rkujawa void efa_attach(device_t, device_t, void *); 72 1.1 rkujawa int efa_intr(void *); 73 1.1 rkujawa int efa_intr_soft(void *arg); 74 1.1 rkujawa static void efa_set_opts(struct efa_softc *sc); 75 1.1 rkujawa static bool efa_mapbase(struct efa_softc *sc); 76 1.1 rkujawa static bool efa_mapreg_gayle(struct efa_softc *sc); 77 1.1 rkujawa static bool efa_mapreg_native(struct efa_softc *sc); 78 1.1 rkujawa static void efa_fata_subregion_pio0(struct wdc_regs *wdr_fata); 79 1.1 rkujawa static void efa_fata_subregion_pion(struct wdc_regs *wdr_fata, bool data32); 80 1.1 rkujawa static void efa_setup_channel(struct ata_channel *chp); 81 1.1 rkujawa static void efa_attach_channel(struct efa_softc *sc, int i); 82 1.1 rkujawa static void efa_select_regset(struct efa_softc *sc, int chnum, 83 1.1 rkujawa uint8_t piomode); 84 1.1 rkujawa static void efa_poll_kthread(void *arg); 85 1.4 rkujawa static bool efa_compare_status(void); 86 1.1 rkujawa #ifdef EFA_DEBUG 87 1.1 rkujawa static void efa_debug_print_regmapping(struct wdc_regs *wdr_fata); 88 1.1 rkujawa #endif /* EFA_DEBUG */ 89 1.1 rkujawa 90 1.1 rkujawa CFATTACH_DECL_NEW(efa, sizeof(struct efa_softc), 91 1.1 rkujawa efa_probe, efa_attach, NULL, NULL); 92 1.1 rkujawa 93 1.1 rkujawa #define PIO_NSUPP 0xFFFFFFFF 94 1.1 rkujawa 95 1.1 rkujawa static const bus_addr_t pio_offsets[] = 96 1.1 rkujawa { FATA1_PIO0_OFF, PIO_NSUPP, PIO_NSUPP, FATA1_PIO3_OFF, FATA1_PIO4_OFF, 97 1.1 rkujawa FATA1_PIO5_OFF }; 98 1.1 rkujawa static const unsigned int wdr_offsets_pio0[] = 99 1.1 rkujawa { FATA1_PIO0_OFF_DATA, FATA1_PIO0_OFF_ERROR, FATA1_PIO0_OFF_SECCNT, 100 1.1 rkujawa FATA1_PIO0_OFF_SECTOR, FATA1_PIO0_OFF_CYL_LO, FATA1_PIO0_OFF_CYL_HI, 101 1.1 rkujawa FATA1_PIO0_OFF_SDH, FATA1_PIO0_OFF_COMMAND }; 102 1.1 rkujawa static const unsigned int wdr_offsets_pion[] = 103 1.1 rkujawa { FATA1_PION_OFF_DATA, FATA1_PION_OFF_ERROR, FATA1_PION_OFF_SECCNT, 104 1.1 rkujawa FATA1_PION_OFF_SECTOR, FATA1_PION_OFF_CYL_LO, FATA1_PION_OFF_CYL_HI, 105 1.1 rkujawa FATA1_PION_OFF_SDH, FATA1_PION_OFF_COMMAND }; 106 1.1 rkujawa 107 1.1 rkujawa int 108 1.1 rkujawa efa_probe(device_t parent, cfdata_t cfp, void *aux) 109 1.1 rkujawa { 110 1.2 rkujawa /* 111 1.2 rkujawa * FastATA 1200 uses portions of Gayle IDE interface, and efa driver 112 1.1 rkujawa * can't coexist with wdc_amiga. Match "wdc" on an A1200, because 113 1.2 rkujawa * FastATA 1200 does not autoconfigure. 114 1.2 rkujawa */ 115 1.4 rkujawa if (!matchname(aux, "wdc") || !is_a1200()) 116 1.1 rkujawa return(0); 117 1.1 rkujawa 118 1.4 rkujawa if (!efa_compare_status()) 119 1.4 rkujawa return(0); 120 1.4 rkujawa 121 1.4 rkujawa #ifdef EFA_DEBUG 122 1.4 rkujawa aprint_normal("efa_probe succeeded\n"); 123 1.4 rkujawa #endif /* EFA_DEBUG */ 124 1.4 rkujawa 125 1.1 rkujawa return 100; 126 1.1 rkujawa } 127 1.1 rkujawa 128 1.1 rkujawa void 129 1.1 rkujawa efa_attach(device_t parent, device_t self, void *aux) 130 1.1 rkujawa { 131 1.1 rkujawa int i; 132 1.1 rkujawa struct efa_softc *sc = device_private(self); 133 1.1 rkujawa 134 1.1 rkujawa aprint_normal(": ELBOX FastATA 1200\n"); 135 1.1 rkujawa 136 1.1 rkujawa gayle_init(); 137 1.1 rkujawa 138 1.1 rkujawa efa_set_opts(sc); 139 1.1 rkujawa 140 1.2 rkujawa if (!efa_mapbase(sc)) { 141 1.1 rkujawa aprint_error_dev(self, "couldn't map base addresses\n"); 142 1.1 rkujawa return; 143 1.1 rkujawa } 144 1.2 rkujawa if (!efa_mapreg_gayle(sc)) { 145 1.1 rkujawa aprint_error_dev(self, "couldn't map Gayle registers\n"); 146 1.1 rkujawa return; 147 1.1 rkujawa } 148 1.2 rkujawa if (!efa_mapreg_native(sc)) { 149 1.16 andvar aprint_error_dev(self, "couldn't map FastATA registers\n"); 150 1.1 rkujawa return; 151 1.1 rkujawa } 152 1.1 rkujawa 153 1.1 rkujawa sc->sc_wdcdev.sc_atac.atac_pio_cap = 5; 154 1.1 rkujawa sc->sc_wdcdev.sc_atac.atac_nchannels = FATA1_CHANNELS; 155 1.1 rkujawa sc->sc_wdcdev.sc_atac.atac_set_modes = efa_setup_channel; 156 1.1 rkujawa sc->sc_wdcdev.sc_atac.atac_dev = self; 157 1.1 rkujawa sc->sc_wdcdev.sc_atac.atac_channels = sc->sc_chanlist; 158 1.3 rkujawa sc->sc_wdcdev.sc_atac.atac_cap = ATAC_CAP_DATA16; 159 1.11 bouyer sc->sc_wdcdev.wdc_maxdrives = 2; 160 1.1 rkujawa 161 1.2 rkujawa if (sc->sc_32bit_io) 162 1.3 rkujawa sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_DATA32; 163 1.3 rkujawa 164 1.1 rkujawa /* 165 1.1 rkujawa * The following should work for polling mode, but it does not. 166 1.2 rkujawa * if (sc->sc_no_intr) 167 1.1 rkujawa * sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_NOIRQ; 168 1.1 rkujawa */ 169 1.1 rkujawa 170 1.1 rkujawa wdc_allocate_regs(&sc->sc_wdcdev); 171 1.1 rkujawa 172 1.2 rkujawa for (i = 0; i < FATA1_CHANNELS; i++) 173 1.1 rkujawa efa_attach_channel(sc, i); 174 1.1 rkujawa 175 1.2 rkujawa if (sc->sc_no_intr) { 176 1.1 rkujawa sc->sc_fata_softintr = softint_establish(SOFTINT_BIO, 177 1.1 rkujawa (void (*)(void *))efa_intr_soft, sc); 178 1.1 rkujawa if (sc->sc_fata_softintr == NULL) { 179 1.1 rkujawa aprint_error_dev(self, "couldn't create soft intr\n"); 180 1.1 rkujawa return; 181 1.1 rkujawa } 182 1.1 rkujawa if (kthread_create(PRI_NONE, 0, NULL, efa_poll_kthread, sc, 183 1.1 rkujawa NULL, "efa")) { 184 1.1 rkujawa aprint_error_dev(self, "couldn't create kthread\n"); 185 1.1 rkujawa return; 186 1.1 rkujawa } 187 1.1 rkujawa } else { 188 1.1 rkujawa sc->sc_isr.isr_intr = efa_intr; 189 1.1 rkujawa sc->sc_isr.isr_arg = sc; 190 1.1 rkujawa sc->sc_isr.isr_ipl = 2; 191 1.1 rkujawa add_isr (&sc->sc_isr); 192 1.12 rkujawa gayle_intr_enable_set(GAYLE_INT_IDE); 193 1.1 rkujawa } 194 1.1 rkujawa 195 1.1 rkujawa } 196 1.1 rkujawa 197 1.1 rkujawa static void 198 1.1 rkujawa efa_attach_channel(struct efa_softc *sc, int chnum) 199 1.1 rkujawa { 200 1.13 phx #ifdef EFA_DEBUG 201 1.13 phx device_t self; 202 1.13 phx 203 1.13 phx self = sc->sc_wdcdev.sc_atac.atac_dev; 204 1.13 phx #endif /* EFA_DEBUG */ 205 1.13 phx 206 1.1 rkujawa sc->sc_chanlist[chnum] = &sc->sc_ports[chnum].chan; 207 1.1 rkujawa 208 1.1 rkujawa sc->sc_ports[chnum].chan.ch_channel = chnum; 209 1.1 rkujawa sc->sc_ports[chnum].chan.ch_atac = &sc->sc_wdcdev.sc_atac; 210 1.1 rkujawa 211 1.2 rkujawa if (!sc->sc_32bit_io) 212 1.1 rkujawa efa_select_regset(sc, chnum, 0); /* Start in PIO0. */ 213 1.1 rkujawa else 214 1.1 rkujawa efa_select_regset(sc, chnum, 3); 215 1.1 rkujawa 216 1.14 jdolecek wdc_init_shadow_regs(CHAN_TO_WDC_REGS(&sc->sc_ports[chnum].chan)); 217 1.1 rkujawa 218 1.1 rkujawa wdcattach(&sc->sc_ports[chnum].chan); 219 1.1 rkujawa 220 1.1 rkujawa #ifdef EFA_DEBUG 221 1.13 phx aprint_normal_dev(self, "done init for channel %d\n", chnum); 222 1.1 rkujawa #endif 223 1.1 rkujawa 224 1.1 rkujawa } 225 1.1 rkujawa 226 1.1 rkujawa /* TODO: convert to callout(9) */ 227 1.1 rkujawa static void 228 1.1 rkujawa efa_poll_kthread(void *arg) 229 1.1 rkujawa { 230 1.1 rkujawa struct efa_softc *sc = arg; 231 1.1 rkujawa 232 1.2 rkujawa for (;;) { 233 1.1 rkujawa /* TODO: actually check if interrupt status register is set */ 234 1.1 rkujawa softint_schedule(sc->sc_fata_softintr); 235 1.1 rkujawa /* TODO: convert to kpause */ 236 1.1 rkujawa tsleep(arg, PWAIT, "efa_poll", hz); 237 1.1 rkujawa } 238 1.1 rkujawa } 239 1.1 rkujawa 240 1.1 rkujawa static void 241 1.1 rkujawa efa_set_opts(struct efa_softc *sc) 242 1.1 rkujawa { 243 1.13 phx device_t self; 244 1.13 phx 245 1.13 phx self = sc->sc_wdcdev.sc_atac.atac_dev; 246 1.13 phx 247 1.1 rkujawa #ifdef EFA_32BIT_IO 248 1.4 rkujawa sc->sc_32bit_io = true; 249 1.1 rkujawa #else 250 1.1 rkujawa sc->sc_32bit_io = false; 251 1.1 rkujawa #endif /* EFA_32BIT_IO */ 252 1.1 rkujawa 253 1.1 rkujawa #ifdef EFA_NO_INTR 254 1.1 rkujawa sc->sc_no_intr = true; /* XXX: not yet! */ 255 1.1 rkujawa #else 256 1.1 rkujawa sc->sc_no_intr = false; 257 1.1 rkujawa #endif /* EFA_NO_INTR */ 258 1.1 rkujawa 259 1.2 rkujawa if (sc->sc_no_intr) 260 1.13 phx aprint_verbose_dev(self, "hardware interrupt disabled\n"); 261 1.1 rkujawa 262 1.2 rkujawa if (sc->sc_32bit_io) 263 1.13 phx aprint_verbose_dev(self, "32-bit I/O enabled\n"); 264 1.1 rkujawa } 265 1.1 rkujawa 266 1.1 rkujawa int 267 1.1 rkujawa efa_intr_soft(void *arg) 268 1.1 rkujawa { 269 1.1 rkujawa int ret = 0; 270 1.1 rkujawa struct efa_softc *sc = (struct efa_softc *)arg; 271 1.1 rkujawa 272 1.1 rkujawa /* TODO: check which channel needs servicing */ 273 1.1 rkujawa /* 274 1.1 rkujawa uint8_t fataintreq; 275 1.1 rkujawa fataintreq = bus_space_read_1(sc->sc_ports[0].wdr[piom].cmd_iot, 276 1.1 rkujawa sc->sc_ports[chnum].intst[piom], 0); 277 1.1 rkujawa */ 278 1.1 rkujawa 279 1.1 rkujawa ret = wdcintr(&sc->sc_ports[0].chan); 280 1.1 rkujawa ret = wdcintr(&sc->sc_ports[1].chan); 281 1.1 rkujawa 282 1.1 rkujawa return ret; 283 1.1 rkujawa } 284 1.1 rkujawa 285 1.1 rkujawa int 286 1.1 rkujawa efa_intr(void *arg) 287 1.1 rkujawa { 288 1.1 rkujawa struct efa_softc *sc = (struct efa_softc *)arg; 289 1.2 rkujawa int r1, r2, ret; 290 1.12 rkujawa uint8_t intreq; 291 1.1 rkujawa 292 1.12 rkujawa intreq = gayle_intr_status(); 293 1.2 rkujawa ret = 0; 294 1.1 rkujawa 295 1.1 rkujawa if (intreq & GAYLE_INT_IDE) { 296 1.12 rkujawa gayle_intr_ack(0x7C | (intreq & 0x03)); 297 1.1 rkujawa /* How to check which channel caused interrupt? 298 1.1 rkujawa * Interrupt status register is not very useful here. */ 299 1.1 rkujawa r1 = wdcintr(&sc->sc_ports[0].chan); 300 1.1 rkujawa r2 = wdcintr(&sc->sc_ports[1].chan); 301 1.1 rkujawa ret = r1 | r2; 302 1.1 rkujawa } 303 1.1 rkujawa 304 1.1 rkujawa return ret; 305 1.1 rkujawa } 306 1.1 rkujawa 307 1.1 rkujawa static bool 308 1.1 rkujawa efa_mapbase(struct efa_softc *sc) 309 1.1 rkujawa { 310 1.1 rkujawa static struct bus_space_tag fata_cmd_iot; 311 1.1 rkujawa static struct bus_space_tag gayle_cmd_iot; 312 1.13 phx int i, j; 313 1.13 phx #ifdef EFA_DEBUG 314 1.13 phx device_t self; 315 1.13 phx 316 1.13 phx self = sc->sc_wdcdev.sc_atac.atac_dev; 317 1.13 phx #endif /* EFA_DEBUG */ 318 1.1 rkujawa 319 1.1 rkujawa gayle_cmd_iot.base = (bus_addr_t) ztwomap(GAYLE_IDE_BASE + 2); 320 1.1 rkujawa gayle_cmd_iot.absm = &amiga_bus_stride_4swap; 321 1.1 rkujawa fata_cmd_iot.base = (bus_addr_t) ztwomap(FATA1_BASE); 322 1.1 rkujawa fata_cmd_iot.absm = &amiga_bus_stride_4swap; 323 1.1 rkujawa 324 1.1 rkujawa #ifdef EFA_DEBUG 325 1.13 phx aprint_normal_dev(self, "Gayle %x -> %x, FastATA %x -> %x\n", 326 1.1 rkujawa GAYLE_IDE_BASE, gayle_cmd_iot.base, FATA1_BASE, fata_cmd_iot.base); 327 1.1 rkujawa #endif 328 1.1 rkujawa 329 1.2 rkujawa if (!gayle_cmd_iot.base) 330 1.1 rkujawa return false; 331 1.2 rkujawa if (!fata_cmd_iot.base) 332 1.1 rkujawa return false; 333 1.1 rkujawa 334 1.1 rkujawa sc->sc_gayle_wdc_regs.cmd_iot = &gayle_cmd_iot; 335 1.1 rkujawa sc->sc_gayle_wdc_regs.ctl_iot = &gayle_cmd_iot; 336 1.1 rkujawa 337 1.2 rkujawa for (i = 0; i < FATA1_CHANNELS; i++) { 338 1.2 rkujawa for (j = 0; j < PIO_COUNT; j++) { 339 1.1 rkujawa sc->sc_ports[i].wdr[j].cmd_iot = &fata_cmd_iot; 340 1.3 rkujawa sc->sc_ports[i].wdr[j].data32iot = &fata_cmd_iot; 341 1.1 rkujawa sc->sc_ports[i].wdr[j].ctl_iot = &gayle_cmd_iot; 342 1.1 rkujawa } 343 1.1 rkujawa } 344 1.1 rkujawa 345 1.1 rkujawa return true; 346 1.1 rkujawa } 347 1.1 rkujawa 348 1.1 rkujawa 349 1.1 rkujawa /* Gayle IDE register mapping, we need it anyway. */ 350 1.1 rkujawa static bool 351 1.1 rkujawa efa_mapreg_gayle(struct efa_softc *sc) 352 1.1 rkujawa { 353 1.1 rkujawa int i; 354 1.1 rkujawa 355 1.1 rkujawa struct wdc_regs *wdr = &sc->sc_gayle_wdc_regs; 356 1.1 rkujawa 357 1.1 rkujawa if (bus_space_map(wdr->cmd_iot, 0, 0x40, 0, 358 1.2 rkujawa &wdr->cmd_baseioh)) { 359 1.1 rkujawa return false; 360 1.1 rkujawa } 361 1.1 rkujawa 362 1.1 rkujawa for (i = 0; i < WDC_NREG; i++) { 363 1.1 rkujawa if (bus_space_subregion(wdr->cmd_iot, 364 1.1 rkujawa wdr->cmd_baseioh, i, i == 0 ? 4 : 1, 365 1.1 rkujawa &wdr->cmd_iohs[i]) != 0) { 366 1.1 rkujawa 367 1.1 rkujawa bus_space_unmap(wdr->cmd_iot, 368 1.1 rkujawa wdr->cmd_baseioh, 0x40); 369 1.1 rkujawa return false; 370 1.1 rkujawa } 371 1.1 rkujawa } 372 1.1 rkujawa 373 1.1 rkujawa if (bus_space_subregion(wdr->cmd_iot, 374 1.1 rkujawa wdr->cmd_baseioh, 0x406, 1, &wdr->ctl_ioh)) 375 1.1 rkujawa return false; 376 1.1 rkujawa 377 1.1 rkujawa return true; 378 1.1 rkujawa } 379 1.1 rkujawa 380 1.1 rkujawa /* Native FastATA register mapping, suitable for PIO modes 0 to 5. */ 381 1.1 rkujawa static bool 382 1.2 rkujawa efa_mapreg_native(struct efa_softc *sc) 383 1.2 rkujawa { 384 1.1 rkujawa struct wdc_regs *wdr_gayle = &sc->sc_gayle_wdc_regs; 385 1.1 rkujawa struct wdc_regs *wdr_fata; 386 1.13 phx int i,j; 387 1.13 phx #ifdef EFA_DEBUG 388 1.13 phx device_t self; 389 1.13 phx 390 1.13 phx self = sc->sc_wdcdev.sc_atac.atac_dev; 391 1.13 phx #endif /* EFA_DEBUG */ 392 1.1 rkujawa 393 1.2 rkujawa for (i = 0; i < FATA1_CHANNELS; i++) { 394 1.1 rkujawa 395 1.2 rkujawa for (j = 0; j < PIO_COUNT; j++) { 396 1.1 rkujawa 397 1.1 rkujawa wdr_fata = &sc->sc_ports[i].wdr[j]; 398 1.1 rkujawa sc->sc_ports[i].mode_ok[j] = false; 399 1.1 rkujawa 400 1.2 rkujawa if (pio_offsets[j] == PIO_NSUPP) { 401 1.1 rkujawa #ifdef EFA_DEBUG 402 1.13 phx aprint_normal_dev(self, 403 1.1 rkujawa "Skipping mapping for PIO mode %x\n", j); 404 1.1 rkujawa #endif 405 1.1 rkujawa continue; 406 1.1 rkujawa } 407 1.1 rkujawa 408 1.2 rkujawa if (bus_space_map(wdr_fata->cmd_iot, 409 1.1 rkujawa pio_offsets[j] + FATA1_CHAN_SIZE * i, 410 1.1 rkujawa FATA1_CHAN_SIZE, 0, &wdr_fata->cmd_baseioh)) { 411 1.1 rkujawa return false; 412 1.1 rkujawa } 413 1.1 rkujawa #ifdef EFA_DEBUG 414 1.13 phx aprint_normal_dev(self, 415 1.1 rkujawa "Chan %x PIO mode %x mapped %x -> %x\n", 416 1.1 rkujawa i, j, (bus_addr_t) kvtop((void*) 417 1.1 rkujawa wdr_fata->cmd_baseioh), (unsigned int) 418 1.1 rkujawa wdr_fata->cmd_baseioh); 419 1.1 rkujawa #endif 420 1.1 rkujawa 421 1.1 rkujawa sc->sc_ports[i].mode_ok[j] = true; 422 1.1 rkujawa 423 1.2 rkujawa if (j == 0) 424 1.1 rkujawa efa_fata_subregion_pio0(wdr_fata); 425 1.1 rkujawa else { 426 1.2 rkujawa if (sc->sc_32bit_io) 427 1.1 rkujawa efa_fata_subregion_pion(wdr_fata, 428 1.1 rkujawa true); 429 1.1 rkujawa else 430 1.1 rkujawa efa_fata_subregion_pion(wdr_fata, 431 1.1 rkujawa false); 432 1.1 rkujawa 433 1.1 rkujawa bus_space_subregion(wdr_fata->cmd_iot, 434 1.1 rkujawa wdr_fata->cmd_baseioh, FATA1_PION_OFF_INTST, 435 1.1 rkujawa 1, &sc->sc_ports[i].intst[j]); 436 1.1 rkujawa } 437 1.1 rkujawa 438 1.1 rkujawa /* No 32-bit register for PIO0 ... */ 439 1.2 rkujawa if (j == 0 && sc->sc_32bit_io) 440 1.1 rkujawa sc->sc_ports[i].mode_ok[j] = false; 441 1.1 rkujawa 442 1.1 rkujawa wdr_fata->ctl_ioh = wdr_gayle->ctl_ioh; 443 1.1 rkujawa }; 444 1.1 rkujawa } 445 1.1 rkujawa return true; 446 1.1 rkujawa } 447 1.1 rkujawa 448 1.1 rkujawa 449 1.1 rkujawa static void 450 1.1 rkujawa efa_fata_subregion_pio0(struct wdc_regs *wdr_fata) 451 1.1 rkujawa { 452 1.5 rkujawa int i; 453 1.1 rkujawa 454 1.5 rkujawa for (i = 0; i < WDC_NREG; i++) 455 1.5 rkujawa bus_space_subregion(wdr_fata->cmd_iot, 456 1.5 rkujawa wdr_fata->cmd_baseioh, wdr_offsets_pio0[i], 457 1.5 rkujawa i == 0 ? 4 : 1, &wdr_fata->cmd_iohs[i]); 458 1.1 rkujawa } 459 1.1 rkujawa 460 1.1 rkujawa static void 461 1.1 rkujawa efa_fata_subregion_pion(struct wdc_regs *wdr_fata, bool data32) 462 1.1 rkujawa { 463 1.5 rkujawa int i; 464 1.5 rkujawa 465 1.2 rkujawa if (data32) 466 1.1 rkujawa bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh, 467 1.3 rkujawa FATA1_PION_OFF_DATA32, 8, &wdr_fata->data32ioh); 468 1.1 rkujawa 469 1.5 rkujawa for (i = 0; i < WDC_NREG; i++) 470 1.5 rkujawa bus_space_subregion(wdr_fata->cmd_iot, 471 1.5 rkujawa wdr_fata->cmd_baseioh, wdr_offsets_pion[i], 472 1.5 rkujawa i == 0 ? 4 : 1, &wdr_fata->cmd_iohs[i]); 473 1.1 rkujawa } 474 1.1 rkujawa 475 1.1 rkujawa static void 476 1.1 rkujawa efa_setup_channel(struct ata_channel *chp) 477 1.1 rkujawa { 478 1.1 rkujawa int drive, chnum; 479 1.1 rkujawa uint8_t mode; 480 1.1 rkujawa struct atac_softc *atac; 481 1.1 rkujawa struct ata_drive_datas *drvp; 482 1.1 rkujawa struct efa_softc *sc; 483 1.1 rkujawa int ipl; 484 1.13 phx #ifdef EFA_DEBUG 485 1.13 phx device_t self; 486 1.13 phx #endif /* EFA_DEBUG */ 487 1.1 rkujawa 488 1.1 rkujawa chnum = chp->ch_channel; 489 1.1 rkujawa atac = chp->ch_atac; 490 1.13 phx 491 1.1 rkujawa sc = device_private(atac->atac_dev); 492 1.1 rkujawa 493 1.1 rkujawa mode = 5; /* start with fastest possible setting */ 494 1.1 rkujawa 495 1.1 rkujawa #ifdef EFA_DEBUG 496 1.13 phx self = sc->sc_wdcdev.sc_atac.atac_dev; 497 1.13 phx aprint_normal_dev(self, "efa_setup_channel for ch %d\n", 498 1.1 rkujawa chnum); 499 1.1 rkujawa #endif /* EFA_DEBUG */ 500 1.1 rkujawa 501 1.1 rkujawa /* We might be in the middle of something... so raise IPL. */ 502 1.1 rkujawa ipl = splvm(); 503 1.1 rkujawa 504 1.1 rkujawa for (drive = 0; drive < 2; drive++) { 505 1.1 rkujawa drvp = &chp->ch_drive[drive]; 506 1.1 rkujawa 507 1.11 bouyer if (drvp->drive_type == ATA_DRIVET_NONE) 508 1.1 rkujawa continue; /* nothing to see here */ 509 1.1 rkujawa 510 1.7 rkujawa if (drvp->PIO_cap < mode) 511 1.1 rkujawa mode = drvp->PIO_cap; 512 1.1 rkujawa 513 1.1 rkujawa /* TODO: check if sc_ports->mode_ok */ 514 1.1 rkujawa 515 1.1 rkujawa #ifdef EFA_DEBUG 516 1.13 phx aprint_normal_dev(self, "drive %d supports %d\n", 517 1.1 rkujawa drive, drvp->PIO_cap); 518 1.1 rkujawa #endif /* EFA_DEBUG */ 519 1.1 rkujawa 520 1.1 rkujawa drvp->PIO_mode = mode; 521 1.1 rkujawa } 522 1.1 rkujawa 523 1.1 rkujawa /* Change FastATA register set. */ 524 1.1 rkujawa efa_select_regset(sc, chnum, mode); 525 1.1 rkujawa /* re-init shadow regs */ 526 1.14 jdolecek wdc_init_shadow_regs(CHAN_TO_WDC_REGS(&sc->sc_ports[chnum].chan)); 527 1.1 rkujawa 528 1.1 rkujawa splx(ipl); 529 1.1 rkujawa } 530 1.1 rkujawa 531 1.1 rkujawa static void 532 1.1 rkujawa efa_select_regset(struct efa_softc *sc, int chnum, uint8_t piomode) 533 1.1 rkujawa { 534 1.1 rkujawa struct wdc_softc *wdc; 535 1.13 phx #ifdef EFA_DEBUG 536 1.13 phx device_t self; 537 1.13 phx 538 1.13 phx self = sc->sc_wdcdev.sc_atac.atac_dev; 539 1.13 phx #endif /* EFA_DEBUG */ 540 1.1 rkujawa 541 1.1 rkujawa wdc = CHAN_TO_WDC(&sc->sc_ports[chnum].chan); 542 1.1 rkujawa wdc->regs[chnum] = sc->sc_ports[chnum].wdr[piomode]; 543 1.1 rkujawa 544 1.1 rkujawa #ifdef EFA_DEBUG 545 1.13 phx aprint_normal_dev(self, "switched ch %d to PIO %d\n", 546 1.1 rkujawa chnum, piomode); 547 1.1 rkujawa 548 1.1 rkujawa efa_debug_print_regmapping(&wdc->regs[chnum]); 549 1.1 rkujawa #endif /* EFA_DEBUG */ 550 1.1 rkujawa } 551 1.1 rkujawa 552 1.1 rkujawa #ifdef EFA_DEBUG 553 1.1 rkujawa static void 554 1.1 rkujawa efa_debug_print_regmapping(struct wdc_regs *wdr_fata) 555 1.1 rkujawa { 556 1.1 rkujawa int i; 557 1.1 rkujawa aprint_normal("base %x->%x", 558 1.1 rkujawa (bus_addr_t) kvtop((void*) wdr_fata->cmd_baseioh), 559 1.1 rkujawa (bus_addr_t) wdr_fata->cmd_baseioh); 560 1.1 rkujawa for (i = 0; i < WDC_NREG; i++) { 561 1.1 rkujawa aprint_normal("reg %x, %x->%x, ", i, 562 1.1 rkujawa (bus_addr_t) kvtop((void*) wdr_fata->cmd_iohs[i]), 563 1.1 rkujawa (bus_addr_t) wdr_fata->cmd_iohs[i]); 564 1.1 rkujawa } 565 1.1 rkujawa aprint_normal("\n"); 566 1.1 rkujawa } 567 1.1 rkujawa #endif /* EFA_DEBUG */ 568 1.1 rkujawa 569 1.4 rkujawa /* Compare the values of (status) command register in PIO0, PIO3 sets. */ 570 1.4 rkujawa static bool 571 1.4 rkujawa efa_compare_status(void) 572 1.4 rkujawa { 573 1.4 rkujawa uint8_t cmd0, cmd3; 574 1.4 rkujawa struct bus_space_tag fata_bst; 575 1.4 rkujawa bus_space_tag_t fata_iot; 576 1.4 rkujawa bus_space_handle_t cmd0_ioh, cmd3_ioh; 577 1.4 rkujawa bool rv; 578 1.4 rkujawa 579 1.4 rkujawa rv = false; 580 1.4 rkujawa 581 1.4 rkujawa fata_bst.base = (bus_addr_t) ztwomap(FATA1_BASE); 582 1.4 rkujawa fata_bst.absm = &amiga_bus_stride_4swap; 583 1.4 rkujawa 584 1.4 rkujawa fata_iot = &fata_bst; 585 1.4 rkujawa 586 1.4 rkujawa if (bus_space_map(fata_iot, pio_offsets[0], FATA1_CHAN_SIZE, 0, 587 1.4 rkujawa &cmd0_ioh)) 588 1.4 rkujawa return false; 589 1.4 rkujawa if (bus_space_map(fata_iot, pio_offsets[3], FATA1_CHAN_SIZE, 0, 590 1.4 rkujawa &cmd3_ioh)) 591 1.4 rkujawa return false; 592 1.4 rkujawa 593 1.4 rkujawa #ifdef EFA_DEBUG 594 1.4 rkujawa aprint_normal("probing for FastATA at %x, %x: ", (bus_addr_t) cmd0_ioh, 595 1.4 rkujawa (bus_addr_t) cmd3_ioh); 596 1.4 rkujawa #endif /* EFA_DEBUG */ 597 1.4 rkujawa 598 1.4 rkujawa cmd0 = bus_space_read_1(fata_iot, cmd0_ioh, FATA1_PIO0_OFF_COMMAND); 599 1.4 rkujawa cmd3 = bus_space_read_1(fata_iot, cmd3_ioh, FATA1_PION_OFF_COMMAND); 600 1.4 rkujawa 601 1.4 rkujawa if (cmd0 == cmd3) 602 1.4 rkujawa rv = true; 603 1.4 rkujawa 604 1.4 rkujawa if ( (cmd0 == 0xFF) || (cmd0 == 0x00) ) { 605 1.4 rkujawa /* Assume there's nothing there... */ 606 1.4 rkujawa rv = false; 607 1.4 rkujawa } 608 1.4 rkujawa 609 1.4 rkujawa #ifdef EFA_DEBUG 610 1.4 rkujawa aprint_normal("cmd0 %x, cmd3 %x\n", cmd0, cmd3); 611 1.4 rkujawa #endif /* EFA_DEBUG */ 612 1.4 rkujawa 613 1.4 rkujawa bus_space_unmap(fata_iot, pio_offsets[0], FATA1_CHAN_SIZE); 614 1.4 rkujawa bus_space_unmap(fata_iot, pio_offsets[3], FATA1_CHAN_SIZE); 615 1.4 rkujawa 616 1.4 rkujawa return rv; 617 1.4 rkujawa } 618 1.4 rkujawa 619