Home | History | Annotate | Line # | Download | only in vr
vrip.c revision 1.16
      1  1.16       uch /*	$NetBSD: vrip.c,v 1.16 2002/01/29 18:53:22 uch Exp $	*/
      2   1.1  takemura 
      3   1.1  takemura /*-
      4  1.14  takemura  * Copyright (c) 1999, 2002
      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.14  takemura  * 3. Neither the name of the project nor the names of its contributors
     16   1.1  takemura  *    may be used to endorse or promote products derived from this software
     17   1.1  takemura  *    without specific prior written permission.
     18   1.1  takemura  *
     19   1.1  takemura  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     20   1.1  takemura  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     21   1.1  takemura  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     22   1.1  takemura  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     23   1.1  takemura  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     24   1.1  takemura  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     25   1.1  takemura  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     26   1.1  takemura  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     27   1.1  takemura  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28   1.1  takemura  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29   1.1  takemura  * SUCH DAMAGE.
     30   1.1  takemura  *
     31   1.1  takemura  */
     32   1.7      sato #include "opt_vr41xx.h"
     33   1.7      sato #include "opt_tx39xx.h"
     34   1.7      sato 
     35   1.1  takemura #include <sys/param.h>
     36   1.1  takemura #include <sys/systm.h>
     37   1.1  takemura #include <sys/device.h>
     38   1.1  takemura #include <sys/reboot.h>
     39   1.1  takemura 
     40   1.1  takemura #include <machine/cpu.h>
     41   1.1  takemura #include <machine/bus.h>
     42   1.1  takemura #include <machine/autoconf.h>
     43   1.8      sato #include <machine/platid.h>
     44   1.8      sato #include <machine/platid_mask.h>
     45   1.1  takemura 
     46   1.1  takemura #include <hpcmips/vr/vr.h>
     47   1.9      sato #include <hpcmips/vr/vrcpudef.h>
     48  1.15  takemura #include <hpcmips/vr/vripunit.h>
     49  1.15  takemura #include <hpcmips/vr/vripif.h>
     50   1.1  takemura #include <hpcmips/vr/vripreg.h>
     51   1.1  takemura #include <hpcmips/vr/vripvar.h>
     52   1.1  takemura #include <hpcmips/vr/icureg.h>
     53  1.15  takemura #include <hpcmips/vr/cmureg.h>
     54   1.1  takemura #include "locators.h"
     55   1.1  takemura 
     56  1.16       uch #ifdef VRIP_DEBUG
     57  1.16       uch #define DPRINTF_ENABLE
     58  1.16       uch #define DPRINTF_DEBUG	vrip_debug
     59  1.16       uch #endif
     60  1.16       uch #define USE_HPC_DPRINTF
     61  1.16       uch #include <machine/debug.h>
     62  1.16       uch 
     63  1.16       uch #ifdef VRIP_DEBUG
     64  1.16       uch #define DBG_BIT_PRINT(reg) if (vrip_debug) dbg_bit_print(reg);
     65  1.16       uch #define DUMP_LEVEL2MASK(sc,arg) if (vrip_debug) __vrip_dump_level2mask(sc,arg)
     66   1.3  takemura #else
     67  1.16       uch #define DBG_BIT_PRINT(arg)
     68  1.16       uch #define DUMP_LEVEL2MASK(sc,arg)
     69   1.3  takemura #endif
     70   1.3  takemura 
     71  1.15  takemura #define MAX_LEVEL1 32
     72  1.15  takemura #define VALID_UNIT(sc, unit)	(0 <= (unit) && (unit) < (sc)->sc_nunits)
     73  1.15  takemura 
     74  1.14  takemura struct vrip_softc {
     75  1.14  takemura 	struct	device sc_dv;
     76  1.14  takemura 	bus_space_tag_t sc_iot;
     77  1.14  takemura 	bus_space_handle_t sc_ioh;
     78  1.14  takemura 	hpcio_chip_t sc_gpio_chips[VRIP_NIOCHIPS];
     79  1.14  takemura 	vrcmu_chipset_tag_t sc_cc;
     80  1.14  takemura 	int sc_pri; /* attaching device priority */
     81  1.14  takemura 	u_int32_t sc_intrmask;
     82  1.15  takemura 	struct vrip_chipset_tag sc_chipset;
     83  1.15  takemura 	const struct vrip_unit *sc_units;
     84  1.15  takemura 	int sc_nunits;
     85  1.15  takemura 	struct intrhand {
     86  1.15  takemura 		int	(*ih_fun)(void *);
     87  1.15  takemura 		void	*ih_arg;
     88  1.15  takemura 		const struct vrip_unit *ih_unit;
     89  1.15  takemura 	} sc_intrhands[MAX_LEVEL1];
     90  1.14  takemura };
     91  1.14  takemura 
     92  1.12       uch int	vripmatch(struct device *, struct cfdata *, void *);
     93  1.12       uch void	vripattach(struct device *, struct device *, void *);
     94  1.12       uch int	vrip_print(void *, const char *);
     95  1.12       uch int	vrip_search(struct device *, struct cfdata *, void *);
     96  1.12       uch int	vrip_intr(void *, u_int32_t, u_int32_t);
     97   1.1  takemura 
     98  1.15  takemura int __vrip_power(vrip_chipset_tag_t, int, int);
     99  1.15  takemura vrip_intr_handle_t __vrip_intr_establish(vrip_chipset_tag_t, int, int,
    100  1.15  takemura     int, int(*)(void*), void*);
    101  1.15  takemura void __vrip_intr_disestablish(vrip_chipset_tag_t, vrip_intr_handle_t);
    102  1.15  takemura void __vrip_intr_setmask1(vrip_chipset_tag_t, vrip_intr_handle_t, int);
    103  1.15  takemura void __vrip_intr_setmask2(vrip_chipset_tag_t, vrip_intr_handle_t,
    104  1.15  takemura     u_int32_t, int);
    105  1.15  takemura void __vrip_intr_getstatus2(vrip_chipset_tag_t, vrip_intr_handle_t,
    106  1.15  takemura     u_int32_t*);
    107  1.15  takemura void __vrip_register_cmu(vrip_chipset_tag_t, vrcmu_chipset_tag_t);
    108  1.15  takemura void __vrip_register_gpio(vrip_chipset_tag_t, hpcio_chip_t);
    109  1.15  takemura void __vrip_dump_level2mask(vrip_chipset_tag_t, void *);
    110   1.1  takemura 
    111   1.1  takemura struct cfattach vrip_ca = {
    112   1.1  takemura 	sizeof(struct vrip_softc), vripmatch, vripattach
    113   1.1  takemura };
    114   1.1  takemura 
    115  1.15  takemura struct vrip_softc *the_vrip_sc = NULL;
    116   1.1  takemura 
    117  1.15  takemura static const struct vrip_chipset_tag vrip_chipset_methods = {
    118  1.15  takemura 	.vc_power		= __vrip_power,
    119  1.15  takemura 	.vc_intr_establish	= __vrip_intr_establish,
    120  1.15  takemura 	.vc_intr_disestablish	= __vrip_intr_disestablish,
    121  1.15  takemura 	.vc_intr_setmask1	= __vrip_intr_setmask1,
    122  1.15  takemura 	.vc_intr_setmask2	= __vrip_intr_setmask2,
    123  1.15  takemura 	.vc_intr_getstatus2	= __vrip_intr_getstatus2,
    124  1.15  takemura 	.vc_register_cmu	= __vrip_register_cmu,
    125  1.15  takemura 	.vc_register_gpio	= __vrip_register_gpio,
    126  1.15  takemura };
    127   1.2  takemura 
    128  1.15  takemura static const struct vrip_unit vrip_units[] = {
    129  1.15  takemura 	[VRIP_UNIT_PMU] = { "pmu",
    130  1.15  takemura 			    { VRIP_INTR_POWER,	VRIP_INTR_BAT,	},	},
    131  1.15  takemura 	[VRIP_UNIT_RTC] = { "rtc",
    132  1.15  takemura 			    { VRIP_INTR_RTCL1,	},		},
    133  1.15  takemura 	[VRIP_UNIT_PIU] = { "piu",
    134  1.15  takemura 			    { VRIP_INTR_PIU, },
    135  1.15  takemura 			    CMUMASK_PIU,
    136  1.15  takemura 			    ICUPIUINT_REG_W,	MPIUINT_REG_W	},
    137  1.15  takemura 	[VRIP_UNIT_KIU] = { "kiu",
    138  1.15  takemura 			    { VRIP_INTR_KIU,	},
    139  1.15  takemura 			    CMUMASK_KIU,
    140  1.15  takemura 			    KIUINT_REG_W,	MKIUINT_REG_W	},
    141  1.15  takemura 	[VRIP_UNIT_SIU] = { "siu",
    142  1.15  takemura 			    { VRIP_INTR_SIU,	},		},
    143  1.15  takemura 	[VRIP_UNIT_GIU] = { "giu",
    144  1.15  takemura 			    { VRIP_INTR_GIU,	},
    145  1.15  takemura 			    0,
    146  1.15  takemura 			    GIUINT_L_REG_W,MGIUINT_L_REG_W,
    147  1.12       uch 			    GIUINT_H_REG_W,	MGIUINT_H_REG_W	},
    148  1.15  takemura 	[VRIP_UNIT_LED] = { "led",
    149  1.15  takemura 			    { VRIP_INTR_LED,	},		},
    150  1.15  takemura 	[VRIP_UNIT_AIU] = { "aiu",
    151  1.15  takemura 			    { VRIP_INTR_AIU,	},
    152  1.15  takemura 			    CMUMASK_AIU,
    153  1.15  takemura 			    AIUINT_REG_W,	MAIUINT_REG_W	},
    154  1.15  takemura 	[VRIP_UNIT_FIR] = { "fir",
    155  1.15  takemura 			    { VRIP_INTR_FIR,	},
    156  1.15  takemura 			    CMUMASK_FIR,
    157  1.15  takemura 			    FIRINT_REG_W,	MFIRINT_REG_W	},
    158  1.15  takemura 	[VRIP_UNIT_DSIU]= { "dsiu",
    159  1.15  takemura 			    { VRIP_INTR_DSIU,	},
    160  1.15  takemura 			    CMUMASK_DSIU,
    161  1.15  takemura 			    DSIUINT_REG_W,	MDSIUINT_REG_W	},
    162  1.15  takemura 	[VRIP_UNIT_PCIU]= { "pciu",
    163  1.15  takemura 			    { VRIP_INTR_PCI,	},
    164  1.15  takemura 			    CMUMASK_PCIU,
    165  1.15  takemura 			    PCIINT_REG_W,	MPCIINT_REG_W	},
    166  1.15  takemura 	[VRIP_UNIT_SCU] = { "scu",
    167  1.15  takemura 			    { VRIP_INTR_SCU,	},
    168  1.15  takemura 			    0,
    169  1.15  takemura 			    SCUINT_REG_W,	MSCUINT_REG_W	},
    170  1.15  takemura 	[VRIP_UNIT_CSI] = { "csi",
    171  1.15  takemura 			    { VRIP_INTR_CSI,	},
    172  1.15  takemura 			    CMUMASK_CSI,
    173  1.15  takemura 			    CSIINT_REG_W,	MCSIINT_REG_W	},
    174  1.15  takemura 	[VRIP_UNIT_BCU] = { "bcu",
    175  1.15  takemura 			    { VRIP_INTR_BCU,	},
    176  1.15  takemura 			    0,
    177  1.15  takemura 			    BCUINT_REG_W,	MBCUINT_REG_W	}
    178   1.1  takemura };
    179   1.9      sato 
    180   1.1  takemura int
    181  1.12       uch vripmatch(struct device *parent, struct cfdata *match, void *aux)
    182   1.1  takemura {
    183   1.1  takemura 	struct mainbus_attach_args *ma = aux;
    184   1.7      sato 
    185   1.7      sato #ifdef TX39XX
    186   1.7      sato 	if (!platid_match(&platid, &platid_mask_CPU_MIPS_VR_41XX))
    187  1.13       uch 		return (0);
    188  1.13       uch #endif /* TX39XX */
    189   1.1  takemura 	if (strcmp(ma->ma_name, match->cf_driver->cd_name))
    190  1.12       uch 		return (0);
    191  1.12       uch 
    192  1.12       uch 	return (1);
    193   1.1  takemura }
    194   1.1  takemura 
    195   1.1  takemura void
    196  1.12       uch vripattach(struct device *parent, struct device *self, void *aux)
    197   1.1  takemura {
    198  1.15  takemura 	struct vrip_softc *sc = (struct vrip_softc*)self;
    199  1.15  takemura 
    200  1.15  takemura 	printf("\n");
    201  1.15  takemura 
    202  1.15  takemura 	sc->sc_units = vrip_units;
    203  1.15  takemura 	sc->sc_nunits = sizeof(vrip_units)/sizeof(struct vrip_unit);
    204  1.15  takemura 
    205  1.15  takemura 	vripattach_common(parent, self, aux);
    206  1.15  takemura }
    207  1.15  takemura 
    208  1.15  takemura void
    209  1.15  takemura vripattach_common(struct device *parent, struct device *self, void *aux)
    210  1.15  takemura {
    211   1.1  takemura 	struct mainbus_attach_args *ma = aux;
    212   1.1  takemura 	struct vrip_softc *sc = (struct vrip_softc*)self;
    213   1.1  takemura 
    214  1.15  takemura 	sc->sc_chipset = vrip_chipset_methods; /* structure assignment */
    215  1.15  takemura 	sc->sc_chipset.vc_sc = sc;
    216  1.15  takemura 
    217   1.1  takemura 	/*
    218   1.1  takemura 	 *  Map ICU (Interrupt Control Unit) register space.
    219   1.1  takemura 	 */
    220   1.1  takemura 	sc->sc_iot = ma->ma_iot;
    221  1.12       uch 	if (bus_space_map(sc->sc_iot, VRIP_ICU_ADDR,
    222  1.12       uch 	    0x20	/*XXX lower area only*/,
    223  1.12       uch 	    0,		/* no flags */
    224  1.12       uch 	    &sc->sc_ioh)) {
    225   1.1  takemura 		printf("vripattach: can't map ICU register.\n");
    226   1.1  takemura 		return;
    227   1.1  takemura 	}
    228   1.1  takemura 
    229   1.1  takemura 	/*
    230   1.1  takemura 	 *  Disable all Level 1 interrupts.
    231   1.1  takemura 	 */
    232   1.2  takemura 	sc->sc_intrmask = 0;
    233   1.1  takemura 	bus_space_write_2(sc->sc_iot, sc->sc_ioh, MSYSINT1_REG_W, 0x0000);
    234   1.1  takemura 	bus_space_write_2(sc->sc_iot, sc->sc_ioh, MSYSINT2_REG_W, 0x0000);
    235   1.1  takemura 	/*
    236   1.1  takemura 	 *  Level 1 interrupts are redirected to HwInt0
    237   1.1  takemura 	 */
    238   1.1  takemura 	vr_intr_establish(VR_INTR0, vrip_intr, self);
    239   1.2  takemura 	the_vrip_sc = sc;
    240   1.1  takemura 	/*
    241   1.1  takemura 	 *  Attach each devices
    242  1.12       uch 	 *	GIU CMU interface interface is used by other system device.
    243  1.12       uch 	 *	so attach first
    244   1.1  takemura 	 */
    245   1.1  takemura 	sc->sc_pri = 2;
    246   1.1  takemura 	config_search(vrip_search, self, vrip_print);
    247   1.1  takemura 	/* Other system devices. */
    248   1.1  takemura 	sc->sc_pri = 1;
    249   1.1  takemura 	config_search(vrip_search, self, vrip_print);
    250   1.1  takemura }
    251   1.1  takemura 
    252   1.1  takemura int
    253  1.12       uch vrip_print(void *aux, const char *hoge)
    254   1.1  takemura {
    255   1.1  takemura 	struct vrip_attach_args *va = (struct vrip_attach_args*)aux;
    256   1.1  takemura 
    257   1.1  takemura 	if (va->va_addr)
    258   1.5  takemura 		printf(" addr 0x%lx", va->va_addr);
    259   1.1  takemura 	if (va->va_size > 1)
    260   1.5  takemura 		printf("-0x%lx", va->va_addr + va->va_size - 1);
    261  1.12       uch 
    262   1.1  takemura 	return (UNCONF);
    263   1.1  takemura }
    264   1.1  takemura 
    265   1.1  takemura int
    266  1.12       uch vrip_search(struct device *parent, struct cfdata *cf, void *aux)
    267   1.1  takemura {
    268   1.1  takemura 	struct vrip_softc *sc = (struct vrip_softc *)parent;
    269   1.1  takemura 	struct vrip_attach_args va;
    270   1.1  takemura 
    271  1.15  takemura 	va.va_vc = &sc->sc_chipset;
    272   1.1  takemura 	va.va_iot = sc->sc_iot;
    273  1.15  takemura 	va.va_unit = cf->cf_loc[VRIPIFCF_UNIT];
    274  1.15  takemura 	va.va_addr = cf->cf_loc[VRIPIFCF_ADDR];
    275  1.15  takemura 	va.va_size = cf->cf_loc[VRIPIFCF_SIZE];
    276  1.15  takemura 	va.va_addr2 = cf->cf_loc[VRIPIFCF_ADDR2];
    277  1.15  takemura 	va.va_size2 = cf->cf_loc[VRIPIFCF_SIZE2];
    278  1.10  takemura 	va.va_gpio_chips = sc->sc_gpio_chips;
    279   1.1  takemura 	if (((*cf->cf_attach->ca_match)(parent, cf, &va) == sc->sc_pri))
    280   1.1  takemura 		config_attach(parent, cf, &va, vrip_print);
    281   1.1  takemura 
    282  1.12       uch 	return (0);
    283   1.1  takemura }
    284   1.1  takemura 
    285  1.15  takemura int
    286  1.15  takemura __vrip_power(vrip_chipset_tag_t vc, int unit, int onoff)
    287  1.15  takemura {
    288  1.15  takemura 	struct vrip_softc *sc = vc->vc_sc;
    289  1.15  takemura 	const struct vrip_unit *vu;
    290  1.15  takemura 
    291  1.15  takemura 	if (sc->sc_chipset.vc_cc == NULL)
    292  1.15  takemura 		return (0);	/* You have no clock mask unit yet. */
    293  1.15  takemura 	if (!VALID_UNIT(sc, unit))
    294  1.15  takemura 		return (0);
    295  1.15  takemura 	vu = &sc->sc_units[unit];
    296  1.15  takemura 
    297  1.15  takemura 	return (*sc->sc_chipset.vc_cc->cc_clock)(sc->sc_chipset.vc_cc,
    298  1.15  takemura 	    vu->vu_clkmask, onoff);
    299  1.15  takemura }
    300  1.15  takemura 
    301  1.15  takemura vrip_intr_handle_t
    302  1.15  takemura __vrip_intr_establish(vrip_chipset_tag_t vc, int unit, int line, int level,
    303  1.12       uch     int (*ih_fun)(void *), void *ih_arg)
    304   1.1  takemura {
    305  1.15  takemura 	struct vrip_softc *sc = vc->vc_sc;
    306  1.15  takemura 	const struct vrip_unit *vu;
    307   1.1  takemura 	struct intrhand *ih;
    308   1.1  takemura 
    309  1.15  takemura 	if (!VALID_UNIT(sc, unit))
    310  1.15  takemura 		return (NULL);
    311  1.15  takemura 	vu = &sc->sc_units[unit];
    312  1.15  takemura 	ih = &sc->sc_intrhands[vu->vu_intr[line]];
    313   1.1  takemura 	if (ih->ih_fun) /* Can't share level 1 interrupt */
    314  1.15  takemura 		return (NULL);
    315   1.1  takemura 	ih->ih_fun = ih_fun;
    316   1.1  takemura 	ih->ih_arg = ih_arg;
    317  1.15  takemura 	ih->ih_unit = vu;
    318   1.1  takemura 
    319   1.1  takemura 	/* Mask level 2 interrupt mask register. (disable interrupt) */
    320   1.1  takemura 	vrip_intr_setmask2(vc, ih, ~0, 0);
    321   1.1  takemura 	/* Unmask  Level 1 interrupt mask register (enable interrupt) */
    322   1.1  takemura 	vrip_intr_setmask1(vc, ih, 1);
    323   1.1  takemura 
    324  1.12       uch 	return ((void *)ih);
    325   1.1  takemura }
    326   1.1  takemura 
    327   1.1  takemura void
    328  1.15  takemura __vrip_intr_disestablish(vrip_chipset_tag_t vc, vrip_intr_handle_t handle)
    329   1.1  takemura {
    330  1.15  takemura 	struct intrhand *ih = handle;
    331  1.12       uch 
    332   1.1  takemura 	ih->ih_fun = NULL;
    333   1.1  takemura 	ih->ih_arg = NULL;
    334   1.1  takemura 	/* Mask level 2 interrupt mask register(if any). (disable interrupt) */
    335   1.1  takemura 	vrip_intr_setmask2(vc, ih, ~0, 0);
    336   1.1  takemura 	/* Mask  Level 1 interrupt mask register (disable interrupt) */
    337   1.1  takemura 	vrip_intr_setmask1(vc, ih, 0);
    338   1.1  takemura }
    339   1.1  takemura 
    340   1.2  takemura void
    341   1.2  takemura vrip_intr_suspend()
    342   1.2  takemura {
    343   1.2  takemura 	bus_space_tag_t iot = the_vrip_sc->sc_iot;
    344   1.2  takemura 	bus_space_handle_t ioh = the_vrip_sc->sc_ioh;
    345   1.2  takemura 
    346   1.2  takemura 	bus_space_write_2 (iot, ioh, MSYSINT1_REG_W, (1<<VRIP_INTR_POWER));
    347   1.2  takemura 	bus_space_write_2 (iot, ioh, MSYSINT2_REG_W, 0);
    348   1.2  takemura }
    349   1.2  takemura 
    350   1.2  takemura void
    351   1.2  takemura vrip_intr_resume()
    352   1.2  takemura {
    353   1.2  takemura 	u_int32_t reg = the_vrip_sc->sc_intrmask;
    354   1.2  takemura 	bus_space_tag_t iot = the_vrip_sc->sc_iot;
    355   1.2  takemura 	bus_space_handle_t ioh = the_vrip_sc->sc_ioh;
    356   1.2  takemura 
    357   1.2  takemura 	bus_space_write_2 (iot, ioh, MSYSINT1_REG_W, reg & 0xffff);
    358   1.2  takemura 	bus_space_write_2 (iot, ioh, MSYSINT2_REG_W, (reg >> 16) & 0xffff);
    359   1.2  takemura }
    360   1.2  takemura 
    361   1.1  takemura /* Set level 1 interrupt mask. */
    362   1.1  takemura void
    363  1.15  takemura __vrip_intr_setmask1(vrip_chipset_tag_t vc, vrip_intr_handle_t handle,
    364  1.15  takemura     int enable)
    365   1.1  takemura {
    366  1.15  takemura 	struct vrip_softc *sc = vc->vc_sc;
    367  1.15  takemura 	struct intrhand *ih = handle;
    368  1.15  takemura 	int level1 = ih - sc->sc_intrhands;
    369   1.1  takemura 	bus_space_tag_t iot = sc->sc_iot;
    370   1.1  takemura 	bus_space_handle_t ioh = sc->sc_ioh;
    371   1.2  takemura 	u_int32_t reg = sc->sc_intrmask;
    372   1.1  takemura 
    373  1.16       uch 	DPRINTF(("__vrip_intr_setmask1: SYSINT: %s %d\n",
    374  1.16       uch 		 enable ? "enable" : "disable", level1));
    375   1.1  takemura 	reg = (bus_space_read_2 (iot, ioh, MSYSINT1_REG_W)&0xffff) |
    376  1.12       uch 	    ((bus_space_read_2 (iot, ioh, MSYSINT2_REG_W)<< 16)&0xffff0000);
    377   1.1  takemura 	if (enable)
    378   1.1  takemura 		reg |= (1 << level1);
    379   1.1  takemura 	else {
    380   1.1  takemura 		reg &= ~(1 << level1);
    381   1.1  takemura 	}
    382   1.2  takemura 	sc->sc_intrmask = reg;
    383   1.1  takemura 	bus_space_write_2 (iot, ioh, MSYSINT1_REG_W, reg & 0xffff);
    384   1.1  takemura 	bus_space_write_2 (iot, ioh, MSYSINT2_REG_W, (reg >> 16) & 0xffff);
    385  1.16       uch 	DBG_BIT_PRINT(reg);
    386   1.1  takemura 
    387   1.1  takemura 	return;
    388   1.1  takemura }
    389   1.1  takemura 
    390  1.15  takemura void
    391  1.15  takemura __vrip_dump_level2mask(vrip_chipset_tag_t vc, vrip_intr_handle_t handle)
    392   1.1  takemura {
    393  1.15  takemura 	struct vrip_softc *sc = vc->vc_sc;
    394  1.15  takemura 	struct intrhand *ih = handle;
    395  1.15  takemura 	const struct vrip_unit *vu = ih->ih_unit;
    396   1.1  takemura 	u_int32_t reg;
    397   1.1  takemura 
    398  1.15  takemura 	if (vu->vu_mlreg) {
    399  1.16       uch 		DPRINTF(("level1[%d] level2 mask:", vu->vu_intr[0]));
    400  1.15  takemura 		reg = bus_space_read_2(sc->sc_iot, sc->sc_ioh, vu->vu_mlreg);
    401  1.15  takemura 		if (vu->vu_mhreg) { /* GIU [16:31] case only */
    402  1.16       uch 			reg |= (bus_space_read_2(sc->sc_iot, sc->sc_ioh,
    403  1.16       uch 			    vu->vu_mhreg) << 16);
    404  1.16       uch 			dbg_bit_print(reg);
    405   1.1  takemura 		} else
    406  1.16       uch 			dbg_bit_print(reg);
    407   1.1  takemura 	}
    408   1.1  takemura }
    409   1.1  takemura 
    410   1.1  takemura /* Get level 2 interrupt status */
    411   1.1  takemura void
    412  1.15  takemura __vrip_intr_getstatus2(vrip_chipset_tag_t vc, vrip_intr_handle_t handle,
    413  1.12       uch     u_int32_t *mask /* Level 2 mask */)
    414   1.1  takemura {
    415  1.15  takemura 	struct vrip_softc *sc = vc->vc_sc;
    416  1.15  takemura 	struct intrhand *ih = handle;
    417  1.15  takemura 	const struct vrip_unit *vu = ih->ih_unit;
    418   1.1  takemura 	u_int32_t reg;
    419  1.12       uch 
    420   1.1  takemura 	reg = bus_space_read_2(sc->sc_iot, sc->sc_ioh,
    421  1.15  takemura 	    vu->vu_lreg);
    422   1.1  takemura 	reg |= ((bus_space_read_2(sc->sc_iot, sc->sc_ioh,
    423  1.15  takemura 	    vu->vu_hreg) << 16)&0xffff0000);
    424  1.16       uch /*    dbg_bit_print(reg);*/
    425   1.1  takemura 	*mask = reg;
    426   1.1  takemura }
    427   1.1  takemura 
    428   1.1  takemura /* Set level 2 interrupt mask. */
    429   1.1  takemura void
    430  1.15  takemura __vrip_intr_setmask2(vrip_chipset_tag_t vc, vrip_intr_handle_t handle,
    431  1.12       uch     u_int32_t mask /* Level 2 mask */, int onoff)
    432   1.1  takemura {
    433  1.15  takemura 	struct vrip_softc *sc = vc->vc_sc;
    434  1.15  takemura 	struct intrhand *ih = handle;
    435  1.15  takemura 	const struct vrip_unit *vu = ih->ih_unit;
    436   1.1  takemura 	u_int16_t reg;
    437   1.3  takemura 
    438   1.6      sato 	DPRINTF(("vrip_intr_setmask2:\n"));
    439  1.16       uch 	DUMP_LEVEL2MASK(vc, handle);
    440   1.1  takemura #ifdef WINCE_DEFAULT_SETTING
    441   1.1  takemura #warning WINCE_DEFAULT_SETTING
    442   1.1  takemura #else
    443  1.15  takemura 	if (vu->vu_mlreg) {
    444  1.15  takemura 		reg = bus_space_read_2(sc->sc_iot, sc->sc_ioh, vu->vu_mlreg);
    445   1.1  takemura 		if (onoff)
    446   1.1  takemura 			reg |= (mask&0xffff);
    447   1.1  takemura 		else
    448   1.1  takemura 			reg &= ~(mask&0xffff);
    449  1.15  takemura 		bus_space_write_2(sc->sc_iot, sc->sc_ioh, vu->vu_mlreg, reg);
    450  1.15  takemura 		if (vu->vu_mhreg != -1) { /* GIU [16:31] case only */
    451  1.12       uch 			reg = bus_space_read_2(sc->sc_iot, sc->sc_ioh,
    452  1.15  takemura 			    vu->vu_mhreg);
    453   1.1  takemura 			if (onoff)
    454   1.1  takemura 				reg |= ((mask >> 16) & 0xffff);
    455   1.1  takemura 			else
    456  1.12       uch 				reg &= ~((mask >> 16) & 0xffff);
    457   1.1  takemura 			bus_space_write_2(sc->sc_iot, sc->sc_ioh,
    458  1.15  takemura 			    vu->vu_mhreg, reg);
    459   1.1  takemura 		}
    460   1.1  takemura 	}
    461   1.1  takemura #endif /* WINCE_DEFAULT_SETTING */
    462  1.16       uch 	DUMP_LEVEL2MASK(vc, handle);
    463   1.3  takemura 
    464   1.1  takemura 	return;
    465   1.1  takemura }
    466   1.1  takemura 
    467   1.1  takemura int
    468  1.12       uch vrip_intr(void *arg, u_int32_t pc, u_int32_t statusReg)
    469   1.1  takemura {
    470   1.1  takemura 	struct vrip_softc *sc = (struct vrip_softc*)arg;
    471   1.1  takemura 	bus_space_tag_t iot = sc->sc_iot;
    472   1.1  takemura 	bus_space_handle_t ioh = sc->sc_ioh;
    473   1.1  takemura 	int i;
    474   1.1  takemura 	u_int32_t reg, mask;
    475   1.1  takemura 	/*
    476   1.1  takemura 	 *  Read level1 interrupt status.
    477   1.1  takemura 	 */
    478   1.1  takemura 	reg = (bus_space_read_2 (iot, ioh, SYSINT1_REG_W)&0xffff) |
    479  1.12       uch 	    ((bus_space_read_2 (iot, ioh, SYSINT2_REG_W)<< 16)&0xffff0000);
    480   1.1  takemura 	mask = (bus_space_read_2 (iot, ioh, MSYSINT1_REG_W)&0xffff) |
    481  1.12       uch 	    ((bus_space_read_2 (iot, ioh, MSYSINT2_REG_W)<< 16)&0xffff0000);
    482   1.1  takemura 	reg &= mask;
    483   1.1  takemura 
    484   1.1  takemura 	/*
    485   1.1  takemura 	 *  Dispatch each handler.
    486   1.1  takemura 	 */
    487   1.1  takemura 	for (i = 0; i < 32; i++) {
    488  1.15  takemura 		register struct intrhand *ih = &sc->sc_intrhands[i];
    489   1.1  takemura 		if (ih->ih_fun && (reg & (1 << i))) {
    490   1.1  takemura 			ih->ih_fun(ih->ih_arg);
    491   1.1  takemura 		}
    492   1.1  takemura 	}
    493  1.12       uch 
    494  1.12       uch 	return (1);
    495   1.1  takemura }
    496   1.1  takemura 
    497   1.1  takemura void
    498  1.15  takemura __vrip_register_cmu(vrip_chipset_tag_t vc, vrcmu_chipset_tag_t cmu)
    499   1.1  takemura {
    500  1.15  takemura 	struct vrip_softc *sc = vc->vc_sc;
    501  1.12       uch 
    502  1.15  takemura 	sc->sc_chipset.vc_cc = cmu;
    503   1.1  takemura }
    504   1.1  takemura 
    505   1.1  takemura void
    506  1.15  takemura __vrip_register_gpio(vrip_chipset_tag_t vc, hpcio_chip_t chip)
    507   1.1  takemura {
    508  1.15  takemura 	struct vrip_softc *sc = vc->vc_sc;
    509  1.10  takemura 
    510  1.10  takemura 	if (chip->hc_chipid < 0 || VRIP_NIOCHIPS <= chip->hc_chipid)
    511  1.10  takemura 		panic("%s: '%s' has unknown id, %d", __FUNCTION__,
    512  1.10  takemura 		    chip->hc_name, chip->hc_chipid);
    513  1.10  takemura 	sc->sc_gpio_chips[chip->hc_chipid] = chip;
    514   1.1  takemura }
    515