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