Home | History | Annotate | Line # | Download | only in dev
efa.c revision 1.4
      1  1.4  rkujawa /*	$NetBSD: efa.c,v 1.4 2011/10/30 11:10:42 rkujawa 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/malloc.h>
     45  1.1  rkujawa #include <sys/device.h>
     46  1.1  rkujawa #include <sys/bus.h>
     47  1.1  rkujawa #include <sys/proc.h>
     48  1.1  rkujawa #include <sys/kernel.h>
     49  1.1  rkujawa #include <sys/kthread.h>
     50  1.1  rkujawa 
     51  1.1  rkujawa #include <machine/cpu.h>
     52  1.1  rkujawa #include <machine/intr.h>
     53  1.1  rkujawa #include <sys/bswap.h>
     54  1.1  rkujawa 
     55  1.1  rkujawa #include <amiga/amiga/cia.h>
     56  1.1  rkujawa #include <amiga/amiga/custom.h>
     57  1.1  rkujawa #include <amiga/amiga/device.h>
     58  1.1  rkujawa #include <amiga/amiga/gayle.h>
     59  1.1  rkujawa #include <amiga/dev/zbusvar.h>
     60  1.1  rkujawa 
     61  1.1  rkujawa #include <dev/ata/atavar.h>
     62  1.1  rkujawa #include <dev/ic/wdcvar.h>
     63  1.1  rkujawa 
     64  1.1  rkujawa #include <amiga/dev/efareg.h>
     65  1.1  rkujawa #include <amiga/dev/efavar.h>
     66  1.1  rkujawa 
     67  1.3  rkujawa #define EFA_32BIT_IO 1
     68  1.1  rkujawa /* #define EFA_NO_INTR 1 */
     69  1.1  rkujawa /* #define EFA_DEBUG 1 */
     70  1.1  rkujawa 
     71  1.1  rkujawa int		efa_probe(device_t, cfdata_t, void *);
     72  1.1  rkujawa void		efa_attach(device_t, device_t, void *);
     73  1.1  rkujawa int		efa_intr(void *);
     74  1.1  rkujawa int		efa_intr_soft(void *arg);
     75  1.1  rkujawa static void	efa_set_opts(struct efa_softc *sc);
     76  1.1  rkujawa static bool	efa_mapbase(struct efa_softc *sc);
     77  1.1  rkujawa static bool	efa_mapreg_gayle(struct efa_softc *sc);
     78  1.1  rkujawa static bool	efa_mapreg_native(struct efa_softc *sc);
     79  1.1  rkujawa static void	efa_fata_subregion_pio0(struct wdc_regs *wdr_fata);
     80  1.1  rkujawa static void	efa_fata_subregion_pion(struct wdc_regs *wdr_fata, bool data32);
     81  1.1  rkujawa static void	efa_setup_channel(struct ata_channel *chp);
     82  1.1  rkujawa static void	efa_attach_channel(struct efa_softc *sc, int i);
     83  1.1  rkujawa static void	efa_select_regset(struct efa_softc *sc, int chnum,
     84  1.1  rkujawa 		    uint8_t piomode);
     85  1.1  rkujawa static void	efa_poll_kthread(void *arg);
     86  1.4  rkujawa static bool	efa_compare_status(void);
     87  1.1  rkujawa #ifdef EFA_DEBUG
     88  1.1  rkujawa static void	efa_debug_print_regmapping(struct wdc_regs *wdr_fata);
     89  1.1  rkujawa #endif /* EFA_DEBUG */
     90  1.1  rkujawa 
     91  1.1  rkujawa CFATTACH_DECL_NEW(efa, sizeof(struct efa_softc),
     92  1.1  rkujawa     efa_probe, efa_attach, NULL, NULL);
     93  1.1  rkujawa 
     94  1.1  rkujawa #define PIO_NSUPP		0xFFFFFFFF
     95  1.1  rkujawa 
     96  1.1  rkujawa static const bus_addr_t		pio_offsets[] =
     97  1.1  rkujawa     { FATA1_PIO0_OFF, PIO_NSUPP, PIO_NSUPP, FATA1_PIO3_OFF, FATA1_PIO4_OFF,
     98  1.1  rkujawa       FATA1_PIO5_OFF };
     99  1.1  rkujawa static const unsigned int	wdr_offsets_pio0[] =
    100  1.1  rkujawa     { FATA1_PIO0_OFF_DATA, FATA1_PIO0_OFF_ERROR, FATA1_PIO0_OFF_SECCNT,
    101  1.1  rkujawa       FATA1_PIO0_OFF_SECTOR, FATA1_PIO0_OFF_CYL_LO, FATA1_PIO0_OFF_CYL_HI,
    102  1.1  rkujawa       FATA1_PIO0_OFF_SDH, FATA1_PIO0_OFF_COMMAND };
    103  1.1  rkujawa static const unsigned int	wdr_offsets_pion[] =
    104  1.1  rkujawa     { FATA1_PION_OFF_DATA, FATA1_PION_OFF_ERROR, FATA1_PION_OFF_SECCNT,
    105  1.1  rkujawa       FATA1_PION_OFF_SECTOR, FATA1_PION_OFF_CYL_LO, FATA1_PION_OFF_CYL_HI,
    106  1.1  rkujawa       FATA1_PION_OFF_SDH, FATA1_PION_OFF_COMMAND };
    107  1.1  rkujawa static const unsigned int	wdr_offsets_pion32[] =
    108  1.1  rkujawa     { FATA1_PION_OFF_DATA32, FATA1_PION_OFF_ERROR, FATA1_PION_OFF_SECCNT,
    109  1.1  rkujawa       FATA1_PION_OFF_SECTOR, FATA1_PION_OFF_CYL_LO, FATA1_PION_OFF_CYL_HI,
    110  1.1  rkujawa       FATA1_PION_OFF_SDH, FATA1_PION_OFF_COMMAND };
    111  1.1  rkujawa 
    112  1.1  rkujawa int
    113  1.1  rkujawa efa_probe(device_t parent, cfdata_t cfp, void *aux)
    114  1.1  rkujawa {
    115  1.2  rkujawa 	/*
    116  1.2  rkujawa 	 * FastATA 1200 uses portions of Gayle IDE interface, and efa driver
    117  1.1  rkujawa 	 * can't coexist with wdc_amiga. Match "wdc" on an A1200, because
    118  1.2  rkujawa 	 * FastATA 1200 does not autoconfigure.
    119  1.2  rkujawa 	 */
    120  1.4  rkujawa 	if (!matchname(aux, "wdc") || !is_a1200())
    121  1.1  rkujawa 		return(0);
    122  1.1  rkujawa 
    123  1.4  rkujawa 	if (!efa_compare_status())
    124  1.4  rkujawa 		return(0);
    125  1.4  rkujawa 
    126  1.4  rkujawa #ifdef EFA_DEBUG
    127  1.4  rkujawa 	aprint_normal("efa_probe succeeded\n");
    128  1.4  rkujawa #endif /* EFA_DEBUG */
    129  1.4  rkujawa 
    130  1.1  rkujawa 	return 100;
    131  1.1  rkujawa }
    132  1.1  rkujawa 
    133  1.1  rkujawa void
    134  1.1  rkujawa efa_attach(device_t parent, device_t self, void *aux)
    135  1.1  rkujawa {
    136  1.1  rkujawa 	int i;
    137  1.1  rkujawa 	struct efa_softc *sc = device_private(self);
    138  1.1  rkujawa 
    139  1.1  rkujawa 	aprint_normal(": ELBOX FastATA 1200\n");
    140  1.1  rkujawa 
    141  1.1  rkujawa 	gayle_init();
    142  1.1  rkujawa 
    143  1.1  rkujawa 	sc->sc_dev = self;
    144  1.1  rkujawa 
    145  1.1  rkujawa 	efa_set_opts(sc);
    146  1.1  rkujawa 
    147  1.2  rkujawa 	if (!efa_mapbase(sc)) {
    148  1.1  rkujawa 		aprint_error_dev(self, "couldn't map base addresses\n");
    149  1.1  rkujawa 		return;
    150  1.1  rkujawa 	}
    151  1.2  rkujawa 	if (!efa_mapreg_gayle(sc)) {
    152  1.1  rkujawa 		aprint_error_dev(self, "couldn't map Gayle registers\n");
    153  1.1  rkujawa 		return;
    154  1.1  rkujawa 	}
    155  1.2  rkujawa 	if (!efa_mapreg_native(sc)) {
    156  1.1  rkujawa 		aprint_error_dev(self, "couldn't map FastATA regsters\n");
    157  1.1  rkujawa 		return;
    158  1.1  rkujawa 	}
    159  1.1  rkujawa 
    160  1.1  rkujawa 	sc->sc_wdcdev.sc_atac.atac_pio_cap = 5;
    161  1.1  rkujawa 	sc->sc_wdcdev.sc_atac.atac_nchannels = FATA1_CHANNELS;
    162  1.1  rkujawa 	sc->sc_wdcdev.sc_atac.atac_set_modes = efa_setup_channel;
    163  1.1  rkujawa 	sc->sc_wdcdev.sc_atac.atac_dev = self;
    164  1.1  rkujawa 	sc->sc_wdcdev.sc_atac.atac_channels = sc->sc_chanlist;
    165  1.3  rkujawa 	sc->sc_wdcdev.sc_atac.atac_cap = ATAC_CAP_DATA16;
    166  1.1  rkujawa 
    167  1.2  rkujawa 	if (sc->sc_32bit_io)
    168  1.3  rkujawa 		sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_DATA32;
    169  1.3  rkujawa 
    170  1.1  rkujawa 	/*
    171  1.1  rkujawa 	 * The following should work for polling mode, but it does not.
    172  1.2  rkujawa 	 * if (sc->sc_no_intr)
    173  1.1  rkujawa 	 *	sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_NOIRQ;
    174  1.1  rkujawa 	 */
    175  1.1  rkujawa 
    176  1.1  rkujawa 	wdc_allocate_regs(&sc->sc_wdcdev);
    177  1.1  rkujawa 
    178  1.1  rkujawa 	sc->sc_intreg = &gayle.intreq;
    179  1.1  rkujawa 
    180  1.2  rkujawa 	for (i = 0; i < FATA1_CHANNELS; i++)
    181  1.1  rkujawa 		efa_attach_channel(sc, i);
    182  1.1  rkujawa 
    183  1.2  rkujawa 	if (sc->sc_no_intr) {
    184  1.1  rkujawa 		sc->sc_fata_softintr = softint_establish(SOFTINT_BIO,
    185  1.1  rkujawa 		    (void (*)(void *))efa_intr_soft, sc);
    186  1.1  rkujawa 		if (sc->sc_fata_softintr == NULL) {
    187  1.1  rkujawa 			aprint_error_dev(self, "couldn't create soft intr\n");
    188  1.1  rkujawa 			return;
    189  1.1  rkujawa 		}
    190  1.1  rkujawa 		if (kthread_create(PRI_NONE, 0, NULL, efa_poll_kthread, sc,
    191  1.1  rkujawa 		    NULL, "efa")) {
    192  1.1  rkujawa 			aprint_error_dev(self, "couldn't create kthread\n");
    193  1.1  rkujawa 			return;
    194  1.1  rkujawa 		}
    195  1.1  rkujawa 	} else {
    196  1.1  rkujawa 		sc->sc_isr.isr_intr = efa_intr;
    197  1.1  rkujawa 		sc->sc_isr.isr_arg = sc;
    198  1.1  rkujawa 		sc->sc_isr.isr_ipl = 2;
    199  1.1  rkujawa 		add_isr (&sc->sc_isr);
    200  1.1  rkujawa 		gayle.intena |= GAYLE_INT_IDE;
    201  1.1  rkujawa 	}
    202  1.1  rkujawa 
    203  1.1  rkujawa }
    204  1.1  rkujawa 
    205  1.1  rkujawa static void
    206  1.1  rkujawa efa_attach_channel(struct efa_softc *sc, int chnum)
    207  1.1  rkujawa {
    208  1.1  rkujawa 	sc->sc_chanlist[chnum] = &sc->sc_ports[chnum].chan;
    209  1.1  rkujawa 
    210  1.1  rkujawa 	sc->sc_ports[chnum].chan.ch_channel = chnum;
    211  1.1  rkujawa 	sc->sc_ports[chnum].chan.ch_atac = &sc->sc_wdcdev.sc_atac;
    212  1.1  rkujawa 	sc->sc_ports[chnum].chan.ch_queue = &sc->sc_ports[chnum].queue;
    213  1.1  rkujawa 	sc->sc_ports[chnum].chan.ch_ndrive = 2;
    214  1.1  rkujawa 
    215  1.2  rkujawa 	if (!sc->sc_32bit_io)
    216  1.1  rkujawa 		efa_select_regset(sc, chnum, 0); /* Start in PIO0. */
    217  1.1  rkujawa 	else
    218  1.1  rkujawa 		efa_select_regset(sc, chnum, 3);
    219  1.1  rkujawa 
    220  1.1  rkujawa 	wdc_init_shadow_regs(&sc->sc_ports[chnum].chan);
    221  1.1  rkujawa 
    222  1.1  rkujawa 	wdcattach(&sc->sc_ports[chnum].chan);
    223  1.1  rkujawa 
    224  1.1  rkujawa #ifdef EFA_DEBUG
    225  1.1  rkujawa 	aprint_normal_dev(sc->sc_dev, "done init for channel %d\n", chnum);
    226  1.1  rkujawa #endif
    227  1.1  rkujawa 
    228  1.1  rkujawa }
    229  1.1  rkujawa 
    230  1.1  rkujawa /* TODO: convert to callout(9) */
    231  1.1  rkujawa static void
    232  1.1  rkujawa efa_poll_kthread(void *arg)
    233  1.1  rkujawa {
    234  1.1  rkujawa 	struct efa_softc *sc = arg;
    235  1.1  rkujawa 
    236  1.2  rkujawa 	for (;;) {
    237  1.1  rkujawa 		/* TODO: actually check if interrupt status register is set */
    238  1.1  rkujawa 		softint_schedule(sc->sc_fata_softintr);
    239  1.1  rkujawa 		/* TODO: convert to kpause */
    240  1.1  rkujawa 		tsleep(arg, PWAIT, "efa_poll", hz);
    241  1.1  rkujawa 	}
    242  1.1  rkujawa }
    243  1.1  rkujawa 
    244  1.1  rkujawa static void
    245  1.1  rkujawa efa_set_opts(struct efa_softc *sc)
    246  1.1  rkujawa {
    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.1  rkujawa 		aprint_verbose_dev(sc->sc_dev, "hardware interrupt disabled\n");
    261  1.1  rkujawa 
    262  1.2  rkujawa 	if (sc->sc_32bit_io)
    263  1.1  rkujawa 		aprint_verbose_dev(sc->sc_dev, "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.2  rkujawa 	u_char intreq;
    291  1.1  rkujawa 
    292  1.2  rkujawa 	intreq = *sc->sc_intreg;
    293  1.2  rkujawa 	ret = 0;
    294  1.1  rkujawa 
    295  1.1  rkujawa 	if (intreq & GAYLE_INT_IDE) {
    296  1.1  rkujawa 		gayle.intreq = 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 	int i, j;
    311  1.1  rkujawa 	static struct bus_space_tag fata_cmd_iot;
    312  1.1  rkujawa 	static struct bus_space_tag gayle_cmd_iot;
    313  1.1  rkujawa 
    314  1.1  rkujawa 	gayle_cmd_iot.base = (bus_addr_t) ztwomap(GAYLE_IDE_BASE + 2);
    315  1.1  rkujawa 	gayle_cmd_iot.absm = &amiga_bus_stride_4swap;
    316  1.1  rkujawa 	fata_cmd_iot.base = (bus_addr_t) ztwomap(FATA1_BASE);
    317  1.1  rkujawa 	fata_cmd_iot.absm = &amiga_bus_stride_4swap;
    318  1.1  rkujawa 
    319  1.1  rkujawa #ifdef EFA_DEBUG
    320  1.1  rkujawa 	aprint_normal_dev(sc->sc_dev, "Gayle %x -> %x, FastATA %x -> %x\n",
    321  1.1  rkujawa 	    GAYLE_IDE_BASE, gayle_cmd_iot.base, FATA1_BASE, fata_cmd_iot.base);
    322  1.1  rkujawa #endif
    323  1.1  rkujawa 
    324  1.2  rkujawa 	if (!gayle_cmd_iot.base)
    325  1.1  rkujawa 		return false;
    326  1.2  rkujawa 	if (!fata_cmd_iot.base)
    327  1.1  rkujawa 		return false;
    328  1.1  rkujawa 
    329  1.1  rkujawa 	sc->sc_gayle_wdc_regs.cmd_iot = &gayle_cmd_iot;
    330  1.1  rkujawa 	sc->sc_gayle_wdc_regs.ctl_iot = &gayle_cmd_iot;
    331  1.1  rkujawa 
    332  1.2  rkujawa 	for (i = 0; i < FATA1_CHANNELS; i++) {
    333  1.2  rkujawa 		for (j = 0; j < PIO_COUNT; j++) {
    334  1.1  rkujawa 			sc->sc_ports[i].wdr[j].cmd_iot = &fata_cmd_iot;
    335  1.3  rkujawa 			sc->sc_ports[i].wdr[j].data32iot = &fata_cmd_iot;
    336  1.1  rkujawa 			sc->sc_ports[i].wdr[j].ctl_iot = &gayle_cmd_iot;
    337  1.1  rkujawa 		}
    338  1.1  rkujawa 	}
    339  1.1  rkujawa 
    340  1.1  rkujawa 	return true;
    341  1.1  rkujawa }
    342  1.1  rkujawa 
    343  1.1  rkujawa 
    344  1.1  rkujawa /* Gayle IDE register mapping, we need it anyway. */
    345  1.1  rkujawa static bool
    346  1.1  rkujawa efa_mapreg_gayle(struct efa_softc *sc)
    347  1.1  rkujawa {
    348  1.1  rkujawa 	int i;
    349  1.1  rkujawa 
    350  1.1  rkujawa 	struct wdc_regs *wdr = &sc->sc_gayle_wdc_regs;
    351  1.1  rkujawa 
    352  1.1  rkujawa 	if (bus_space_map(wdr->cmd_iot, 0, 0x40, 0,
    353  1.2  rkujawa 	    &wdr->cmd_baseioh)) {
    354  1.1  rkujawa 		return false;
    355  1.1  rkujawa 	}
    356  1.1  rkujawa 
    357  1.1  rkujawa 	for (i = 0; i < WDC_NREG; i++) {
    358  1.1  rkujawa 		if (bus_space_subregion(wdr->cmd_iot,
    359  1.1  rkujawa 		    wdr->cmd_baseioh, i, i == 0 ? 4 : 1,
    360  1.1  rkujawa 		    &wdr->cmd_iohs[i]) != 0) {
    361  1.1  rkujawa 
    362  1.1  rkujawa 			bus_space_unmap(wdr->cmd_iot,
    363  1.1  rkujawa 			    wdr->cmd_baseioh, 0x40);
    364  1.1  rkujawa 			return false;
    365  1.1  rkujawa 		}
    366  1.1  rkujawa 	}
    367  1.1  rkujawa 
    368  1.1  rkujawa 	if (bus_space_subregion(wdr->cmd_iot,
    369  1.1  rkujawa 	    wdr->cmd_baseioh, 0x406, 1, &wdr->ctl_ioh))
    370  1.1  rkujawa 		return false;
    371  1.1  rkujawa 
    372  1.1  rkujawa 	return true;
    373  1.1  rkujawa }
    374  1.1  rkujawa 
    375  1.1  rkujawa /* Native FastATA register mapping, suitable for PIO modes 0 to 5. */
    376  1.1  rkujawa static bool
    377  1.2  rkujawa efa_mapreg_native(struct efa_softc *sc)
    378  1.2  rkujawa {
    379  1.1  rkujawa 	int i,j;
    380  1.1  rkujawa 	struct wdc_regs *wdr_gayle = &sc->sc_gayle_wdc_regs;
    381  1.1  rkujawa 	struct wdc_regs *wdr_fata;
    382  1.1  rkujawa 
    383  1.2  rkujawa 	for (i = 0; i < FATA1_CHANNELS; i++) {
    384  1.1  rkujawa 
    385  1.2  rkujawa 		for (j = 0; j < PIO_COUNT; j++) {
    386  1.1  rkujawa 
    387  1.1  rkujawa 			wdr_fata = &sc->sc_ports[i].wdr[j];
    388  1.1  rkujawa 			sc->sc_ports[i].mode_ok[j] = false;
    389  1.1  rkujawa 
    390  1.2  rkujawa 			if (pio_offsets[j] == PIO_NSUPP) {
    391  1.1  rkujawa #ifdef EFA_DEBUG
    392  1.1  rkujawa 				aprint_normal_dev(sc->sc_dev,
    393  1.1  rkujawa 				    "Skipping mapping for PIO mode %x\n", j);
    394  1.1  rkujawa #endif
    395  1.1  rkujawa 				continue;
    396  1.1  rkujawa 			}
    397  1.1  rkujawa 
    398  1.2  rkujawa 			if (bus_space_map(wdr_fata->cmd_iot,
    399  1.1  rkujawa 			    pio_offsets[j] + FATA1_CHAN_SIZE * i,
    400  1.1  rkujawa 			    FATA1_CHAN_SIZE, 0, &wdr_fata->cmd_baseioh)) {
    401  1.1  rkujawa 			    return false;
    402  1.1  rkujawa 			}
    403  1.1  rkujawa #ifdef EFA_DEBUG
    404  1.1  rkujawa 			aprint_normal_dev(sc->sc_dev,
    405  1.1  rkujawa 			    "Chan %x PIO mode %x mapped %x -> %x\n",
    406  1.1  rkujawa 			    i, j, (bus_addr_t) kvtop((void*)
    407  1.1  rkujawa 			    wdr_fata->cmd_baseioh), (unsigned int)
    408  1.1  rkujawa 			    wdr_fata->cmd_baseioh);
    409  1.1  rkujawa #endif
    410  1.1  rkujawa 
    411  1.1  rkujawa 			sc->sc_ports[i].mode_ok[j] = true;
    412  1.1  rkujawa 
    413  1.2  rkujawa 			if (j == 0)
    414  1.1  rkujawa 				efa_fata_subregion_pio0(wdr_fata);
    415  1.1  rkujawa 			else {
    416  1.2  rkujawa 				if (sc->sc_32bit_io)
    417  1.1  rkujawa 					efa_fata_subregion_pion(wdr_fata,
    418  1.1  rkujawa 					    true);
    419  1.1  rkujawa 				else
    420  1.1  rkujawa 					efa_fata_subregion_pion(wdr_fata,
    421  1.1  rkujawa 					    false);
    422  1.1  rkujawa 
    423  1.1  rkujawa 				bus_space_subregion(wdr_fata->cmd_iot,
    424  1.1  rkujawa 				    wdr_fata->cmd_baseioh, FATA1_PION_OFF_INTST,
    425  1.1  rkujawa 				    1, &sc->sc_ports[i].intst[j]);
    426  1.1  rkujawa 			}
    427  1.1  rkujawa 
    428  1.1  rkujawa 			/* No 32-bit register for PIO0 ... */
    429  1.2  rkujawa 			if (j == 0 && sc->sc_32bit_io)
    430  1.1  rkujawa 				sc->sc_ports[i].mode_ok[j] = false;
    431  1.1  rkujawa 
    432  1.1  rkujawa 			wdr_fata->ctl_ioh = wdr_gayle->ctl_ioh;
    433  1.1  rkujawa 		};
    434  1.1  rkujawa 	}
    435  1.1  rkujawa 	return true;
    436  1.1  rkujawa }
    437  1.1  rkujawa 
    438  1.1  rkujawa 
    439  1.1  rkujawa static void
    440  1.1  rkujawa efa_fata_subregion_pio0(struct wdc_regs *wdr_fata)
    441  1.1  rkujawa {
    442  1.1  rkujawa 
    443  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    444  1.1  rkujawa 	    FATA1_PIO0_OFF_DATA, 4, &wdr_fata->cmd_iohs[wd_data]);
    445  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    446  1.1  rkujawa 	    FATA1_PIO0_OFF_ERROR, 1, &wdr_fata->cmd_iohs[wd_error]);
    447  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    448  1.1  rkujawa 	    FATA1_PIO0_OFF_SECCNT, 1, &wdr_fata->cmd_iohs[wd_seccnt]);
    449  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    450  1.1  rkujawa 	    FATA1_PIO0_OFF_SECTOR, 1, &wdr_fata->cmd_iohs[wd_sector]);
    451  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    452  1.1  rkujawa 	    FATA1_PIO0_OFF_CYL_LO, 1, &wdr_fata->cmd_iohs[wd_cyl_lo]);
    453  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    454  1.1  rkujawa 	    FATA1_PIO0_OFF_CYL_HI, 1, &wdr_fata->cmd_iohs[wd_cyl_hi]);
    455  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    456  1.1  rkujawa 	    FATA1_PIO0_OFF_SDH, 1, &wdr_fata->cmd_iohs[wd_sdh]);
    457  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    458  1.1  rkujawa 	    FATA1_PIO0_OFF_COMMAND, 1, &wdr_fata->cmd_iohs[wd_command]);
    459  1.1  rkujawa }
    460  1.1  rkujawa 
    461  1.1  rkujawa static void
    462  1.1  rkujawa efa_fata_subregion_pion(struct wdc_regs *wdr_fata, bool data32)
    463  1.1  rkujawa {
    464  1.2  rkujawa 	if (data32)
    465  1.1  rkujawa 		bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    466  1.3  rkujawa 		    FATA1_PION_OFF_DATA32, 8, &wdr_fata->data32ioh);
    467  1.1  rkujawa 
    468  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    469  1.3  rkujawa     	    FATA1_PION_OFF_DATA, 4, &wdr_fata->cmd_iohs[wd_data]);
    470  1.3  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    471  1.1  rkujawa 	    FATA1_PION_OFF_ERROR, 1, &wdr_fata->cmd_iohs[wd_error]);
    472  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    473  1.1  rkujawa 	    FATA1_PION_OFF_SECCNT, 1, &wdr_fata->cmd_iohs[wd_seccnt]);
    474  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    475  1.1  rkujawa 	    FATA1_PION_OFF_SECTOR, 1, &wdr_fata->cmd_iohs[wd_sector]);
    476  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    477  1.1  rkujawa 	    FATA1_PION_OFF_CYL_LO, 1, &wdr_fata->cmd_iohs[wd_cyl_lo]);
    478  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    479  1.1  rkujawa 	    FATA1_PION_OFF_CYL_HI, 1, &wdr_fata->cmd_iohs[wd_cyl_hi]);
    480  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    481  1.1  rkujawa 	    FATA1_PION_OFF_SDH, 1, &wdr_fata->cmd_iohs[wd_sdh]);
    482  1.1  rkujawa 	bus_space_subregion(wdr_fata->cmd_iot, wdr_fata->cmd_baseioh,
    483  1.1  rkujawa 	    FATA1_PION_OFF_COMMAND, 1, &wdr_fata->cmd_iohs[wd_command]);
    484  1.1  rkujawa }
    485  1.1  rkujawa 
    486  1.1  rkujawa static void
    487  1.1  rkujawa efa_setup_channel(struct ata_channel *chp)
    488  1.1  rkujawa {
    489  1.1  rkujawa 	int drive, chnum;
    490  1.1  rkujawa 	uint8_t mode;
    491  1.1  rkujawa 	struct atac_softc *atac;
    492  1.1  rkujawa 	struct ata_drive_datas *drvp;
    493  1.1  rkujawa 	struct efa_softc *sc;
    494  1.1  rkujawa 	int ipl;
    495  1.1  rkujawa 
    496  1.1  rkujawa 	chnum = chp->ch_channel;
    497  1.1  rkujawa 	atac = chp->ch_atac;
    498  1.1  rkujawa 	sc = device_private(atac->atac_dev);
    499  1.1  rkujawa 
    500  1.1  rkujawa 	mode = 5; /* start with fastest possible setting */
    501  1.1  rkujawa 
    502  1.1  rkujawa #ifdef EFA_DEBUG
    503  1.1  rkujawa 	aprint_normal_dev(sc->sc_dev, "efa_setup_channel for ch %d\n",
    504  1.1  rkujawa 	    chnum);
    505  1.1  rkujawa #endif /* EFA_DEBUG */
    506  1.1  rkujawa 
    507  1.1  rkujawa 	/* We might be in the middle of something... so raise IPL. */
    508  1.1  rkujawa 	ipl = splvm();
    509  1.1  rkujawa 
    510  1.1  rkujawa 	for (drive = 0; drive < 2; drive++) {
    511  1.1  rkujawa 		drvp = &chp->ch_drive[drive];
    512  1.1  rkujawa 
    513  1.1  rkujawa 		if ((drvp->drive_flags & DRIVE) == 0)
    514  1.1  rkujawa 			continue; /* nothing to see here */
    515  1.1  rkujawa 
    516  1.2  rkujawa 		if (drvp->PIO_cap < mode);
    517  1.1  rkujawa 			mode = drvp->PIO_cap;
    518  1.1  rkujawa 
    519  1.1  rkujawa 		/* TODO: check if sc_ports->mode_ok */
    520  1.1  rkujawa 
    521  1.1  rkujawa #ifdef EFA_DEBUG
    522  1.1  rkujawa 		aprint_normal_dev(sc->sc_dev, "drive %d supports %d\n",
    523  1.1  rkujawa 		    drive, drvp->PIO_cap);
    524  1.1  rkujawa #endif /* EFA_DEBUG */
    525  1.1  rkujawa 
    526  1.1  rkujawa 		drvp->PIO_mode = mode;
    527  1.1  rkujawa 	}
    528  1.1  rkujawa 
    529  1.1  rkujawa 	/* Change FastATA register set. */
    530  1.1  rkujawa 	efa_select_regset(sc, chnum, mode);
    531  1.1  rkujawa 	/* re-init shadow regs */
    532  1.1  rkujawa 	wdc_init_shadow_regs(&sc->sc_ports[chnum].chan);
    533  1.1  rkujawa 
    534  1.1  rkujawa 	splx(ipl);
    535  1.1  rkujawa }
    536  1.1  rkujawa 
    537  1.1  rkujawa static void
    538  1.1  rkujawa efa_select_regset(struct efa_softc *sc, int chnum, uint8_t piomode)
    539  1.1  rkujawa {
    540  1.1  rkujawa 	struct wdc_softc *wdc;
    541  1.1  rkujawa 
    542  1.1  rkujawa 	wdc = CHAN_TO_WDC(&sc->sc_ports[chnum].chan);
    543  1.1  rkujawa 	wdc->regs[chnum] = sc->sc_ports[chnum].wdr[piomode];
    544  1.1  rkujawa 
    545  1.1  rkujawa #ifdef EFA_DEBUG
    546  1.1  rkujawa 	aprint_normal_dev(sc->sc_dev, "switched ch %d to PIO %d\n",
    547  1.1  rkujawa 	    chnum, piomode);
    548  1.1  rkujawa 
    549  1.1  rkujawa 	efa_debug_print_regmapping(&wdc->regs[chnum]);
    550  1.1  rkujawa #endif /* EFA_DEBUG */
    551  1.1  rkujawa }
    552  1.1  rkujawa 
    553  1.1  rkujawa #ifdef EFA_DEBUG
    554  1.1  rkujawa static void
    555  1.1  rkujawa efa_debug_print_regmapping(struct wdc_regs *wdr_fata)
    556  1.1  rkujawa {
    557  1.1  rkujawa 	int i;
    558  1.1  rkujawa 	aprint_normal("base %x->%x",
    559  1.1  rkujawa 	    (bus_addr_t) kvtop((void*) wdr_fata->cmd_baseioh),
    560  1.1  rkujawa 	    (bus_addr_t) wdr_fata->cmd_baseioh);
    561  1.1  rkujawa 	for (i = 0; i < WDC_NREG; i++) {
    562  1.1  rkujawa 		aprint_normal("reg %x, %x->%x, ", i,
    563  1.1  rkujawa 		    (bus_addr_t) kvtop((void*) wdr_fata->cmd_iohs[i]),
    564  1.1  rkujawa 		    (bus_addr_t) wdr_fata->cmd_iohs[i]);
    565  1.1  rkujawa 	}
    566  1.1  rkujawa 	aprint_normal("\n");
    567  1.1  rkujawa }
    568  1.1  rkujawa #endif /* EFA_DEBUG */
    569  1.1  rkujawa 
    570  1.4  rkujawa /* Compare the values of (status) command register in PIO0, PIO3 sets. */
    571  1.4  rkujawa static bool
    572  1.4  rkujawa efa_compare_status(void)
    573  1.4  rkujawa {
    574  1.4  rkujawa 	uint8_t cmd0, cmd3;
    575  1.4  rkujawa 	struct bus_space_tag fata_bst;
    576  1.4  rkujawa 	bus_space_tag_t fata_iot;
    577  1.4  rkujawa 	bus_space_handle_t cmd0_ioh, cmd3_ioh;
    578  1.4  rkujawa 	bool rv;
    579  1.4  rkujawa 
    580  1.4  rkujawa 	rv = false;
    581  1.4  rkujawa 
    582  1.4  rkujawa 	fata_bst.base = (bus_addr_t) ztwomap(FATA1_BASE);
    583  1.4  rkujawa 	fata_bst.absm = &amiga_bus_stride_4swap;
    584  1.4  rkujawa 
    585  1.4  rkujawa 	fata_iot = &fata_bst;
    586  1.4  rkujawa 
    587  1.4  rkujawa 	if (bus_space_map(fata_iot, pio_offsets[0], FATA1_CHAN_SIZE, 0,
    588  1.4  rkujawa 	    &cmd0_ioh))
    589  1.4  rkujawa 		return false;
    590  1.4  rkujawa 	if (bus_space_map(fata_iot, pio_offsets[3], FATA1_CHAN_SIZE, 0,
    591  1.4  rkujawa 	    &cmd3_ioh))
    592  1.4  rkujawa 		return false;
    593  1.4  rkujawa 
    594  1.4  rkujawa #ifdef EFA_DEBUG
    595  1.4  rkujawa 	aprint_normal("probing for FastATA at %x, %x: ", (bus_addr_t) cmd0_ioh,
    596  1.4  rkujawa 	    (bus_addr_t) cmd3_ioh);
    597  1.4  rkujawa #endif /* EFA_DEBUG */
    598  1.4  rkujawa 
    599  1.4  rkujawa 	cmd0 = bus_space_read_1(fata_iot, cmd0_ioh, FATA1_PIO0_OFF_COMMAND);
    600  1.4  rkujawa 	cmd3 = bus_space_read_1(fata_iot, cmd3_ioh, FATA1_PION_OFF_COMMAND);
    601  1.4  rkujawa 
    602  1.4  rkujawa 	if (cmd0 == cmd3)
    603  1.4  rkujawa 		rv = true;
    604  1.4  rkujawa 
    605  1.4  rkujawa 	if ( (cmd0 == 0xFF) || (cmd0 == 0x00) ) {
    606  1.4  rkujawa 		/* Assume there's nothing there... */
    607  1.4  rkujawa 		rv = false;
    608  1.4  rkujawa 	}
    609  1.4  rkujawa 
    610  1.4  rkujawa #ifdef EFA_DEBUG
    611  1.4  rkujawa 	aprint_normal("cmd0 %x, cmd3 %x\n", cmd0, cmd3);
    612  1.4  rkujawa #endif /* EFA_DEBUG */
    613  1.4  rkujawa 
    614  1.4  rkujawa 	bus_space_unmap(fata_iot, pio_offsets[0], FATA1_CHAN_SIZE);
    615  1.4  rkujawa 	bus_space_unmap(fata_iot, pio_offsets[3], FATA1_CHAN_SIZE);
    616  1.4  rkujawa 
    617  1.4  rkujawa 	return rv;
    618  1.4  rkujawa }
    619  1.4  rkujawa 
    620