Home | History | Annotate | Line # | Download | only in vr
vrip.c revision 1.9
      1  1.9      sato /*	$NetBSD: vrip.c,v 1.9 2001/04/18 11:07:28 sato Exp $	*/
      2  1.1  takemura 
      3  1.1  takemura /*-
      4  1.1  takemura  * Copyright (c) 1999
      5  1.1  takemura  *         Shin Takemura and PocketBSD Project. All rights reserved.
      6  1.1  takemura  *
      7  1.1  takemura  * Redistribution and use in source and binary forms, with or without
      8  1.1  takemura  * modification, are permitted provided that the following conditions
      9  1.1  takemura  * are met:
     10  1.1  takemura  * 1. Redistributions of source code must retain the above copyright
     11  1.1  takemura  *    notice, this list of conditions and the following disclaimer.
     12  1.1  takemura  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  takemura  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  takemura  *    documentation and/or other materials provided with the distribution.
     15  1.1  takemura  * 3. All advertising materials mentioning features or use of this software
     16  1.1  takemura  *    must display the following acknowledgement:
     17  1.1  takemura  *	This product includes software developed by the PocketBSD project
     18  1.1  takemura  *	and its contributors.
     19  1.1  takemura  * 4. Neither the name of the project nor the names of its contributors
     20  1.1  takemura  *    may be used to endorse or promote products derived from this software
     21  1.1  takemura  *    without specific prior written permission.
     22  1.1  takemura  *
     23  1.1  takemura  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     24  1.1  takemura  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     25  1.1  takemura  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     26  1.1  takemura  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     27  1.1  takemura  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     28  1.1  takemura  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     29  1.1  takemura  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     30  1.1  takemura  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     31  1.1  takemura  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     32  1.1  takemura  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     33  1.1  takemura  * SUCH DAMAGE.
     34  1.1  takemura  *
     35  1.1  takemura  */
     36  1.7      sato #include "opt_vr41xx.h"
     37  1.7      sato #include "opt_tx39xx.h"
     38  1.7      sato 
     39  1.1  takemura #include <sys/param.h>
     40  1.1  takemura #include <sys/systm.h>
     41  1.1  takemura #include <sys/device.h>
     42  1.1  takemura #include <sys/reboot.h>
     43  1.1  takemura 
     44  1.1  takemura #include <machine/cpu.h>
     45  1.1  takemura #include <machine/bus.h>
     46  1.1  takemura #include <machine/autoconf.h>
     47  1.8      sato #include <machine/platid.h>
     48  1.8      sato #include <machine/platid_mask.h>
     49  1.1  takemura 
     50  1.1  takemura #include <hpcmips/vr/vr.h>
     51  1.9      sato #include <hpcmips/vr/vrcpudef.h>
     52  1.1  takemura #include <hpcmips/vr/vripreg.h>
     53  1.1  takemura #include <hpcmips/vr/vripvar.h>
     54  1.1  takemura #include <hpcmips/vr/icureg.h>
     55  1.1  takemura #include "locators.h"
     56  1.1  takemura 
     57  1.3  takemura #define VRIPDEBUG
     58  1.3  takemura #ifdef VRIPDEBUG
     59  1.6      sato #ifndef VRIPDEBUG_CONF
     60  1.6      sato #define VRIPDEBUG_CONF 0
     61  1.6      sato #endif /* VRIPDEBUG_CONF */
     62  1.6      sato int	vrip_debug = VRIPDEBUG_CONF;
     63  1.6      sato #define DPRINTF(arg) if (vrip_debug) printf arg;
     64  1.6      sato #define DBITDISP32(reg) if (vrip_debug) bitdisp32(reg);
     65  1.6      sato #define DDUMP_LEVEL2MASK(sc,arg) if (vrip_debug) vrip_dump_level2mask(sc,arg)
     66  1.3  takemura #else
     67  1.6      sato #define DPRINTF(arg)
     68  1.6      sato #define DBITDISP32(arg)
     69  1.6      sato #define DDUMP_LEVEL2MASK(sc,arg)
     70  1.3  takemura #endif
     71  1.3  takemura 
     72  1.1  takemura int	vripmatch __P((struct device*, struct cfdata*, void*));
     73  1.1  takemura void	vripattach __P((struct device*, struct device*, void*));
     74  1.1  takemura int	vrip_print __P((void*, const char*));
     75  1.1  takemura int	vrip_search __P((struct device*, struct cfdata*, void*));
     76  1.1  takemura int	vrip_intr __P((void*, u_int32_t, u_int32_t));
     77  1.1  takemura 
     78  1.1  takemura static void vrip_dump_level2mask __P((vrip_chipset_tag_t, void*));
     79  1.1  takemura 
     80  1.1  takemura struct cfattach vrip_ca = {
     81  1.1  takemura 	sizeof(struct vrip_softc), vripmatch, vripattach
     82  1.1  takemura };
     83  1.1  takemura 
     84  1.1  takemura #define MAX_LEVEL1 32
     85  1.1  takemura 
     86  1.2  takemura struct vrip_softc *the_vrip_sc = NULL;
     87  1.2  takemura 
     88  1.1  takemura static struct intrhand {
     89  1.1  takemura 	int	 (*ih_fun) __P((void *));
     90  1.1  takemura 	void *ih_arg;
     91  1.1  takemura 	int ih_l1line;
     92  1.1  takemura 	int	ih_ipl;
     93  1.1  takemura 	bus_addr_t	ih_lreg;
     94  1.1  takemura 	bus_addr_t	ih_mlreg;
     95  1.1  takemura 	bus_addr_t	ih_hreg;
     96  1.1  takemura 	bus_addr_t	ih_mhreg;
     97  1.1  takemura } intrhand[MAX_LEVEL1] = {
     98  1.9      sato 	[VRIP_INTR_PIU] = { 0, 0, 0, 0, ICUPIUINT_REG_W,	MPIUINT_REG_W	},
     99  1.9      sato 	[VRIP_INTR_AIU] = { 0, 0, 0, 0, AIUINT_REG_W,	MAIUINT_REG_W	},
    100  1.9      sato 	[VRIP_INTR_KIU] = { 0, 0, 0, 0, KIUINT_REG_W,	MKIUINT_REG_W	},
    101  1.9      sato 	[VRIP_INTR_GIU] = { 0, 0, 0, 0, GIUINT_L_REG_W,	MGIUINT_L_REG_W, GIUINT_H_REG_W,	MGIUINT_H_REG_W	},
    102  1.9      sato 	[VRIP_INTR_FIR] = { 0, 0, 0, 0, FIRINT_REG_W,	MFIRINT_REG_W	},
    103  1.9      sato 	[VRIP_INTR_DSIU] = { 0, 0, 0, 0, DSIUINT_REG_W,	MDSIUINT_REG_W	},
    104  1.9      sato 	[VRIP_INTR_PCI] = { 0, 0, 0, 0, PCIINT_REG_W,	MPCIINT_REG_W	},
    105  1.9      sato 	[VRIP_INTR_SCU] = { 0, 0, 0, 0, SCUINT_REG_W,	MSCUINT_REG_W	},
    106  1.9      sato 	[VRIP_INTR_CSI] = { 0, 0, 0, 0, CSIINT_REG_W,	MCSIINT_REG_W	},
    107  1.9      sato 	[VRIP_INTR_BCU] = { 0, 0, 0, 0, BCUINT_REG_W,	MBCUINT_REG_W	}
    108  1.1  takemura };
    109  1.9      sato 
    110  1.1  takemura #define	LEGAL_LEVEL1(x)	((x) >= 0 && (x) < MAX_LEVEL1)
    111  1.1  takemura 
    112  1.1  takemura void
    113  1.1  takemura bitdisp16 (u_int16_t a)
    114  1.1  takemura {
    115  1.1  takemura 	u_int16_t j;
    116  1.1  takemura 	for (j = 0x8000; j > 0; j >>=1)
    117  1.1  takemura 		printf ("%c", a&j ?'|':'.');
    118  1.1  takemura 	printf ("\n");
    119  1.1  takemura }
    120  1.1  takemura 
    121  1.1  takemura void
    122  1.1  takemura bitdisp32 (u_int32_t a)
    123  1.1  takemura {
    124  1.1  takemura 	u_int32_t j;
    125  1.1  takemura 	for (j = 0x80000000; j > 0; j >>=1)
    126  1.1  takemura 		printf ("%c" , a&j ? '|' : '.');
    127  1.1  takemura 	printf ("\n");
    128  1.1  takemura }
    129  1.1  takemura 
    130  1.1  takemura void
    131  1.1  takemura bitdisp64(u_int32_t a[2])
    132  1.1  takemura {
    133  1.1  takemura 	u_int32_t j;
    134  1.1  takemura 	for( j = 0x80000000 ; j > 0 ; j >>=1 )
    135  1.1  takemura 		printf("%c" , a[1]&j ?';':',' );
    136  1.1  takemura 	for( j = 0x80000000 ; j > 0 ; j >>=1 )
    137  1.1  takemura 		printf("%c" , a[0]&j ?'|':'.' );
    138  1.1  takemura 	printf("\n");
    139  1.1  takemura }
    140  1.1  takemura 
    141  1.1  takemura int
    142  1.1  takemura vripmatch(parent, match, aux)
    143  1.1  takemura 	struct device *parent;
    144  1.1  takemura 	struct cfdata *match;
    145  1.1  takemura 	void *aux;
    146  1.1  takemura {
    147  1.1  takemura 	struct mainbus_attach_args *ma = aux;
    148  1.7      sato 
    149  1.7      sato #ifdef TX39XX
    150  1.7      sato 	if (!platid_match(&platid, &platid_mask_CPU_MIPS_VR_41XX))
    151  1.7      sato 		return 1;
    152  1.7      sato #endif /* !TX39XX */
    153  1.1  takemura 	if (strcmp(ma->ma_name, match->cf_driver->cd_name))
    154  1.1  takemura 		return 0;
    155  1.1  takemura 	return 1;
    156  1.1  takemura }
    157  1.1  takemura 
    158  1.1  takemura void
    159  1.1  takemura vripattach(parent, self, aux)
    160  1.1  takemura 	struct device *parent;
    161  1.1  takemura 	struct device *self;
    162  1.1  takemura 	void *aux;
    163  1.1  takemura {
    164  1.1  takemura 	struct mainbus_attach_args *ma = aux;
    165  1.1  takemura 	struct vrip_softc *sc = (struct vrip_softc*)self;
    166  1.1  takemura 
    167  1.1  takemura 	printf("\n");
    168  1.1  takemura 	/*
    169  1.1  takemura 	 *  Map ICU (Interrupt Control Unit) register space.
    170  1.1  takemura 	 */
    171  1.1  takemura 	sc->sc_iot = ma->ma_iot;
    172  1.1  takemura 	if (bus_space_map(sc->sc_iot, VRIP_ICU_ADDR, 0x20/*XXX lower area only*/,
    173  1.1  takemura 			  0, /* no flags */
    174  1.1  takemura 			  &sc->sc_ioh)) {
    175  1.1  takemura 		printf("vripattach: can't map ICU register.\n");
    176  1.1  takemura 		return;
    177  1.1  takemura 	}
    178  1.1  takemura 
    179  1.1  takemura 	/*
    180  1.1  takemura 	 *  Disable all Level 1 interrupts.
    181  1.1  takemura 	 */
    182  1.2  takemura 	sc->sc_intrmask = 0;
    183  1.1  takemura 	bus_space_write_2(sc->sc_iot, sc->sc_ioh, MSYSINT1_REG_W, 0x0000);
    184  1.1  takemura 	bus_space_write_2(sc->sc_iot, sc->sc_ioh, MSYSINT2_REG_W, 0x0000);
    185  1.1  takemura 	/*
    186  1.1  takemura 	 *  Level 1 interrupts are redirected to HwInt0
    187  1.1  takemura 	 */
    188  1.1  takemura 	vr_intr_establish(VR_INTR0, vrip_intr, self);
    189  1.2  takemura 	the_vrip_sc = sc;
    190  1.1  takemura 	/*
    191  1.1  takemura 	 *  Attach each devices
    192  1.1  takemura 	 */
    193  1.1  takemura 	/* GIU CMU interface interface is used by other system device. so attach first */
    194  1.1  takemura 	sc->sc_pri = 2;
    195  1.1  takemura 	config_search(vrip_search, self, vrip_print);
    196  1.1  takemura 	/* Other system devices. */
    197  1.1  takemura 	sc->sc_pri = 1;
    198  1.1  takemura 	config_search(vrip_search, self, vrip_print);
    199  1.1  takemura }
    200  1.1  takemura 
    201  1.1  takemura int
    202  1.1  takemura vrip_print(aux, hoge)
    203  1.1  takemura 	void *aux;
    204  1.1  takemura 	const char *hoge;
    205  1.1  takemura {
    206  1.1  takemura 	struct vrip_attach_args *va = (struct vrip_attach_args*)aux;
    207  1.1  takemura 
    208  1.1  takemura 	if (va->va_addr)
    209  1.5  takemura 		printf(" addr 0x%lx", va->va_addr);
    210  1.1  takemura 	if (va->va_size > 1)
    211  1.5  takemura 		printf("-0x%lx", va->va_addr + va->va_size - 1);
    212  1.1  takemura 	if (va->va_intr != VRIPCF_INTR_DEFAULT)
    213  1.1  takemura 		printf(" intr %d", va->va_intr);
    214  1.1  takemura 	return (UNCONF);
    215  1.1  takemura }
    216  1.1  takemura 
    217  1.1  takemura int
    218  1.1  takemura vrip_search(parent, cf, aux)
    219  1.1  takemura 	struct device *parent;
    220  1.1  takemura 	struct cfdata *cf;
    221  1.1  takemura 	void *aux;
    222  1.1  takemura {
    223  1.1  takemura 	struct vrip_softc *sc = (struct vrip_softc *)parent;
    224  1.1  takemura 	struct vrip_attach_args va;
    225  1.1  takemura 
    226  1.1  takemura 	va.va_vc = sc;
    227  1.1  takemura 	va.va_iot = sc->sc_iot;
    228  1.1  takemura 	va.va_addr = cf->cf_loc[VRIPCF_ADDR];
    229  1.1  takemura 	va.va_size = cf->cf_loc[VRIPCF_SIZE];
    230  1.1  takemura 	va.va_intr = cf->cf_loc[VRIPCF_INTR];
    231  1.1  takemura 	va.va_addr2 = cf->cf_loc[VRIPCF_ADDR2];
    232  1.1  takemura 	va.va_size2 = cf->cf_loc[VRIPCF_SIZE2];
    233  1.1  takemura 	va.va_gc = sc->sc_gc;
    234  1.1  takemura 	va.va_gf = sc->sc_gf;
    235  1.1  takemura 	va.va_cc = sc->sc_cc;
    236  1.1  takemura 	va.va_cf = sc->sc_cf;
    237  1.1  takemura 	if (((*cf->cf_attach->ca_match)(parent, cf, &va) == sc->sc_pri))
    238  1.1  takemura 		config_attach(parent, cf, &va, vrip_print);
    239  1.1  takemura 
    240  1.1  takemura 	return 0;
    241  1.1  takemura }
    242  1.1  takemura 
    243  1.1  takemura void *
    244  1.1  takemura vrip_intr_establish(vc, intr, level, ih_fun, ih_arg)
    245  1.1  takemura 	vrip_chipset_tag_t vc;
    246  1.1  takemura 	int intr;
    247  1.1  takemura 	int level; /* XXX not yet */
    248  1.1  takemura 	int (*ih_fun) __P((void *));
    249  1.1  takemura 	void *ih_arg;
    250  1.1  takemura {
    251  1.1  takemura 	struct intrhand *ih;
    252  1.1  takemura 
    253  1.1  takemura 	if (!LEGAL_LEVEL1(intr))
    254  1.1  takemura 		return 0;
    255  1.1  takemura 	ih = &intrhand[intr];
    256  1.1  takemura 	if (ih->ih_fun) /* Can't share level 1 interrupt */
    257  1.1  takemura 		return 0;
    258  1.1  takemura 	ih->ih_l1line = intr;
    259  1.1  takemura 	ih->ih_fun = ih_fun;
    260  1.1  takemura 	ih->ih_arg = ih_arg;
    261  1.1  takemura 
    262  1.1  takemura 	/* Mask level 2 interrupt mask register. (disable interrupt) */
    263  1.1  takemura 	vrip_intr_setmask2(vc, ih, ~0, 0);
    264  1.1  takemura 	/* Unmask  Level 1 interrupt mask register (enable interrupt) */
    265  1.1  takemura 	vrip_intr_setmask1(vc, ih, 1);
    266  1.1  takemura 
    267  1.1  takemura 	return (void *)ih;
    268  1.1  takemura }
    269  1.1  takemura 
    270  1.1  takemura void
    271  1.1  takemura vrip_intr_disestablish(vc, arg)
    272  1.1  takemura 	vrip_chipset_tag_t vc;
    273  1.1  takemura 	void *arg;
    274  1.1  takemura {
    275  1.1  takemura 	struct intrhand *ih = arg;
    276  1.1  takemura 	ih->ih_fun = NULL;
    277  1.1  takemura 	ih->ih_arg = NULL;
    278  1.1  takemura 	/* Mask level 2 interrupt mask register(if any). (disable interrupt) */
    279  1.1  takemura 	vrip_intr_setmask2(vc, ih, ~0, 0);
    280  1.1  takemura 	/* Mask  Level 1 interrupt mask register (disable interrupt) */
    281  1.1  takemura 	vrip_intr_setmask1(vc, ih, 0);
    282  1.1  takemura }
    283  1.1  takemura 
    284  1.2  takemura void
    285  1.2  takemura vrip_intr_suspend()
    286  1.2  takemura {
    287  1.2  takemura 	bus_space_tag_t iot = the_vrip_sc->sc_iot;
    288  1.2  takemura 	bus_space_handle_t ioh = the_vrip_sc->sc_ioh;
    289  1.2  takemura 
    290  1.2  takemura 	bus_space_write_2 (iot, ioh, MSYSINT1_REG_W, (1<<VRIP_INTR_POWER));
    291  1.2  takemura 	bus_space_write_2 (iot, ioh, MSYSINT2_REG_W, 0);
    292  1.2  takemura }
    293  1.2  takemura 
    294  1.2  takemura void
    295  1.2  takemura vrip_intr_resume()
    296  1.2  takemura {
    297  1.2  takemura 	u_int32_t reg = the_vrip_sc->sc_intrmask;
    298  1.2  takemura 	bus_space_tag_t iot = the_vrip_sc->sc_iot;
    299  1.2  takemura 	bus_space_handle_t ioh = the_vrip_sc->sc_ioh;
    300  1.2  takemura 
    301  1.2  takemura 	bus_space_write_2 (iot, ioh, MSYSINT1_REG_W, reg & 0xffff);
    302  1.2  takemura 	bus_space_write_2 (iot, ioh, MSYSINT2_REG_W, (reg >> 16) & 0xffff);
    303  1.2  takemura }
    304  1.2  takemura 
    305  1.1  takemura /* Set level 1 interrupt mask. */
    306  1.1  takemura void
    307  1.1  takemura vrip_intr_setmask1(vc, arg, enable)
    308  1.1  takemura 	vrip_chipset_tag_t vc;
    309  1.1  takemura 	void *arg;
    310  1.1  takemura 	int enable;
    311  1.1  takemura {
    312  1.1  takemura 	struct vrip_softc *sc = (void*)vc;
    313  1.1  takemura 	struct intrhand *ih = arg;
    314  1.1  takemura 	int level1 = ih->ih_l1line;
    315  1.1  takemura 	bus_space_tag_t iot = sc->sc_iot;
    316  1.1  takemura 	bus_space_handle_t ioh = sc->sc_ioh;
    317  1.2  takemura 	u_int32_t reg = sc->sc_intrmask;
    318  1.1  takemura 
    319  1.1  takemura 	reg = (bus_space_read_2 (iot, ioh, MSYSINT1_REG_W)&0xffff) |
    320  1.1  takemura 		((bus_space_read_2 (iot, ioh, MSYSINT2_REG_W)<< 16)&0xffff0000);
    321  1.1  takemura 	if (enable)
    322  1.1  takemura 		reg |= (1 << level1);
    323  1.1  takemura 	else {
    324  1.1  takemura 		reg &= ~(1 << level1);
    325  1.1  takemura 	}
    326  1.2  takemura 	sc->sc_intrmask = reg;
    327  1.1  takemura 	bus_space_write_2 (iot, ioh, MSYSINT1_REG_W, reg & 0xffff);
    328  1.1  takemura 	bus_space_write_2 (iot, ioh, MSYSINT2_REG_W, (reg >> 16) & 0xffff);
    329  1.6      sato 	DBITDISP32(reg);
    330  1.1  takemura 
    331  1.1  takemura 	return;
    332  1.1  takemura }
    333  1.1  takemura 
    334  1.1  takemura static void
    335  1.1  takemura vrip_dump_level2mask (vc, arg)
    336  1.1  takemura 	vrip_chipset_tag_t vc;
    337  1.1  takemura 	void *arg;
    338  1.1  takemura {
    339  1.1  takemura 	struct vrip_softc *sc = (void*)vc;
    340  1.1  takemura 	struct intrhand *ih = arg;
    341  1.1  takemura 	u_int32_t reg;
    342  1.1  takemura 
    343  1.1  takemura 	if (ih->ih_mlreg) {
    344  1.1  takemura 		printf ("level1[%d] level2 mask:", ih->ih_l1line);
    345  1.1  takemura 		reg = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ih->ih_mlreg);
    346  1.1  takemura 		if (ih->ih_mhreg) { /* GIU [16:31] case only */
    347  1.1  takemura 			reg |= (bus_space_read_2(sc->sc_iot, sc->sc_ioh, ih->ih_mhreg) << 16);
    348  1.1  takemura 			bitdisp32(reg);
    349  1.1  takemura 		} else
    350  1.1  takemura 			bitdisp16(reg);
    351  1.1  takemura 	}
    352  1.1  takemura }
    353  1.1  takemura 
    354  1.1  takemura /* Get level 2 interrupt status */
    355  1.1  takemura void
    356  1.1  takemura vrip_intr_get_status2(vc, arg, mask)
    357  1.1  takemura 	vrip_chipset_tag_t vc;
    358  1.1  takemura 	void *arg;
    359  1.1  takemura 	u_int32_t *mask; /* Level 2 mask */
    360  1.1  takemura {
    361  1.1  takemura 	struct vrip_softc *sc = (void*)vc;
    362  1.1  takemura 	struct intrhand *ih = arg;
    363  1.1  takemura 	u_int32_t reg;
    364  1.1  takemura 	reg = bus_space_read_2(sc->sc_iot, sc->sc_ioh,
    365  1.1  takemura 			       ih->ih_lreg);
    366  1.1  takemura 	reg |= ((bus_space_read_2(sc->sc_iot, sc->sc_ioh,
    367  1.1  takemura 				  ih->ih_hreg) << 16)&0xffff0000);
    368  1.1  takemura /*    bitdisp32(reg);*/
    369  1.1  takemura 	*mask = reg;
    370  1.1  takemura }
    371  1.1  takemura 
    372  1.1  takemura /* Set level 2 interrupt mask. */
    373  1.1  takemura void
    374  1.1  takemura vrip_intr_setmask2(vc, arg, mask, onoff)
    375  1.1  takemura 	vrip_chipset_tag_t vc;
    376  1.1  takemura 	void *arg;
    377  1.1  takemura 	u_int32_t mask; /* Level 2 mask */
    378  1.1  takemura {
    379  1.1  takemura 	struct vrip_softc *sc = (void*)vc;
    380  1.1  takemura 	struct intrhand *ih = arg;
    381  1.1  takemura 	u_int16_t reg;
    382  1.3  takemura 
    383  1.6      sato 	DPRINTF(("vrip_intr_setmask2:\n"));
    384  1.6      sato 	DDUMP_LEVEL2MASK(vc, arg);
    385  1.1  takemura #ifdef WINCE_DEFAULT_SETTING
    386  1.1  takemura #warning WINCE_DEFAULT_SETTING
    387  1.1  takemura #else
    388  1.1  takemura 	if (ih->ih_mlreg) {
    389  1.1  takemura 		reg = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ih->ih_mlreg);
    390  1.1  takemura 		if (onoff)
    391  1.1  takemura 			reg |= (mask&0xffff);
    392  1.1  takemura 		else
    393  1.1  takemura 			reg &= ~(mask&0xffff);
    394  1.1  takemura 		bus_space_write_2(sc->sc_iot, sc->sc_ioh, ih->ih_mlreg, reg);
    395  1.1  takemura 		if (ih->ih_mhreg != -1) { /* GIU [16:31] case only */
    396  1.1  takemura 			reg = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ih->ih_mhreg);
    397  1.1  takemura 			if (onoff)
    398  1.1  takemura 				reg |= ((mask >> 16) & 0xffff);
    399  1.1  takemura 			else
    400  1.1  takemura 				reg &= ~((mask >> 16) & 0xffff);
    401  1.1  takemura 			bus_space_write_2(sc->sc_iot, sc->sc_ioh,
    402  1.1  takemura 					  ih->ih_mhreg, reg);
    403  1.1  takemura 		}
    404  1.1  takemura 	}
    405  1.1  takemura #endif /* WINCE_DEFAULT_SETTING */
    406  1.6      sato 	DDUMP_LEVEL2MASK(vc, arg);
    407  1.3  takemura 
    408  1.1  takemura 	return;
    409  1.1  takemura }
    410  1.1  takemura 
    411  1.1  takemura int
    412  1.1  takemura vrip_intr(arg, pc, statusReg)
    413  1.1  takemura 	void *arg;
    414  1.1  takemura 	u_int32_t pc;
    415  1.1  takemura 	u_int32_t statusReg;
    416  1.1  takemura {
    417  1.1  takemura 	struct vrip_softc *sc = (struct vrip_softc*)arg;
    418  1.1  takemura 	bus_space_tag_t iot = sc->sc_iot;
    419  1.1  takemura 	bus_space_handle_t ioh = sc->sc_ioh;
    420  1.1  takemura 	int i;
    421  1.1  takemura 	u_int32_t reg, mask;
    422  1.1  takemura 	/*
    423  1.1  takemura 	 *  Read level1 interrupt status.
    424  1.1  takemura 	 */
    425  1.1  takemura 	reg = (bus_space_read_2 (iot, ioh, SYSINT1_REG_W)&0xffff) |
    426  1.1  takemura 		((bus_space_read_2 (iot, ioh, SYSINT2_REG_W)<< 16)&0xffff0000);
    427  1.1  takemura 	mask = (bus_space_read_2 (iot, ioh, MSYSINT1_REG_W)&0xffff) |
    428  1.1  takemura 		((bus_space_read_2 (iot, ioh, MSYSINT2_REG_W)<< 16)&0xffff0000);
    429  1.1  takemura 	reg &= mask;
    430  1.1  takemura 
    431  1.1  takemura 	/*
    432  1.1  takemura 	 *  Dispatch each handler.
    433  1.1  takemura 	 */
    434  1.1  takemura 	for (i = 0; i < 32; i++) {
    435  1.1  takemura 		register struct intrhand *ih = &intrhand[i];
    436  1.1  takemura 		if (ih->ih_fun && (reg & (1 << i))) {
    437  1.1  takemura 			ih->ih_fun(ih->ih_arg);
    438  1.1  takemura 		}
    439  1.1  takemura 	}
    440  1.1  takemura 	return 1;
    441  1.1  takemura }
    442  1.1  takemura 
    443  1.1  takemura void
    444  1.1  takemura vrip_cmu_function_register(vc, func, arg)
    445  1.1  takemura 	vrip_chipset_tag_t vc;
    446  1.1  takemura 	vrcmu_function_tag_t func;
    447  1.1  takemura 	vrcmu_chipset_tag_t arg;
    448  1.1  takemura {
    449  1.1  takemura 	struct vrip_softc *sc = (void*)vc;
    450  1.1  takemura 	sc->sc_cf = func;
    451  1.1  takemura 	sc->sc_cc = arg;
    452  1.1  takemura }
    453  1.1  takemura 
    454  1.1  takemura void
    455  1.1  takemura vrip_giu_function_register(vc, func, arg)
    456  1.1  takemura 	vrip_chipset_tag_t vc;
    457  1.1  takemura 	vrgiu_function_tag_t func;
    458  1.1  takemura 	vrgiu_chipset_tag_t arg;
    459  1.1  takemura {
    460  1.1  takemura 	struct vrip_softc *sc = (void*)vc;
    461  1.1  takemura 	sc->sc_gf = func;
    462  1.1  takemura 	sc->sc_gc = arg;
    463  1.1  takemura }
    464