Home | History | Annotate | Line # | Download | only in vr
vrgiu.c revision 1.18
      1  1.18      sato /*	$NetBSD: vrgiu.c,v 1.18 2001/04/18 11:11:11 sato Exp $	*/
      2   1.1  takemura /*-
      3   1.1  takemura  * Copyright (c) 1999
      4   1.1  takemura  *         Shin Takemura and PocketBSD Project. All rights reserved.
      5   1.1  takemura  *
      6   1.1  takemura  * Redistribution and use in source and binary forms, with or without
      7   1.1  takemura  * modification, are permitted provided that the following conditions
      8   1.1  takemura  * are met:
      9   1.1  takemura  * 1. Redistributions of source code must retain the above copyright
     10   1.1  takemura  *    notice, this list of conditions and the following disclaimer.
     11   1.1  takemura  * 2. Redistributions in binary form must reproduce the above copyright
     12   1.1  takemura  *    notice, this list of conditions and the following disclaimer in the
     13   1.1  takemura  *    documentation and/or other materials provided with the distribution.
     14   1.1  takemura  * 3. All advertising materials mentioning features or use of this software
     15   1.1  takemura  *    must display the following acknowledgement:
     16   1.1  takemura  *	This product includes software developed by the PocketBSD project
     17   1.1  takemura  *	and its contributors.
     18   1.1  takemura  * 4. Neither the name of the project nor the names of its contributors
     19   1.1  takemura  *    may be used to endorse or promote products derived from this software
     20   1.1  takemura  *    without specific prior written permission.
     21   1.1  takemura  *
     22   1.1  takemura  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     23   1.1  takemura  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     24   1.1  takemura  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     25   1.1  takemura  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     26   1.1  takemura  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     27   1.1  takemura  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     28   1.1  takemura  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     29   1.1  takemura  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     30   1.1  takemura  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     31   1.1  takemura  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     32   1.1  takemura  * SUCH DAMAGE.
     33   1.1  takemura  *
     34   1.1  takemura  */
     35   1.1  takemura 
     36   1.1  takemura #include <sys/param.h>
     37   1.1  takemura #include <sys/systm.h>
     38   1.1  takemura #include <sys/device.h>
     39   1.1  takemura #include <sys/malloc.h>
     40  1.14      sato #include <sys/queue.h>
     41  1.15      sato #include <sys/reboot.h>
     42  1.14      sato 
     43   1.1  takemura #define	TAILQ_EMPTY(head) ((head)->tqh_first == NULL)
     44   1.1  takemura 
     45   1.1  takemura #include <mips/cpuregs.h>
     46   1.1  takemura #include <machine/bus.h>
     47  1.16      sato #include <machine/config_hook.h>
     48   1.1  takemura 
     49  1.18      sato #include "opt_vr41xx.h"
     50  1.18      sato #include <hpcmips/vr/vrcpudef.h>
     51   1.1  takemura #include <hpcmips/vr/vripreg.h>
     52   1.1  takemura #include <hpcmips/vr/vripvar.h>
     53   1.1  takemura #include <hpcmips/vr/vrgiureg.h>
     54   1.1  takemura 
     55   1.1  takemura #include "locators.h"
     56   1.1  takemura 
     57   1.3  takemura #define VRGIUDEBUG
     58   1.1  takemura #ifdef VRGIUDEBUG
     59   1.3  takemura #define DEBUG_IO	1
     60   1.3  takemura #define DEBUG_INTR	2
     61   1.7      sato #ifndef VRGIUDEBUG_CONF
     62  1.10      sato #define VRGIUDEBUG_CONF 0
     63   1.7      sato #endif /* VRGIUDEBUG_CONF */
     64   1.7      sato int	vrgiu_debug = VRGIUDEBUG_CONF;
     65   1.3  takemura #define	DPRINTF(flag, arg) if (vrgiu_debug & flag) printf arg;
     66   1.9      sato #define DDUMP_IO(flag, sc) if (vrgiu_debug & flag) vrgiu_dump_io(sc);
     67   1.9      sato #define DDUMP_IOSETTING(flag, sc) \
     68  1.10      sato 		if (vrgiu_debug & flag) vrgiu_dump_iosetting(sc);
     69  1.10      sato #define	VPRINTF(flag, arg) \
     70  1.12  jdolecek 		if (bootverbose || vrgiu_debug & flag) printf arg;
     71  1.10      sato #define VDUMP_IO(flag, sc) \
     72  1.12  jdolecek 		if (bootverbose || vrgiu_debug & flag) vrgiu_dump_io(sc);
     73  1.10      sato #define VDUMP_IOSETTING(flag, sc) \
     74  1.12  jdolecek 		if (bootverbose || vrgiu_debug & flag) vrgiu_dump_iosetting(sc);
     75   1.1  takemura #else
     76   1.3  takemura #define	DPRINTF(flag, arg)
     77   1.9      sato #define DDUMP_IO(flag, sc)
     78   1.9      sato #define DDUMP_IOSETTING(flag, sc)
     79  1.12  jdolecek #define	VPRINTF(flag, arg) if (bootverbose) printf arg;
     80  1.12  jdolecek #define VDUMP_IO(flag, sc) if (bootverbose) vrgiu_dump_io(sc);
     81  1.10      sato #define VDUMP_IOSETTING(flag, sc) \
     82  1.12  jdolecek 			if (bootverbose) vrgiu_dump_iosetting(sc);
     83   1.1  takemura #endif
     84   1.1  takemura 
     85  1.16      sato #ifdef VRGIU_INTR_NOLED
     86  1.16      sato int vrgiu_intr_led = 0;
     87  1.16      sato #else /* VRGIU_INTR_NOLED */
     88  1.16      sato int vrgiu_intr_led = 1;
     89  1.16      sato #endif /* VRGIU_INTR_NOLED */
     90  1.16      sato 
     91   1.1  takemura #define	LEGAL_INTR_PORT(x)	((x) >= 0 && (x) < MAX_GPIO_INOUT)
     92   1.1  takemura #define	LEGAL_OUT_PORT(x)	((x) >= 0 && (x) < MAX_GPIO_OUT)
     93   1.1  takemura 
     94   1.1  takemura int vrgiu_match __P((struct device*, struct cfdata*, void*));
     95   1.1  takemura void vrgiu_attach __P((struct device*, struct device*, void*));
     96   1.1  takemura int vrgiu_intr __P((void*));
     97   1.1  takemura int vrgiu_print __P((void*, const char*));
     98   1.1  takemura void vrgiu_callback __P((struct device*));
     99   1.1  takemura 
    100  1.14      sato void	vrgiu_dump_regs __P((struct vrgiu_softc *sc));
    101  1.14      sato void	vrgiu_dump_io __P((struct vrgiu_softc *sc));
    102  1.14      sato void	vrgiu_diff_io __P((void));
    103  1.14      sato void	vrgiu_dump_iosetting __P((struct vrgiu_softc *sc));
    104  1.14      sato void	vrgiu_diff_iosetting __P((void));
    105   1.1  takemura u_int32_t vrgiu_regread_4 __P((vrgiu_chipset_tag_t, bus_addr_t));
    106   1.3  takemura u_int16_t vrgiu_regread __P((vrgiu_chipset_tag_t, bus_addr_t));
    107   1.1  takemura void	vrgiu_regwrite_4 __P((vrgiu_chipset_tag_t, bus_addr_t, u_int32_t));
    108   1.3  takemura void	vrgiu_regwrite __P((vrgiu_chipset_tag_t, bus_addr_t, u_int16_t));
    109   1.1  takemura 
    110   1.4  takemura int vrgiu_port_read __P((vrgiu_chipset_tag_t, int));
    111   1.4  takemura int vrgiu_port_write __P((vrgiu_chipset_tag_t, int, int));
    112   1.1  takemura 
    113   1.1  takemura void *vrgiu_intr_establish __P((vrgiu_chipset_tag_t, int, int, int, int (*)(void *), void*));
    114   1.1  takemura void vrgiu_intr_disestablish __P((vrgiu_chipset_tag_t, void*));
    115   1.1  takemura 
    116   1.1  takemura struct vrgiu_function_tag vrgiu_functions = {
    117   1.1  takemura 	vrgiu_port_read,
    118   1.1  takemura 	vrgiu_port_write,
    119   1.1  takemura 	vrgiu_regread_4,
    120   1.1  takemura 	vrgiu_regwrite_4,
    121   1.1  takemura 	vrgiu_intr_establish,
    122   1.1  takemura 	vrgiu_intr_disestablish
    123   1.1  takemura };
    124   1.1  takemura 
    125   1.1  takemura struct cfattach vrgiu_ca = {
    126   1.1  takemura 	sizeof(struct vrgiu_softc), vrgiu_match, vrgiu_attach
    127   1.1  takemura };
    128   1.1  takemura 
    129  1.14      sato struct vrgiu_softc *this_giu;
    130  1.14      sato 
    131   1.1  takemura int
    132   1.1  takemura vrgiu_match(parent, cf, aux)
    133   1.1  takemura 	struct device *parent;
    134   1.1  takemura 	struct cfdata *cf;
    135   1.1  takemura 	void *aux;
    136   1.1  takemura {
    137   1.1  takemura 	return 2; /* 1st attach group of vrip */
    138   1.1  takemura }
    139   1.1  takemura 
    140   1.1  takemura void
    141   1.1  takemura vrgiu_attach(parent, self, aux)
    142   1.1  takemura 	struct device *parent;
    143   1.1  takemura 	struct device *self;
    144   1.1  takemura 	void *aux;
    145   1.1  takemura {
    146   1.1  takemura 	struct vrip_attach_args *va = aux;
    147   1.1  takemura 	struct vrgiu_softc *sc = (void*)self;
    148   1.1  takemura 	struct gpbus_attach_args gpa;
    149   1.1  takemura 	int i;
    150   1.1  takemura 
    151  1.14      sato 	this_giu = sc;
    152   1.1  takemura 	sc->sc_vc = va->va_vc;
    153   1.1  takemura 	sc->sc_iot = va->va_iot;
    154   1.1  takemura 	bus_space_map(sc->sc_iot, va->va_addr, va->va_size,
    155   1.1  takemura 		      0 /* no cache */, &sc->sc_ioh);
    156   1.1  takemura 	/*
    157   1.1  takemura 	 *  Disable all interrupts.
    158   1.1  takemura 	 */
    159   1.1  takemura 	sc->sc_intr_mask = 0;
    160   1.8      shin 	printf("\n");
    161   1.1  takemura #ifdef WINCE_DEFAULT_SETTING
    162   1.1  takemura #warning WINCE_DEFAULT_SETTING
    163   1.1  takemura #else
    164  1.10      sato 	VPRINTF(DEBUG_IO, ("WIN setting:                                "));
    165  1.10      sato 	VDUMP_IOSETTING(DEBUG_IO, sc);
    166  1.10      sato 	VPRINTF(DEBUG_IO, ("\n"));
    167   1.1  takemura 	vrgiu_regwrite_4(sc, GIUINTEN_REG, sc->sc_intr_mask);
    168   1.1  takemura #endif
    169   1.1  takemura 
    170   1.1  takemura 	for (i = 0; i < MAX_GPIO_INOUT; i++)
    171   1.1  takemura 		TAILQ_INIT(&sc->sc_intr_head[i]);
    172   1.1  takemura 	if (!(sc->sc_ih = vrip_intr_establish(va->va_vc, va->va_intr, IPL_BIO,
    173   1.1  takemura 					      vrgiu_intr, sc))) {
    174   1.1  takemura 		printf("%s: can't establish interrupt\n", sc->sc_dev.dv_xname);
    175   1.1  takemura 		return;
    176   1.1  takemura 	}
    177   1.1  takemura 	vrgiu_functions.gf_intr_establish = vrgiu_intr_establish;
    178   1.1  takemura 	vrgiu_functions.gf_intr_disestablish = vrgiu_intr_disestablish;
    179   1.1  takemura 	/*
    180   1.1  takemura 	 * Register functions to upper interface.
    181   1.1  takemura 	 */
    182   1.1  takemura 	vrip_giu_function_register(va->va_vc, &vrgiu_functions, self);
    183   1.9      sato 
    184   1.1  takemura 	/* Display port status (Input/Output) for debugging */
    185  1.10      sato 	VPRINTF(DEBUG_IO, ("I/O setting:                                "));
    186   1.9      sato 	DDUMP_IOSETTING(DEBUG_IO, sc);
    187  1.10      sato 	VPRINTF(DEBUG_IO, ("\n"));
    188  1.10      sato 	VPRINTF(DEBUG_IO, ("       data:"));
    189  1.10      sato 	VDUMP_IO(DEBUG_IO, sc);
    190   1.5      sato 
    191   1.1  takemura 	/*
    192   1.1  takemura 	 *  General purpose bus
    193   1.1  takemura 	 */
    194   1.1  takemura 	gpa.gpa_busname = "gpbus";
    195   1.1  takemura 	gpa.gpa_gc = sc;
    196   1.1  takemura 	gpa.gpa_gf = &vrgiu_functions;
    197   1.4  takemura 	while (config_found(self, &gpa, vrgiu_print)) ;
    198   1.1  takemura 	/*
    199   1.1  takemura 	 * GIU-ISA bridge
    200   1.1  takemura 	 */
    201   1.1  takemura #if 1 /* XXX Sometimes mounting root device failed. Why? XXX*/
    202   1.1  takemura 	config_defer(self, vrgiu_callback);
    203   1.1  takemura #else
    204   1.1  takemura 	vrgiu_callback(self);
    205   1.1  takemura #endif
    206   1.1  takemura }
    207   1.1  takemura 
    208   1.1  takemura void
    209   1.1  takemura vrgiu_callback(self)
    210   1.1  takemura 	struct device *self;
    211   1.1  takemura {
    212   1.1  takemura 	struct vrgiu_softc *sc = (void*)self;
    213   1.1  takemura 	struct gpbus_attach_args gpa;
    214   1.1  takemura 
    215   1.1  takemura 	gpa.gpa_busname = "vrisab";
    216   1.1  takemura 	gpa.gpa_gc = sc;
    217   1.1  takemura 	gpa.gpa_gf = &vrgiu_functions;
    218   1.1  takemura 	config_found(self, &gpa, vrgiu_print);
    219   1.1  takemura }
    220   1.1  takemura 
    221   1.1  takemura int
    222   1.1  takemura vrgiu_print(aux, pnp)
    223   1.1  takemura 	void *aux;
    224   1.1  takemura 	const char *pnp;
    225   1.1  takemura {
    226   1.1  takemura 	if (pnp)
    227   1.1  takemura 		return (QUIET);
    228   1.1  takemura 	return (UNCONF);
    229   1.1  takemura }
    230   1.1  takemura 
    231   1.1  takemura void
    232   1.3  takemura vrgiu_dump_iosetting(sc)
    233   1.3  takemura 	struct vrgiu_softc *sc;
    234   1.3  takemura {
    235   1.3  takemura 	long iosel, inten, useupdn, termupdn;
    236   1.3  takemura 	u_int32_t m;
    237   1.3  takemura 	iosel= vrgiu_regread_4(sc, GIUIOSEL_REG);
    238   1.3  takemura 	inten= vrgiu_regread_4(sc, GIUINTEN_REG);
    239   1.3  takemura 	useupdn = vrgiu_regread(sc, GIUUSEUPDN_REG_W);
    240   1.3  takemura 	termupdn = vrgiu_regread(sc, GIUTERMUPDN_REG_W);
    241   1.3  takemura 	for (m = 0x80000000; m; m >>=1)
    242   1.3  takemura 		printf ("%c" , (useupdn&m) ?
    243   1.3  takemura 			((termupdn&m) ? 'U' : 'D') :
    244   1.3  takemura 			((iosel&m) ? 'o' : ((inten&m)?'I':'i')));
    245   1.3  takemura }
    246   1.3  takemura 
    247   1.3  takemura void
    248  1.14      sato vrgiu_diff_iosetting()
    249  1.14      sato {
    250  1.14      sato 	struct vrgiu_softc *sc = this_giu;
    251  1.14      sato 	static long oiosel = 0, ointen = 0, ouseupdn = 0, otermupdn = 0;
    252  1.14      sato 	long iosel, inten, useupdn, termupdn;
    253  1.14      sato 	u_int32_t m;
    254  1.14      sato 
    255  1.14      sato 	iosel= vrgiu_regread_4(sc, GIUIOSEL_REG);
    256  1.14      sato 	inten= vrgiu_regread_4(sc, GIUINTEN_REG);
    257  1.14      sato 	useupdn = vrgiu_regread(sc, GIUUSEUPDN_REG_W);
    258  1.14      sato 	termupdn = vrgiu_regread(sc, GIUTERMUPDN_REG_W);
    259  1.14      sato 	if (oiosel != iosel || ointen != inten ||
    260  1.14      sato 	    ouseupdn != useupdn || otermupdn != termupdn) {
    261  1.14      sato 		for (m = 0x80000000; m; m >>=1)
    262  1.14      sato 			printf ("%c" , (useupdn&m) ?
    263  1.14      sato 				((termupdn&m) ? 'U' : 'D') :
    264  1.14      sato 				((iosel&m) ? 'o' : ((inten&m)?'I':'i')));
    265  1.14      sato 	}
    266  1.14      sato 	oiosel = iosel;
    267  1.14      sato 	ointen = inten;
    268  1.14      sato 	ouseupdn = useupdn;
    269  1.14      sato 	otermupdn = termupdn;
    270  1.14      sato }
    271  1.14      sato 
    272  1.14      sato void
    273   1.9      sato vrgiu_dump_io(sc)
    274   1.9      sato 	struct vrgiu_softc *sc;
    275   1.9      sato {
    276   1.9      sato 	u_int32_t preg[2];
    277   1.9      sato 
    278   1.9      sato 	preg[0] = vrgiu_regread_4(sc, GIUPIOD_REG);
    279   1.9      sato 	preg[1] = vrgiu_regread_4(sc, GIUPODAT_REG);
    280   1.9      sato 
    281   1.9      sato 	bitdisp64(preg);
    282  1.14      sato }
    283  1.14      sato 
    284  1.14      sato void
    285  1.14      sato vrgiu_diff_io()
    286  1.14      sato {
    287  1.14      sato 	struct vrgiu_softc *sc  = this_giu;
    288  1.14      sato 	static u_int32_t opreg[2] = {0, 0};
    289  1.14      sato 	u_int32_t preg[2];
    290  1.14      sato 
    291  1.14      sato 	preg[0] = vrgiu_regread_4(sc, GIUPIOD_REG);
    292  1.14      sato 	preg[1] = vrgiu_regread_4(sc, GIUPODAT_REG);
    293  1.14      sato 
    294  1.14      sato 	if (opreg[0] != preg[0] || opreg[1] != preg[1]) {
    295  1.14      sato 		printf("giu data: ");
    296  1.14      sato 		bitdisp64(preg);
    297  1.14      sato 	}
    298  1.14      sato 	opreg[0] = preg[0];
    299  1.14      sato 	opreg[1] = preg[1];
    300   1.9      sato }
    301   1.9      sato 
    302   1.9      sato void
    303   1.1  takemura vrgiu_dump_regs(sc)
    304   1.1  takemura 	struct vrgiu_softc *sc;
    305   1.1  takemura {
    306   1.1  takemura 	if (sc == NULL) {
    307   1.1  takemura 		panic("%s(%d): VRGIU device not initialized\n",
    308   1.1  takemura 		      __FILE__, __LINE__);
    309   1.1  takemura 	}
    310   1.1  takemura 	printf("    IOSEL: %08x\n", vrgiu_regread_4(sc, GIUIOSEL_REG));
    311   1.1  takemura 	printf("     PIOD: %08x\n", vrgiu_regread_4(sc, GIUPIOD_REG));
    312   1.1  takemura 	printf("    PODAT: %08x\n", vrgiu_regread_4(sc, GIUPODAT_REG));
    313   1.1  takemura 	printf("  INTSTAT: %08x\n", vrgiu_regread_4(sc, GIUINTSTAT_REG));
    314   1.1  takemura 	printf("    INTEN: %08x\n", vrgiu_regread_4(sc, GIUINTEN_REG));
    315   1.1  takemura 	printf("   INTTYP: %08x\n", vrgiu_regread_4(sc, GIUINTTYP_REG));
    316   1.1  takemura 	printf(" INTALSEL: %08x\n", vrgiu_regread_4(sc, GIUINTALSEL_REG));
    317   1.1  takemura 	printf(" INTHTSEL: %08x\n", vrgiu_regread_4(sc, GIUINTHTSEL_REG));
    318   1.1  takemura }
    319   1.1  takemura /*
    320   1.1  takemura  * GIU regster access method.
    321   1.1  takemura  */
    322   1.1  takemura u_int32_t
    323   1.1  takemura vrgiu_regread_4(vc, offs)
    324   1.1  takemura 	vrgiu_chipset_tag_t vc;
    325   1.1  takemura 	bus_addr_t offs;
    326   1.1  takemura {
    327   1.1  takemura 	struct vrgiu_softc *sc = (void*)vc;
    328   1.1  takemura 	u_int16_t reg[2];
    329   1.1  takemura 	bus_space_read_region_2 (sc->sc_iot, sc->sc_ioh, offs, reg, 2);
    330   1.1  takemura 	return reg[0]|(reg[1]<<16);
    331   1.1  takemura }
    332   1.1  takemura 
    333   1.3  takemura u_int16_t
    334   1.3  takemura vrgiu_regread(vc, off)
    335   1.3  takemura 	vrgiu_chipset_tag_t vc;
    336   1.3  takemura 	bus_addr_t off;
    337   1.3  takemura {
    338   1.3  takemura 	struct vrgiu_softc *sc = (void*)vc;
    339   1.3  takemura 	return bus_space_read_2(sc->sc_iot, sc->sc_ioh, off);
    340   1.3  takemura }
    341   1.3  takemura 
    342   1.1  takemura void
    343   1.1  takemura vrgiu_regwrite_4(vc, offs, data)
    344   1.1  takemura 	vrgiu_chipset_tag_t vc;
    345   1.1  takemura 	bus_addr_t offs;
    346   1.1  takemura 	u_int32_t data;
    347   1.1  takemura {
    348   1.1  takemura 	struct vrgiu_softc *sc = (void*)vc;
    349   1.1  takemura 
    350   1.1  takemura 	u_int16_t reg[2];
    351   1.1  takemura 	reg[0] = data & 0xffff;
    352   1.1  takemura 	reg[1] = (data>>16)&0xffff;
    353   1.1  takemura 	bus_space_write_region_2 (sc->sc_iot, sc->sc_ioh, offs, reg, 2);
    354   1.1  takemura }
    355   1.3  takemura 
    356   1.3  takemura void
    357   1.3  takemura vrgiu_regwrite(vc, off, data)
    358   1.3  takemura 	vrgiu_chipset_tag_t vc;
    359   1.3  takemura 	bus_addr_t off;
    360   1.3  takemura 	u_int16_t data;
    361   1.3  takemura {
    362   1.3  takemura 	struct vrgiu_softc *sc = (void*)vc;
    363   1.3  takemura 	bus_space_write_2(sc->sc_iot, sc->sc_ioh, off, data);
    364   1.3  takemura }
    365   1.4  takemura 
    366   1.1  takemura /*
    367   1.1  takemura  * PORT
    368   1.1  takemura  */
    369   1.1  takemura int
    370   1.4  takemura vrgiu_port_read(vc, port)
    371   1.1  takemura 	vrgiu_chipset_tag_t vc;
    372   1.4  takemura 	int port;
    373   1.1  takemura {
    374   1.4  takemura 	int on;
    375   1.4  takemura 
    376   1.4  takemura 	if (!LEGAL_OUT_PORT(port))
    377   1.4  takemura 		panic("vrgiu_port_read: illegal gpio port");
    378   1.4  takemura 
    379   1.4  takemura 	if (port < 32)
    380   1.4  takemura 		on = (vrgiu_regread_4(vc, GIUPIOD_REG) & (1 << port));
    381   1.4  takemura 	else
    382   1.4  takemura 		on = (vrgiu_regread_4(vc, GIUPODAT_REG) & (1 << (port - 32)));
    383   1.4  takemura 
    384   1.4  takemura 	return (on ? 1 : 0);
    385   1.1  takemura }
    386   1.1  takemura 
    387   1.1  takemura int
    388   1.4  takemura vrgiu_port_write(vc, port, onoff)
    389   1.1  takemura 	vrgiu_chipset_tag_t vc;
    390   1.4  takemura 	int port;
    391   1.1  takemura 	int onoff;
    392   1.1  takemura {
    393   1.4  takemura 	u_int32_t reg[2];
    394   1.4  takemura 	int bank;
    395   1.1  takemura 
    396   1.1  takemura 	if (!LEGAL_OUT_PORT(port))
    397   1.1  takemura 		panic("vrgiu_port_write: illegal gpio port");
    398   1.1  takemura 
    399   1.4  takemura 	reg[0] = vrgiu_regread_4(vc, GIUPIOD_REG);
    400   1.4  takemura 	reg[1] = vrgiu_regread_4(vc, GIUPODAT_REG);
    401   1.1  takemura 	bank = port < 32 ? 0 : 1;
    402   1.1  takemura 	if (bank == 1)
    403   1.1  takemura 		port -= 32;
    404   1.1  takemura 
    405   1.1  takemura 	if (onoff)
    406   1.1  takemura 		reg[bank] |= (1<<port);
    407   1.1  takemura 	else
    408   1.1  takemura 		reg[bank] &= ~(1<<port);
    409   1.1  takemura 	vrgiu_regwrite_4(vc, GIUPIOD_REG, reg[0]);
    410   1.1  takemura 	vrgiu_regwrite_4(vc, GIUPODAT_REG, reg[1]);
    411   1.1  takemura 
    412   1.1  takemura 	return 0;
    413   1.1  takemura }
    414   1.1  takemura /*
    415   1.1  takemura  *  For before autoconfiguration.
    416   1.1  takemura  */
    417   1.1  takemura void
    418   1.1  takemura __vrgiu_out(port, data)
    419   1.1  takemura 	int port;
    420   1.1  takemura 	int data;
    421   1.1  takemura {
    422   1.1  takemura 	u_int16_t reg;
    423   1.1  takemura 	u_int32_t addr;
    424   1.1  takemura 	int offs;
    425   1.1  takemura 
    426   1.1  takemura 	if (!LEGAL_OUT_PORT(port))
    427   1.1  takemura 		panic("__vrgiu_out: illegal gpio port");
    428   1.1  takemura 	if (port < 16) {
    429   1.1  takemura 		addr = MIPS_PHYS_TO_KSEG1((VRIP_GIU_ADDR + GIUPIOD_L_REG_W));
    430   1.1  takemura 		offs = port;
    431   1.1  takemura 	} else if (port < 32) {
    432   1.1  takemura 		addr = MIPS_PHYS_TO_KSEG1((VRIP_GIU_ADDR + GIUPIOD_H_REG_W));
    433   1.1  takemura 		offs = port - 16;
    434   1.1  takemura 	} else if (port < 48) {
    435   1.1  takemura 		addr = MIPS_PHYS_TO_KSEG1((VRIP_GIU_ADDR + GIUPODAT_L_REG_W));
    436   1.1  takemura 		offs = port - 32;
    437   1.1  takemura 	} else {
    438   1.1  takemura 		addr = MIPS_PHYS_TO_KSEG1((VRIP_GIU_ADDR + GIUPODAT_H_REG_W));
    439   1.1  takemura 		offs = port - 48;
    440   1.1  takemura 		panic ("__vrgiu_out: not coded yet.");
    441   1.1  takemura 	}
    442   1.9      sato 	DPRINTF(DEBUG_IO, ("__vrgiu_out: addr %08x bit %d\n", addr, offs));
    443   1.1  takemura 
    444   1.1  takemura 	wbflush();
    445   1.1  takemura 	reg = *((volatile u_int16_t*)addr);
    446   1.1  takemura 	if (data) {
    447   1.1  takemura 		reg |= (1 << offs);
    448   1.1  takemura 	} else {
    449   1.1  takemura 		reg &= ~(1 << offs);
    450   1.1  takemura 	}
    451   1.1  takemura 	*((volatile u_int16_t*)addr) = reg;
    452   1.1  takemura 	wbflush();
    453   1.1  takemura }
    454   1.1  takemura /*
    455   1.1  takemura  * Interrupt staff
    456   1.1  takemura  */
    457   1.1  takemura void *
    458   1.1  takemura vrgiu_intr_establish(ic, port, mode, level, ih_fun, ih_arg)
    459   1.1  takemura 	vrgiu_chipset_tag_t ic;
    460   1.1  takemura 	int port; /* GPIO pin # */
    461   1.1  takemura 	int mode; /* GIU trigger setting */
    462   1.1  takemura 	int level;  /* XXX not yet */
    463   1.1  takemura 	int (*ih_fun) __P((void*));
    464   1.1  takemura 	void *ih_arg;
    465   1.1  takemura {
    466   1.1  takemura 	struct vrgiu_softc *sc = (void*)ic;
    467   1.1  takemura 	int s;
    468   1.1  takemura 	u_int32_t reg, mask;
    469   1.1  takemura 	struct vrgiu_intr_entry *ih;
    470   1.1  takemura 
    471   1.1  takemura 	if (!LEGAL_INTR_PORT(port))
    472   1.1  takemura 		panic ("vrgiu_intr_establish: bogus interrupt line.");
    473   1.1  takemura 	if (sc->sc_intr_mode[port] && mode != sc->sc_intr_mode[port])
    474   1.1  takemura 		panic ("vrgiu_intr_establish: bogus interrupt type.");
    475   1.1  takemura 	else
    476   1.1  takemura 		sc->sc_intr_mode[port] = mode;
    477   1.1  takemura 	mask = (1 << port);
    478   1.1  takemura 
    479   1.1  takemura 	s = splhigh();
    480   1.1  takemura 
    481   1.1  takemura 	if (!(ih = malloc(sizeof(struct vrgiu_intr_entry), M_DEVBUF, M_NOWAIT)))
    482   1.1  takemura 		panic ("vrgiu_intr_establish: no memory.");
    483   1.1  takemura 
    484   1.1  takemura 	ih->ih_port = port;
    485   1.1  takemura 	ih->ih_fun = ih_fun;
    486   1.1  takemura 	ih->ih_arg = ih_arg;
    487   1.1  takemura 	TAILQ_INSERT_TAIL(&sc->sc_intr_head[port], ih, ih_link);
    488   1.1  takemura #ifdef WINCE_DEFAULT_SETTING
    489   1.1  takemura #warning WINCE_DEFAULT_SETTING
    490   1.1  takemura #else
    491   1.1  takemura 	/*
    492   1.1  takemura 	 *  Setup registers
    493   1.1  takemura 	 */
    494   1.1  takemura 	/* Input mode */
    495   1.1  takemura 	reg = vrgiu_regread_4(sc, GIUIOSEL_REG);
    496   1.1  takemura 	reg &= ~mask;
    497   1.1  takemura 	vrgiu_regwrite_4(sc, GIUIOSEL_REG, reg);
    498   1.1  takemura 
    499   1.1  takemura 	/* interrupt type */
    500   1.1  takemura 	reg = vrgiu_regread_4(sc, GIUINTTYP_REG);
    501   1.3  takemura 	DPRINTF(DEBUG_INTR, ("[%s->",reg & mask ? "edge" : "level"));
    502   1.1  takemura 	if (mode & VRGIU_INTR_EDGE) {
    503   1.3  takemura 		DPRINTF(DEBUG_INTR, ("edge]"));
    504   1.1  takemura 		reg |= mask;	/* edge */
    505   1.1  takemura 	} else {
    506   1.3  takemura 		DPRINTF(DEBUG_INTR, ("level]"));
    507   1.1  takemura 		reg &= ~mask;	/* level */
    508   1.1  takemura 	}
    509   1.1  takemura 	vrgiu_regwrite_4(sc, GIUINTTYP_REG, reg);
    510   1.1  takemura 
    511   1.1  takemura 	/* interrupt level */
    512   1.1  takemura 	if (!(mode & VRGIU_INTR_EDGE)) {
    513   1.1  takemura 		reg = vrgiu_regread_4(sc, GIUINTALSEL_REG);
    514   1.3  takemura 		DPRINTF(DEBUG_INTR, ("[%s->",reg & mask ? "high" : "low"));
    515   1.1  takemura 		if (mode & VRGIU_INTR_HIGH) {
    516   1.3  takemura 			DPRINTF(DEBUG_INTR, ("high]"));
    517   1.1  takemura 			reg |= mask;	/* high */
    518   1.1  takemura 		} else {
    519   1.3  takemura 			DPRINTF(DEBUG_INTR, ("low]"));
    520   1.1  takemura 			reg &= ~mask;	/* low */
    521   1.1  takemura 		}
    522   1.1  takemura 		vrgiu_regwrite_4(sc, GIUINTALSEL_REG, reg);
    523   1.1  takemura 	}
    524   1.1  takemura 	/* hold or through */
    525   1.1  takemura 	reg = vrgiu_regread_4(sc, GIUINTHTSEL_REG);
    526   1.3  takemura 	DPRINTF(DEBUG_INTR, ("[%s->",reg & mask ? "hold" : "through"));
    527   1.1  takemura 	if (mode & VRGIU_INTR_HOLD) {
    528   1.3  takemura 		DPRINTF(DEBUG_INTR, ("hold]"));
    529   1.1  takemura 		reg |= mask;	/* hold */
    530   1.1  takemura 	} else {
    531   1.3  takemura 		DPRINTF(DEBUG_INTR, ("through]"));
    532   1.1  takemura 		reg &= ~mask;	/* through */
    533   1.1  takemura 	}
    534   1.1  takemura 	vrgiu_regwrite_4(sc, GIUINTHTSEL_REG, reg);
    535   1.1  takemura #endif
    536   1.1  takemura 	/*
    537   1.1  takemura 	 *  clear interrupt status
    538   1.1  takemura 	 */
    539   1.1  takemura 	reg = vrgiu_regread_4(sc, GIUINTSTAT_REG);
    540   1.1  takemura 	reg &= ~mask;
    541   1.1  takemura 	vrgiu_regwrite_4(sc, GIUINTSTAT_REG, reg);
    542   1.1  takemura 	/*
    543   1.1  takemura 	 *  enable interrupt
    544   1.1  takemura 	 */
    545   1.1  takemura #ifdef WINCE_DEFAULT_SETTING
    546   1.1  takemura #warning WINCE_DEFAULT_SETTING
    547   1.1  takemura #else
    548   1.1  takemura 	sc->sc_intr_mask |= mask;
    549   1.1  takemura 	vrgiu_regwrite_4(sc, GIUINTEN_REG, sc->sc_intr_mask);
    550   1.1  takemura 	/* Unmask GIU level 2 mask register */
    551   1.1  takemura 	vrip_intr_setmask2(sc->sc_vc, sc->sc_ih, (1<<port), 1);
    552   1.1  takemura #endif
    553   1.1  takemura 	splx(s);
    554   1.1  takemura 
    555   1.3  takemura 	DPRINTF(DEBUG_INTR, ("\n"));
    556   1.1  takemura 
    557   1.1  takemura 	return ih;
    558   1.1  takemura }
    559   1.1  takemura 
    560   1.1  takemura void
    561   1.1  takemura vrgiu_intr_disestablish(ic, arg)
    562   1.1  takemura 	vrgiu_chipset_tag_t ic;
    563   1.1  takemura 	void *arg;
    564   1.1  takemura {
    565   1.1  takemura 	struct vrgiu_intr_entry *ihe = arg;
    566   1.1  takemura 	struct vrgiu_softc *sc = (void*)ic;
    567   1.1  takemura 	int port = ihe->ih_port;
    568   1.1  takemura 	struct vrgiu_intr_entry *ih;
    569   1.1  takemura 	int s;
    570   1.1  takemura 
    571   1.1  takemura 	s = splhigh();
    572   1.1  takemura 	TAILQ_FOREACH(ih, &sc->sc_intr_head[port], ih_link) {
    573   1.1  takemura 		if (ih == ihe) {
    574   1.1  takemura 			TAILQ_REMOVE(&sc->sc_intr_head[port], ih, ih_link);
    575   1.1  takemura 			free(ih, M_DEVBUF);
    576   1.1  takemura 			if (TAILQ_EMPTY(&sc->sc_intr_head[port])) {
    577   1.1  takemura 				/* Disable interrupt */
    578   1.1  takemura #ifdef WINCE_DEFAULT_SETTING
    579   1.1  takemura #warning WINCE_DEFAULT_SETTING
    580   1.1  takemura #else
    581   1.1  takemura 				sc->sc_intr_mask &= ~(1<<port);
    582   1.1  takemura 				vrgiu_regwrite_4(sc, GIUINTEN_REG, sc->sc_intr_mask);
    583   1.1  takemura #endif
    584   1.1  takemura 			}
    585   1.1  takemura 			splx(s);
    586   1.1  takemura 			return;
    587   1.1  takemura 		}
    588   1.1  takemura 	}
    589   1.1  takemura 	panic("vrgiu_intr_disetablish: no such a handle.");
    590   1.1  takemura 	/* NOTREACHED */
    591   1.1  takemura }
    592   1.1  takemura 
    593   1.1  takemura int
    594   1.1  takemura vrgiu_intr(arg)
    595   1.1  takemura 	void *arg;
    596   1.1  takemura {
    597   1.1  takemura #ifdef DUMP_GIU_LEVEL2_INTR
    598   1.1  takemura #warning DUMP_GIU_LEVEL2_INTR
    599   1.1  takemura 	static u_int32_t oreg;
    600   1.1  takemura #endif
    601   1.1  takemura 	struct vrgiu_softc *sc = arg;
    602   1.1  takemura 	int i;
    603   1.1  takemura 	u_int32_t reg;
    604  1.17      sato 	int ledvalue = CONFIG_HOOK_LED_FLASH;
    605  1.17      sato 
    606   1.1  takemura 	/* Get Level 2 interrupt status */
    607   1.1  takemura 	vrip_intr_get_status2 (sc->sc_vc, sc->sc_ih, &reg);
    608   1.1  takemura #ifdef DUMP_GIU_LEVEL2_INTR
    609   1.1  takemura #warning DUMP_GIU_LEVEL2_INTR
    610   1.1  takemura 	{
    611   1.1  takemura 		u_int32_t uedge, dedge, j;
    612   1.1  takemura 		for (j = 0x80000000; j > 0; j >>=1)
    613   1.1  takemura 			printf ("%c" , reg&j ? '|' : '.');
    614   1.1  takemura 		uedge = (reg ^ oreg) & reg;
    615   1.1  takemura 		dedge = (reg ^ oreg) & ~reg;
    616   1.1  takemura 		if (uedge || dedge) {
    617   1.1  takemura 			for (j = 0; j < 32; j++) {
    618   1.1  takemura 				if (uedge & (1 << j))
    619   1.1  takemura 					printf ("+%d", j);
    620   1.1  takemura 				else if (dedge & (1 << j))
    621   1.1  takemura 					printf ("-%d", j);
    622   1.1  takemura 			}
    623   1.1  takemura 		}
    624   1.1  takemura 		oreg = reg;
    625   1.1  takemura 		printf ("\n");
    626   1.1  takemura 	}
    627   1.1  takemura #endif
    628   1.2       uch 	/* Clear interrupt */
    629   1.2       uch 	vrgiu_regwrite_4(sc, GIUINTSTAT_REG, vrgiu_regread_4(sc, GIUINTSTAT_REG));
    630   1.2       uch 
    631   1.1  takemura 	/* Dispatch handler */
    632   1.1  takemura 	for (i = 0; i < MAX_GPIO_INOUT; i++) {
    633   1.1  takemura 		if (reg & (1 << i)) {
    634   1.1  takemura 			register struct vrgiu_intr_entry *ih;
    635   1.1  takemura 			TAILQ_FOREACH(ih, &sc->sc_intr_head[i], ih_link) {
    636   1.1  takemura 				ih->ih_fun(ih->ih_arg);
    637   1.1  takemura 			}
    638   1.1  takemura 		}
    639   1.1  takemura 	}
    640   1.2       uch 
    641  1.17      sato 	if (vrgiu_intr_led)
    642  1.17      sato 		config_hook_call(CONFIG_HOOK_SET,
    643  1.17      sato 				 CONFIG_HOOK_LED,
    644  1.17      sato 				(void *)&ledvalue);
    645   1.1  takemura 	return 0;
    646   1.1  takemura }
    647