Home | History | Annotate | Line # | Download | only in dev
efa.c revision 1.17
      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