Home | History | Annotate | Line # | Download | only in sa11x0
sa1111.c revision 1.3.4.4
      1  1.3.4.4  nathanw /*      $NetBSD: sa1111.c,v 1.3.4.4 2002/10/18 02:35:39 nathanw Exp $	*/
      2  1.3.4.2  nathanw 
      3  1.3.4.2  nathanw /*-
      4  1.3.4.2  nathanw  * Copyright (c) 2001 The NetBSD Foundation, Inc.
      5  1.3.4.2  nathanw  * All rights reserved.
      6  1.3.4.2  nathanw  *
      7  1.3.4.2  nathanw  * This code is derived from software contributed to The NetBSD Foundation
      8  1.3.4.2  nathanw  * by IWAMOTO Toshihiro.
      9  1.3.4.2  nathanw  *
     10  1.3.4.2  nathanw  * Redistribution and use in source and binary forms, with or without
     11  1.3.4.2  nathanw  * modification, are permitted provided that the following conditions
     12  1.3.4.2  nathanw  * are met:
     13  1.3.4.2  nathanw  * 1. Redistributions of source code must retain the above copyright
     14  1.3.4.2  nathanw  *    notice, this list of conditions and the following disclaimer.
     15  1.3.4.2  nathanw  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.3.4.2  nathanw  *    notice, this list of conditions and the following disclaimer in the
     17  1.3.4.2  nathanw  *    documentation and/or other materials provided with the distribution.
     18  1.3.4.2  nathanw  * 3. All advertising materials mentioning features or use of this software
     19  1.3.4.2  nathanw  *    must display the following acknowledgement:
     20  1.3.4.2  nathanw  *        This product includes software developed by the NetBSD
     21  1.3.4.2  nathanw  *        Foundation, Inc. and its contributors.
     22  1.3.4.2  nathanw  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  1.3.4.2  nathanw  *    contributors may be used to endorse or promote products derived
     24  1.3.4.2  nathanw  *    from this software without specific prior written permission.
     25  1.3.4.2  nathanw  *
     26  1.3.4.2  nathanw  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  1.3.4.2  nathanw  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  1.3.4.2  nathanw  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  1.3.4.2  nathanw  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  1.3.4.2  nathanw  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  1.3.4.2  nathanw  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  1.3.4.2  nathanw  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  1.3.4.2  nathanw  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  1.3.4.2  nathanw  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  1.3.4.2  nathanw  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  1.3.4.2  nathanw  * POSSIBILITY OF SUCH DAMAGE.
     37  1.3.4.2  nathanw  */
     38  1.3.4.2  nathanw 
     39  1.3.4.2  nathanw /*
     40  1.3.4.2  nathanw  * TODO:
     41  1.3.4.2  nathanw  *   - separate machine specific attach code
     42  1.3.4.2  nathanw  *   - introduce bus abstraction to support SA1101
     43  1.3.4.2  nathanw  */
     44  1.3.4.2  nathanw 
     45  1.3.4.2  nathanw #include <sys/param.h>
     46  1.3.4.2  nathanw #include <sys/systm.h>
     47  1.3.4.2  nathanw #include <sys/types.h>
     48  1.3.4.2  nathanw #include <sys/conf.h>
     49  1.3.4.2  nathanw #include <sys/device.h>
     50  1.3.4.2  nathanw #include <sys/kernel.h>
     51  1.3.4.2  nathanw #include <sys/malloc.h>
     52  1.3.4.2  nathanw #include <sys/uio.h>
     53  1.3.4.2  nathanw 
     54  1.3.4.2  nathanw #include <machine/bus.h>
     55  1.3.4.2  nathanw #ifdef hpcarm
     56  1.3.4.2  nathanw #include <machine/platid.h>
     57  1.3.4.2  nathanw #include <machine/platid_mask.h>
     58  1.3.4.2  nathanw #endif
     59  1.3.4.2  nathanw 
     60  1.3.4.2  nathanw #include <arm/sa11x0/sa11x0_reg.h>
     61  1.3.4.2  nathanw #include <arm/sa11x0/sa11x0_var.h>
     62  1.3.4.2  nathanw #include <arm/sa11x0/sa11x0_gpioreg.h>
     63  1.3.4.2  nathanw #include <arm/sa11x0/sa1111_reg.h>
     64  1.3.4.2  nathanw #include <arm/sa11x0/sa1111_var.h>
     65  1.3.4.2  nathanw 
     66  1.3.4.2  nathanw static	int	sacc_probe(struct device *, struct cfdata *, void *);
     67  1.3.4.2  nathanw static	void	sacc_attach(struct device *, struct device *, void *);
     68  1.3.4.2  nathanw static	int	sa1111_search(struct device *, struct cfdata *, void *);
     69  1.3.4.2  nathanw static	int	sa1111_print(void *, const char *);
     70  1.3.4.2  nathanw 
     71  1.3.4.2  nathanw static void	sacc_intr_calculatemasks(struct sacc_softc *);
     72  1.3.4.2  nathanw static void	sacc_intr_setpolarity(sacc_chipset_tag_t *, int , int);
     73  1.3.4.2  nathanw int		sacc_intr(void *);
     74  1.3.4.2  nathanw 
     75  1.3.4.2  nathanw #ifndef hpcarm
     76  1.3.4.2  nathanw void *softintr_establish(int, int (*)(void *), void *);
     77  1.3.4.2  nathanw void softintr_schedule(void *);
     78  1.3.4.2  nathanw #endif
     79  1.3.4.2  nathanw 
     80  1.3.4.2  nathanw #ifdef hpcarm
     81  1.3.4.2  nathanw struct platid_data sacc_platid_table[] = {
     82  1.3.4.2  nathanw 	{ &platid_mask_MACH_HP_JORNADA_720, (void *)1 },
     83  1.3.4.2  nathanw 	{ &platid_mask_MACH_HP_JORNADA_720JP, (void *)1 },
     84  1.3.4.2  nathanw 	{ NULL, NULL }
     85  1.3.4.2  nathanw };
     86  1.3.4.2  nathanw #endif
     87  1.3.4.2  nathanw 
     88  1.3.4.4  nathanw CFATTACH_DECL(sacc, sizeof(struct sacc_softc),
     89  1.3.4.4  nathanw     sacc_probe, sacc_attach, NULL, NULL);
     90  1.3.4.2  nathanw 
     91  1.3.4.2  nathanw #ifdef INTR_DEBUG
     92  1.3.4.2  nathanw #define DPRINTF(arg)	printf arg
     93  1.3.4.2  nathanw #else
     94  1.3.4.2  nathanw #define DPRINTF(arg)
     95  1.3.4.2  nathanw #endif
     96  1.3.4.2  nathanw 
     97  1.3.4.2  nathanw static int
     98  1.3.4.2  nathanw sacc_probe(parent, match, aux)
     99  1.3.4.2  nathanw 	struct device *parent;
    100  1.3.4.2  nathanw 	struct cfdata *match;
    101  1.3.4.2  nathanw 	void *aux;
    102  1.3.4.2  nathanw {
    103  1.3.4.2  nathanw 	struct sa11x0_attach_args *sa = aux;
    104  1.3.4.2  nathanw 	bus_space_handle_t ioh;
    105  1.3.4.2  nathanw 	u_int32_t skid;
    106  1.3.4.2  nathanw 
    107  1.3.4.2  nathanw 	if (bus_space_map(sa->sa_iot, sa->sa_addr, sa->sa_size, 0, &ioh))
    108  1.3.4.2  nathanw 		return (0);
    109  1.3.4.2  nathanw 
    110  1.3.4.2  nathanw 	skid = bus_space_read_4(sa->sa_iot, ioh, SACCSBI_SKID);
    111  1.3.4.2  nathanw 	bus_space_unmap(sa->sa_iot, ioh, sa->sa_size);
    112  1.3.4.2  nathanw 
    113  1.3.4.2  nathanw 	if ((skid & 0xffffff00) != 0x690cc200)
    114  1.3.4.2  nathanw 		return (0);
    115  1.3.4.2  nathanw 
    116  1.3.4.2  nathanw 	return (1);
    117  1.3.4.2  nathanw }
    118  1.3.4.2  nathanw 
    119  1.3.4.2  nathanw static void
    120  1.3.4.2  nathanw sacc_attach(parent, self, aux)
    121  1.3.4.2  nathanw 	struct device *parent;
    122  1.3.4.2  nathanw 	struct device *self;
    123  1.3.4.2  nathanw 	void *aux;
    124  1.3.4.2  nathanw {
    125  1.3.4.2  nathanw 	int i, gpiopin;
    126  1.3.4.2  nathanw 	u_int32_t skid;
    127  1.3.4.2  nathanw 	struct sacc_softc *sc = (struct sacc_softc *)self;
    128  1.3.4.2  nathanw 	struct sa11x0_softc *psc = (struct sa11x0_softc *)parent;
    129  1.3.4.2  nathanw 	struct sa11x0_attach_args *sa = aux;
    130  1.3.4.2  nathanw #ifdef hpcarm
    131  1.3.4.2  nathanw 	struct platid_data *p;
    132  1.3.4.2  nathanw #endif
    133  1.3.4.2  nathanw 
    134  1.3.4.2  nathanw 	printf("\n");
    135  1.3.4.2  nathanw 
    136  1.3.4.2  nathanw 	sc->sc_iot = sa->sa_iot;
    137  1.3.4.2  nathanw 	sc->sc_piot = psc->sc_iot;
    138  1.3.4.2  nathanw 	sc->sc_gpioh = psc->sc_gpioh;
    139  1.3.4.2  nathanw #ifdef hpcarm
    140  1.3.4.2  nathanw 	if ((p = platid_search_data(&platid, sacc_platid_table)) == NULL)
    141  1.3.4.2  nathanw 		return;
    142  1.3.4.2  nathanw 
    143  1.3.4.2  nathanw 	gpiopin = (int) p->data;
    144  1.3.4.2  nathanw #else
    145  1.3.4.2  nathanw 	gpiopin = sa->sa_gpio;
    146  1.3.4.2  nathanw #endif
    147  1.3.4.2  nathanw 	sc->sc_gpiomask = 1 << gpiopin;
    148  1.3.4.2  nathanw 
    149  1.3.4.2  nathanw 	if (bus_space_map(sa->sa_iot, sa->sa_addr, sa->sa_size, 0,
    150  1.3.4.2  nathanw 			  &sc->sc_ioh)) {
    151  1.3.4.2  nathanw 		printf("%s: unable to map registers\n", sc->sc_dev.dv_xname);
    152  1.3.4.2  nathanw 		return;
    153  1.3.4.2  nathanw 	}
    154  1.3.4.2  nathanw 
    155  1.3.4.2  nathanw 	skid = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SACCSBI_SKID);
    156  1.3.4.2  nathanw 
    157  1.3.4.2  nathanw 	printf("%s: SA1111 rev %d.%d\n", sc->sc_dev.dv_xname,
    158  1.3.4.2  nathanw 	       (skid & 0xf0) >> 3, skid & 0xf);
    159  1.3.4.2  nathanw 
    160  1.3.4.2  nathanw 	for(i = 0; i < SACCIC_LEN; i++)
    161  1.3.4.2  nathanw 		sc->sc_intrhand[i] = NULL;
    162  1.3.4.2  nathanw 
    163  1.3.4.2  nathanw 	/* initialize SA1111 interrupt controller */
    164  1.3.4.2  nathanw 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SACCIC_INTEN0, 0);
    165  1.3.4.2  nathanw 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SACCIC_INTEN1, 0);
    166  1.3.4.2  nathanw 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SACCIC_INTTSTSEL, 0);
    167  1.3.4.2  nathanw 	bus_space_write_4(sc->sc_iot, sc->sc_ioh,
    168  1.3.4.2  nathanw 			  SACCIC_INTSTATCLR0, 0xffffffff);
    169  1.3.4.2  nathanw 	bus_space_write_4(sc->sc_iot, sc->sc_ioh,
    170  1.3.4.2  nathanw 			  SACCIC_INTSTATCLR1, 0xffffffff);
    171  1.3.4.2  nathanw 
    172  1.3.4.2  nathanw 	/* connect to SA1110's GPIO intr */
    173  1.3.4.2  nathanw 	sa11x0_intr_establish(0, gpiopin, 1, IPL_SERIAL, sacc_intr, sc);
    174  1.3.4.2  nathanw 
    175  1.3.4.2  nathanw 	/*
    176  1.3.4.2  nathanw 	 *  Attach each devices
    177  1.3.4.2  nathanw 	 */
    178  1.3.4.2  nathanw 	config_search(sa1111_search, self, NULL);
    179  1.3.4.2  nathanw }
    180  1.3.4.2  nathanw 
    181  1.3.4.2  nathanw static int
    182  1.3.4.2  nathanw sa1111_search(parent, cf, aux)
    183  1.3.4.2  nathanw 	struct device *parent;
    184  1.3.4.2  nathanw 	struct cfdata *cf;
    185  1.3.4.2  nathanw 	void *aux;
    186  1.3.4.2  nathanw {
    187  1.3.4.4  nathanw         if (config_match(parent, cf, NULL) > 0)
    188  1.3.4.2  nathanw                 config_attach(parent, cf, NULL, sa1111_print);
    189  1.3.4.2  nathanw 
    190  1.3.4.2  nathanw         return 0;
    191  1.3.4.2  nathanw }
    192  1.3.4.2  nathanw 
    193  1.3.4.2  nathanw static int
    194  1.3.4.2  nathanw sa1111_print(aux, name)
    195  1.3.4.2  nathanw 	void *aux;
    196  1.3.4.2  nathanw 	const char *name;
    197  1.3.4.2  nathanw {
    198  1.3.4.2  nathanw 	return (UNCONF);
    199  1.3.4.2  nathanw }
    200  1.3.4.2  nathanw 
    201  1.3.4.2  nathanw int
    202  1.3.4.2  nathanw sacc_intr(arg)
    203  1.3.4.2  nathanw 	void *arg;
    204  1.3.4.2  nathanw {
    205  1.3.4.2  nathanw 	int i;
    206  1.3.4.2  nathanw 	u_int32_t mask;
    207  1.3.4.2  nathanw 	struct sacc_intrvec intstat;
    208  1.3.4.2  nathanw 	struct sacc_softc *sc = arg;
    209  1.3.4.2  nathanw #ifdef hpcarm
    210  1.3.4.2  nathanw 	struct sacc_intrhand *ih;
    211  1.3.4.2  nathanw #endif
    212  1.3.4.2  nathanw 
    213  1.3.4.2  nathanw 	intstat.lo =
    214  1.3.4.2  nathanw 	    bus_space_read_4(sc->sc_iot, sc->sc_ioh, SACCIC_INTSTATCLR0);
    215  1.3.4.2  nathanw 	intstat.hi =
    216  1.3.4.2  nathanw 	    bus_space_read_4(sc->sc_iot, sc->sc_ioh, SACCIC_INTSTATCLR1);
    217  1.3.4.2  nathanw 	DPRINTF(("sacc_intr_dispatch: %x %x\n", intstat.lo, intstat.hi));
    218  1.3.4.2  nathanw 
    219  1.3.4.3  nathanw 	/* clear SA1110's GPIO intr status */
    220  1.3.4.3  nathanw 	bus_space_write_4(sc->sc_piot, sc->sc_gpioh,
    221  1.3.4.3  nathanw 			  SAGPIO_EDR, sc->sc_gpiomask);
    222  1.3.4.3  nathanw 
    223  1.3.4.2  nathanw 	for(i = 0, mask = 1; i < 32; i++, mask <<= 1)
    224  1.3.4.2  nathanw 		if (intstat.lo & mask) {
    225  1.3.4.2  nathanw 			/*
    226  1.3.4.2  nathanw 			 * Clear intr status before calling intr handlers.
    227  1.3.4.2  nathanw 			 * This cause stray interrupts, but clearing
    228  1.3.4.2  nathanw 			 * after calling intr handlers cause intr lossage.
    229  1.3.4.2  nathanw 			 */
    230  1.3.4.2  nathanw 			bus_space_write_4(sc->sc_iot, sc->sc_ioh,
    231  1.3.4.2  nathanw 					  SACCIC_INTSTATCLR0, 1 << i);
    232  1.3.4.2  nathanw 
    233  1.3.4.2  nathanw #ifdef hpcarm
    234  1.3.4.2  nathanw 			for(ih = sc->sc_intrhand[i]; ih; ih = ih->ih_next)
    235  1.3.4.2  nathanw 				softintr_schedule(ih->ih_soft);
    236  1.3.4.2  nathanw #endif
    237  1.3.4.2  nathanw 		}
    238  1.3.4.2  nathanw 	for(i = 0, mask = 1; i < SACCIC_LEN - 32; i++, mask <<= 1)
    239  1.3.4.2  nathanw 		if (intstat.hi & mask) {
    240  1.3.4.2  nathanw 			bus_space_write_4(sc->sc_iot, sc->sc_ioh,
    241  1.3.4.2  nathanw 					  SACCIC_INTSTATCLR1, 1 << i);
    242  1.3.4.2  nathanw #ifdef hpcarm
    243  1.3.4.2  nathanw 			for(ih = sc->sc_intrhand[i + 32]; ih; ih = ih->ih_next)
    244  1.3.4.2  nathanw 				softintr_schedule(ih->ih_soft);
    245  1.3.4.2  nathanw #endif
    246  1.3.4.2  nathanw 		}
    247  1.3.4.2  nathanw 	return 1;
    248  1.3.4.2  nathanw }
    249  1.3.4.2  nathanw 
    250  1.3.4.2  nathanw void *
    251  1.3.4.2  nathanw sacc_intr_establish(ic, irq, type, level, ih_fun, ih_arg)
    252  1.3.4.2  nathanw 	sacc_chipset_tag_t *ic;
    253  1.3.4.2  nathanw 	int irq, type, level;
    254  1.3.4.2  nathanw 	int (*ih_fun)(void *);
    255  1.3.4.2  nathanw 	void *ih_arg;
    256  1.3.4.2  nathanw {
    257  1.3.4.2  nathanw 	int s;
    258  1.3.4.2  nathanw 	struct sacc_softc *sc = (struct sacc_softc *)ic;
    259  1.3.4.2  nathanw 	struct sacc_intrhand **p, *ih;
    260  1.3.4.2  nathanw 
    261  1.3.4.2  nathanw 	/* no point in sleeping unless someone can free memory. */
    262  1.3.4.2  nathanw 	ih = malloc(sizeof *ih, M_DEVBUF, cold ? M_NOWAIT : M_WAITOK);
    263  1.3.4.2  nathanw 	if (ih == NULL)
    264  1.3.4.2  nathanw 		panic("sacc_intr_establish: can't malloc handler info");
    265  1.3.4.2  nathanw 
    266  1.3.4.2  nathanw 	if (irq < 0 || irq > SACCIC_LEN ||
    267  1.3.4.2  nathanw 	    ! (type == IST_EDGE_RAISE || type == IST_EDGE_FALL))
    268  1.3.4.2  nathanw 		panic("sacc_intr_establish: bogus irq or type");
    269  1.3.4.2  nathanw 
    270  1.3.4.2  nathanw 	if (sc->sc_intrhand[irq] == NULL) {
    271  1.3.4.2  nathanw 		sacc_intr_setpolarity(ic, irq, type);
    272  1.3.4.2  nathanw 		sc->sc_intrtype[irq] = type;
    273  1.3.4.2  nathanw 	} else if (sc->sc_intrtype[irq] != type)
    274  1.3.4.2  nathanw 		/* XXX we should be able to share raising and
    275  1.3.4.2  nathanw 		 * falling edge intrs */
    276  1.3.4.4  nathanw 		panic("sacc_intr_establish: type must be unique");
    277  1.3.4.2  nathanw 
    278  1.3.4.2  nathanw 	/* install intr handler */
    279  1.3.4.2  nathanw #ifdef hpcarm
    280  1.3.4.2  nathanw 	ih->ih_soft = softintr_establish(level, (void (*)(void *)) ih_fun,
    281  1.3.4.2  nathanw 					 ih_arg);
    282  1.3.4.2  nathanw #endif
    283  1.3.4.2  nathanw 	ih->ih_irq = irq;
    284  1.3.4.2  nathanw 	ih->ih_next = NULL;
    285  1.3.4.2  nathanw 
    286  1.3.4.2  nathanw 	s = splhigh();
    287  1.3.4.2  nathanw 	for(p = &sc->sc_intrhand[irq]; *p; p = &(*p)->ih_next)
    288  1.3.4.2  nathanw 		;
    289  1.3.4.2  nathanw 
    290  1.3.4.2  nathanw 	*p = ih;
    291  1.3.4.2  nathanw 
    292  1.3.4.2  nathanw 	sacc_intr_calculatemasks(sc);
    293  1.3.4.2  nathanw 	splx(s);
    294  1.3.4.2  nathanw 
    295  1.3.4.2  nathanw 	return(ih);
    296  1.3.4.2  nathanw }
    297  1.3.4.2  nathanw 
    298  1.3.4.2  nathanw void
    299  1.3.4.2  nathanw sacc_intr_disestablish(ic, arg)
    300  1.3.4.2  nathanw 	sacc_chipset_tag_t *ic;
    301  1.3.4.2  nathanw 	void *arg;
    302  1.3.4.2  nathanw {
    303  1.3.4.2  nathanw 	int irq, s;
    304  1.3.4.2  nathanw 	struct sacc_softc *sc = (struct sacc_softc *)ic;
    305  1.3.4.2  nathanw 	struct sacc_intrhand *ih, **p;
    306  1.3.4.2  nathanw 
    307  1.3.4.2  nathanw 	ih = (struct sacc_intrhand *)arg;
    308  1.3.4.2  nathanw 	irq = ih->ih_irq;
    309  1.3.4.2  nathanw 
    310  1.3.4.2  nathanw #ifdef DIAGNOSTIC
    311  1.3.4.2  nathanw 	if (irq < 0 || irq > SACCIC_LEN)
    312  1.3.4.2  nathanw 		panic("sacc_intr_disestablish: bogus irq");
    313  1.3.4.2  nathanw #endif
    314  1.3.4.2  nathanw 
    315  1.3.4.2  nathanw 	s = splhigh();
    316  1.3.4.2  nathanw 
    317  1.3.4.2  nathanw 	for(p = &sc->sc_intrhand[irq];; p = &(*p)->ih_next) {
    318  1.3.4.2  nathanw 		if (*p == NULL)
    319  1.3.4.2  nathanw 			panic("sacc_intr_disestablish: handler not registered");
    320  1.3.4.2  nathanw 		if (*p == ih)
    321  1.3.4.2  nathanw 			break;
    322  1.3.4.2  nathanw 	}
    323  1.3.4.2  nathanw 	*p = (*p)->ih_next;
    324  1.3.4.2  nathanw 
    325  1.3.4.2  nathanw 	sacc_intr_calculatemasks(sc);
    326  1.3.4.2  nathanw 	splx(s);
    327  1.3.4.2  nathanw 
    328  1.3.4.2  nathanw 	free(ih, M_DEVBUF);
    329  1.3.4.2  nathanw }
    330  1.3.4.2  nathanw 
    331  1.3.4.2  nathanw void
    332  1.3.4.2  nathanw sacc_intr_setpolarity(ic, irq, type)
    333  1.3.4.2  nathanw 	sacc_chipset_tag_t *ic;
    334  1.3.4.2  nathanw 	int irq;
    335  1.3.4.2  nathanw 	int type;
    336  1.3.4.2  nathanw {
    337  1.3.4.2  nathanw 	struct sacc_softc *sc = (struct sacc_softc *)ic;
    338  1.3.4.2  nathanw 	int s;
    339  1.3.4.2  nathanw 	u_int32_t pol, mask;
    340  1.3.4.2  nathanw 	int addr;
    341  1.3.4.2  nathanw 
    342  1.3.4.2  nathanw 	if (irq >= 32) {
    343  1.3.4.2  nathanw 		addr = SACCIC_INTPOL1;
    344  1.3.4.2  nathanw 		irq -= 32;
    345  1.3.4.2  nathanw 	} else
    346  1.3.4.2  nathanw 		addr = SACCIC_INTPOL0;
    347  1.3.4.2  nathanw 
    348  1.3.4.2  nathanw 	mask = (1 << irq);
    349  1.3.4.2  nathanw 
    350  1.3.4.2  nathanw 	s = splhigh();
    351  1.3.4.2  nathanw 	pol = bus_space_read_4(sc->sc_iot, sc->sc_ioh, addr);
    352  1.3.4.2  nathanw 	if (type == IST_EDGE_RAISE)
    353  1.3.4.2  nathanw 		pol &= ~mask;
    354  1.3.4.2  nathanw 	else
    355  1.3.4.2  nathanw 		pol |= mask;
    356  1.3.4.2  nathanw 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, addr, pol);
    357  1.3.4.2  nathanw 	splx(s);
    358  1.3.4.2  nathanw }
    359  1.3.4.2  nathanw 
    360  1.3.4.2  nathanw void
    361  1.3.4.2  nathanw sacc_intr_calculatemasks(sc)
    362  1.3.4.2  nathanw 	struct sacc_softc *sc;
    363  1.3.4.2  nathanw {
    364  1.3.4.2  nathanw 	int irq;
    365  1.3.4.2  nathanw 
    366  1.3.4.2  nathanw 	sc->sc_imask.lo = 0;
    367  1.3.4.2  nathanw 	sc->sc_imask.hi = 0;
    368  1.3.4.2  nathanw 	for(irq = 0; irq < 32; irq++)
    369  1.3.4.2  nathanw 		if (sc->sc_intrhand[irq])
    370  1.3.4.2  nathanw 			sc->sc_imask.lo |= (1 << irq);
    371  1.3.4.2  nathanw 	for(irq = 0; irq < SACCIC_LEN - 32; irq++)
    372  1.3.4.2  nathanw 		if (sc->sc_intrhand[irq + 32])
    373  1.3.4.2  nathanw 			sc->sc_imask.hi |= (1 << irq);
    374  1.3.4.2  nathanw 
    375  1.3.4.2  nathanw 
    376  1.3.4.2  nathanw 	/* XXX this should not be done here */
    377  1.3.4.2  nathanw 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SACCIC_INTEN0,
    378  1.3.4.2  nathanw 			  sc->sc_imask.lo);
    379  1.3.4.2  nathanw 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SACCIC_INTEN1,
    380  1.3.4.2  nathanw 			  sc->sc_imask.hi);
    381  1.3.4.2  nathanw 	DPRINTF(("sacc_intr_calculatemasks: %x %x\n", sc->sc_imask.lo,
    382  1.3.4.2  nathanw 	    sc->sc_imask.hi));
    383  1.3.4.2  nathanw }
    384