Home | History | Annotate | Line # | Download | only in rmi
rmixl_intr.c revision 1.1.2.2
      1  1.1.2.2  cliff /*	$NetBSD: rmixl_intr.c,v 1.1.2.2 2009/09/25 22:22:09 cliff Exp $	*/
      2  1.1.2.1  cliff 
      3  1.1.2.1  cliff /*-
      4  1.1.2.1  cliff  * Copyright (c) 2007 Ruslan Ermilov and Vsevolod Lobko.
      5  1.1.2.1  cliff  * All rights reserved.
      6  1.1.2.1  cliff  *
      7  1.1.2.1  cliff  * Redistribution and use in source and binary forms, with or
      8  1.1.2.1  cliff  * without modification, are permitted provided that the following
      9  1.1.2.1  cliff  * conditions are met:
     10  1.1.2.1  cliff  * 1. Redistributions of source code must retain the above copyright
     11  1.1.2.1  cliff  *    notice, this list of conditions and the following disclaimer.
     12  1.1.2.1  cliff  * 2. Redistributions in binary form must reproduce the above
     13  1.1.2.1  cliff  *    copyright notice, this list of conditions and the following
     14  1.1.2.1  cliff  *    disclaimer in the documentation and/or other materials provided
     15  1.1.2.1  cliff  *    with the distribution.
     16  1.1.2.1  cliff  * 3. The names of the authors may not be used to endorse or promote
     17  1.1.2.1  cliff  *    products derived from this software without specific prior
     18  1.1.2.1  cliff  *    written permission.
     19  1.1.2.1  cliff  *
     20  1.1.2.1  cliff  * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY
     21  1.1.2.1  cliff  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
     22  1.1.2.1  cliff  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
     23  1.1.2.1  cliff  * PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHORS
     24  1.1.2.1  cliff  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
     25  1.1.2.1  cliff  * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
     26  1.1.2.1  cliff  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
     27  1.1.2.1  cliff  * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     28  1.1.2.1  cliff  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
     29  1.1.2.1  cliff  * TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
     30  1.1.2.1  cliff  * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
     31  1.1.2.1  cliff  * OF SUCH DAMAGE.
     32  1.1.2.1  cliff  */
     33  1.1.2.1  cliff /*-
     34  1.1.2.1  cliff  * Copyright (c) 2001 The NetBSD Foundation, Inc.
     35  1.1.2.1  cliff  * All rights reserved.
     36  1.1.2.1  cliff  *
     37  1.1.2.1  cliff  * This code is derived from software contributed to The NetBSD Foundation
     38  1.1.2.1  cliff  * by Jason R. Thorpe.
     39  1.1.2.1  cliff  *
     40  1.1.2.1  cliff  * Redistribution and use in source and binary forms, with or without
     41  1.1.2.1  cliff  * modification, are permitted provided that the following conditions
     42  1.1.2.1  cliff  * are met:
     43  1.1.2.1  cliff  * 1. Redistributions of source code must retain the above copyright
     44  1.1.2.1  cliff  *    notice, this list of conditions and the following disclaimer.
     45  1.1.2.1  cliff  * 2. Redistributions in binary form must reproduce the above copyright
     46  1.1.2.1  cliff  *    notice, this list of conditions and the following disclaimer in the
     47  1.1.2.1  cliff  *    documentation and/or other materials provided with the distribution.
     48  1.1.2.1  cliff  *
     49  1.1.2.1  cliff  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     50  1.1.2.1  cliff  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     51  1.1.2.1  cliff  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     52  1.1.2.1  cliff  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     53  1.1.2.1  cliff  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     54  1.1.2.1  cliff  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     55  1.1.2.1  cliff  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     56  1.1.2.1  cliff  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     57  1.1.2.1  cliff  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     58  1.1.2.1  cliff  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     59  1.1.2.1  cliff  * POSSIBILITY OF SUCH DAMAGE.
     60  1.1.2.1  cliff  */
     61  1.1.2.1  cliff 
     62  1.1.2.1  cliff /*
     63  1.1.2.1  cliff  * Platform-specific interrupt support for the RMI XLP, XLR, XLS
     64  1.1.2.1  cliff  */
     65  1.1.2.1  cliff 
     66  1.1.2.1  cliff #include <sys/cdefs.h>
     67  1.1.2.2  cliff __KERNEL_RCSID(0, "$NetBSD: rmixl_intr.c,v 1.1.2.2 2009/09/25 22:22:09 cliff Exp $");
     68  1.1.2.1  cliff 
     69  1.1.2.1  cliff #include "opt_ddb.h"
     70  1.1.2.1  cliff 
     71  1.1.2.1  cliff #include <sys/param.h>
     72  1.1.2.1  cliff #include <sys/queue.h>
     73  1.1.2.1  cliff #include <sys/malloc.h>
     74  1.1.2.1  cliff #include <sys/systm.h>
     75  1.1.2.1  cliff #include <sys/device.h>
     76  1.1.2.1  cliff #include <sys/kernel.h>
     77  1.1.2.1  cliff 
     78  1.1.2.1  cliff #include <machine/bus.h>
     79  1.1.2.1  cliff #include <machine/intr.h>
     80  1.1.2.1  cliff 
     81  1.1.2.1  cliff #include <mips/locore.h>
     82  1.1.2.1  cliff #include <mips/rmi/rmixlreg.h>
     83  1.1.2.1  cliff #include <mips/rmi/rmixlvar.h>
     84  1.1.2.1  cliff 
     85  1.1.2.1  cliff #include <dev/pci/pcireg.h>
     86  1.1.2.1  cliff #include <dev/pci/pcivar.h>
     87  1.1.2.1  cliff 
     88  1.1.2.1  cliff /*
     89  1.1.2.1  cliff  * This is a mask of bits to clear in the SR when we go to a
     90  1.1.2.1  cliff  * given hardware interrupt priority level.
     91  1.1.2.1  cliff  */
     92  1.1.2.1  cliff const uint32_t ipl_sr_bits[_IPL_N] = {
     93  1.1.2.2  cliff 	[IPL_NONE] = 0,
     94  1.1.2.2  cliff 	[IPL_SOFTCLOCK] =
     95  1.1.2.2  cliff 		MIPS_SOFT_INT_MASK_0,
     96  1.1.2.2  cliff 	[IPL_SOFTNET] =
     97  1.1.2.2  cliff 		MIPS_SOFT_INT_MASK_0
     98  1.1.2.2  cliff 	      | MIPS_SOFT_INT_MASK_1,
     99  1.1.2.2  cliff 	[IPL_VM] =
    100  1.1.2.2  cliff 		MIPS_SOFT_INT_MASK_0
    101  1.1.2.2  cliff 	      | MIPS_SOFT_INT_MASK_1
    102  1.1.2.2  cliff 	      | MIPS_INT_MASK_0,
    103  1.1.2.2  cliff 	[IPL_SCHED] =
    104  1.1.2.2  cliff 		MIPS_SOFT_INT_MASK_0
    105  1.1.2.2  cliff 	      | MIPS_SOFT_INT_MASK_1
    106  1.1.2.2  cliff 	      | MIPS_INT_MASK_0
    107  1.1.2.2  cliff 	      | MIPS_INT_MASK_1
    108  1.1.2.2  cliff 	      | MIPS_INT_MASK_2
    109  1.1.2.2  cliff 	      | MIPS_INT_MASK_3
    110  1.1.2.2  cliff 	      | MIPS_INT_MASK_4
    111  1.1.2.2  cliff 	      | MIPS_INT_MASK_5,
    112  1.1.2.1  cliff };
    113  1.1.2.1  cliff 
    114  1.1.2.2  cliff /*
    115  1.1.2.2  cliff  * 'IRQs' here are indiividual interrupt sources
    116  1.1.2.2  cliff  * each has a slot in the Interrupt Redirection Table (IRT)
    117  1.1.2.2  cliff  * in the order listed
    118  1.1.2.2  cliff  *
    119  1.1.2.2  cliff  * NOTE: many irq sources depend on the chip family
    120  1.1.2.2  cliff  * XLS1xx vs. XLS2xx vs. XLS3xx vs. XLS6xx
    121  1.1.2.2  cliff  * so just use generic names where they diverge
    122  1.1.2.2  cliff  */
    123  1.1.2.2  cliff #define	NIRQS	32
    124  1.1.2.2  cliff static const char *rmixl_irqnames[NIRQS] = {
    125  1.1.2.2  cliff 	"int 0 (watchdog)",	/*  0 */
    126  1.1.2.2  cliff 	"int 1 (timer0)",	/*  1 */
    127  1.1.2.2  cliff 	"int 2 (timer1)",	/*  2 */
    128  1.1.2.2  cliff 	"int 3 (timer2)",	/*  3 */
    129  1.1.2.2  cliff 	"int 4 (timer3)",	/*  4 */
    130  1.1.2.2  cliff 	"int 5 (timer4)",	/*  5 */
    131  1.1.2.2  cliff 	"int 6 (timer5)",	/*  6 */
    132  1.1.2.2  cliff 	"int 7 (timer6)",	/*  7 */
    133  1.1.2.2  cliff 	"int 8 (timer7)",	/*  8 */
    134  1.1.2.2  cliff 	"int 9 (uart0)",	/*  9 */
    135  1.1.2.2  cliff 	"int 10 (uart1)",	/* 10 */
    136  1.1.2.2  cliff 	"int 11 (i2c0)",	/* 11 */
    137  1.1.2.2  cliff 	"int 12 (i2c1)",	/* 12 */
    138  1.1.2.2  cliff 	"int 13 (pcmcia)",	/* 13 */
    139  1.1.2.2  cliff 	"int 14 (gpio_a)",	/* 14 */
    140  1.1.2.2  cliff 	"int 15 (irq15)",	/* 15 */
    141  1.1.2.2  cliff 	"int 16 (bridge_tb)",	/* 16 */
    142  1.1.2.2  cliff 	"int 17 (gmac0)",	/* 17 */
    143  1.1.2.2  cliff 	"int 18 (gmac1)",	/* 18 */
    144  1.1.2.2  cliff 	"int 19 (gmac2)",	/* 19 */
    145  1.1.2.2  cliff 	"int 20 (gmac3)",	/* 20 */
    146  1.1.2.2  cliff 	"int 21 (irq21)",	/* 21 */
    147  1.1.2.2  cliff 	"int 22 (irq22)",	/* 22 */
    148  1.1.2.2  cliff 	"int 23 (irq23)",	/* 23 */
    149  1.1.2.2  cliff 	"int 24 (irq24)",	/* 24 */
    150  1.1.2.2  cliff 	"int 25 (bridge_err)",	/* 25 */
    151  1.1.2.2  cliff 	"int 26 (pcie_link0)",	/* 26 */
    152  1.1.2.2  cliff 	"int 27 (pcie_link1)",	/* 27 */
    153  1.1.2.2  cliff 	"int 28 (irq28)",	/* 28 */
    154  1.1.2.2  cliff 	"int 29 (irq29)",	/* 29 */
    155  1.1.2.2  cliff 	"int 30 (gpio_b)",	/* 30 */
    156  1.1.2.2  cliff 	"int 31 (usb)",		/* 31 */
    157  1.1.2.1  cliff };
    158  1.1.2.1  cliff 
    159  1.1.2.2  cliff /*
    160  1.1.2.2  cliff  * per-IRQ event stats
    161  1.1.2.2  cliff  */
    162  1.1.2.2  cliff struct rmixl_irqtab {
    163  1.1.2.2  cliff 	struct evcnt irq_count;
    164  1.1.2.2  cliff 	void *irq_ih;
    165  1.1.2.1  cliff };
    166  1.1.2.2  cliff static struct rmixl_irqtab rmixl_irqtab[NIRQS];
    167  1.1.2.1  cliff 
    168  1.1.2.1  cliff 
    169  1.1.2.2  cliff /*
    170  1.1.2.2  cliff  * 'vectors' here correspond to IRT Entry vector numbers
    171  1.1.2.2  cliff  * - IRT Entry vector# is bit# in EIRR
    172  1.1.2.2  cliff  * - note that EIRR[7:0] == CAUSE[15:8]
    173  1.1.2.2  cliff  * - we actually only use the first _IPL_N bits
    174  1.1.2.2  cliff  *   (less than 8)
    175  1.1.2.2  cliff  *
    176  1.1.2.2  cliff  * each IRT entry gets routed to a vector
    177  1.1.2.2  cliff  * (if and when that interrupt is established)
    178  1.1.2.2  cliff  * the vectors are shared on a per-IPL basis
    179  1.1.2.2  cliff  * which simplifies dispatch
    180  1.1.2.2  cliff  *
    181  1.1.2.2  cliff  * XXX use of mips64 extended IRQs is TBD
    182  1.1.2.2  cliff  */
    183  1.1.2.2  cliff #define	NINTRVECS	_IPL_N
    184  1.1.2.2  cliff 
    185  1.1.2.2  cliff /*
    186  1.1.2.2  cliff  * translate IPL to vector number
    187  1.1.2.2  cliff  */
    188  1.1.2.2  cliff static const int rmixl_iplvec[_IPL_N] = {
    189  1.1.2.2  cliff 	[IPL_NONE] = 		-1,	/* XXX */
    190  1.1.2.2  cliff 	[IPL_SOFTCLOCK] =	 0,
    191  1.1.2.2  cliff 	[IPL_SOFTNET] =		 1,
    192  1.1.2.2  cliff 	[IPL_VM] =		 2,
    193  1.1.2.2  cliff 	[IPL_SCHED] =		 3,
    194  1.1.2.1  cliff };
    195  1.1.2.1  cliff 
    196  1.1.2.2  cliff /*
    197  1.1.2.2  cliff  * list and ref count manage sharing of each vector
    198  1.1.2.2  cliff  */
    199  1.1.2.2  cliff struct rmixl_intrvec {
    200  1.1.2.2  cliff 	LIST_HEAD(, evbmips_intrhand) iv_list;
    201  1.1.2.2  cliff 	u_int iv_refcnt;
    202  1.1.2.1  cliff };
    203  1.1.2.2  cliff static struct rmixl_intrvec rmixl_intrvec[NINTRVECS];
    204  1.1.2.2  cliff 
    205  1.1.2.2  cliff 
    206  1.1.2.2  cliff /*
    207  1.1.2.2  cliff  * register byte order is BIG ENDIAN regardless of code model
    208  1.1.2.2  cliff  */
    209  1.1.2.2  cliff #define REG_DEREF(o)					\
    210  1.1.2.2  cliff 	*((volatile uint32_t *)MIPS_PHYS_TO_KSEG1( 	\
    211  1.1.2.2  cliff 		rmixl_configuration.rc_io_pbase 	\
    212  1.1.2.2  cliff 		+ RMIXL_IO_DEV_PIC + (o)))
    213  1.1.2.1  cliff 
    214  1.1.2.2  cliff #define REG_READ(o)	be32toh(REG_DEREF(o))
    215  1.1.2.2  cliff #define REG_WRITE(o,v)	REG_DEREF(o) = htobe32(v)
    216  1.1.2.1  cliff 
    217  1.1.2.1  cliff void
    218  1.1.2.1  cliff evbmips_intr_init(void)
    219  1.1.2.1  cliff {
    220  1.1.2.2  cliff 	uint32_t r;
    221  1.1.2.1  cliff 	int i;
    222  1.1.2.1  cliff 
    223  1.1.2.2  cliff 	for (i=0; i < NIRQS; i++) {
    224  1.1.2.2  cliff 		evcnt_attach_dynamic(&rmixl_irqtab[i].irq_count,
    225  1.1.2.2  cliff 			EVCNT_TYPE_INTR, NULL, "rmixl", rmixl_irqnames[i]);
    226  1.1.2.2  cliff 		rmixl_irqtab[i].irq_ih = NULL;
    227  1.1.2.1  cliff 	}
    228  1.1.2.1  cliff 
    229  1.1.2.2  cliff 	for (i=0; i < NINTRVECS; i++) {
    230  1.1.2.2  cliff 		LIST_INIT(&rmixl_intrvec[i].iv_list);
    231  1.1.2.2  cliff 		rmixl_intrvec[i].iv_refcnt = 0;
    232  1.1.2.1  cliff 	}
    233  1.1.2.1  cliff 
    234  1.1.2.2  cliff 	/*
    235  1.1.2.2  cliff 	 * disable watchdog, watchdog NMI, timers
    236  1.1.2.2  cliff 	 */
    237  1.1.2.2  cliff 	r = REG_READ(RMIXL_PIC_CONTROL);
    238  1.1.2.2  cliff 	r &= RMIXL_PIC_CONTROL_RESV;
    239  1.1.2.2  cliff 	REG_WRITE(RMIXL_PIC_CONTROL, r);
    240  1.1.2.2  cliff 
    241  1.1.2.2  cliff 	/*
    242  1.1.2.2  cliff 	 * invalidate all IRT Entries
    243  1.1.2.2  cliff 	 * permanently unmask Thread#0 in low word
    244  1.1.2.2  cliff 	 * (assume we only have 1 thread)
    245  1.1.2.2  cliff 	 */
    246  1.1.2.2  cliff 	for (i=0; i < NIRQS; i++) {
    247  1.1.2.2  cliff 
    248  1.1.2.2  cliff 		/* high word */
    249  1.1.2.2  cliff 		r = REG_READ(RMIXL_PIC_IRTENTRYC1(i));
    250  1.1.2.2  cliff 		r &= RMIXL_PIC_IRTENTRYC1_RESV;
    251  1.1.2.2  cliff 		REG_WRITE(RMIXL_PIC_IRTENTRYC1(i), r);
    252  1.1.2.2  cliff 
    253  1.1.2.2  cliff 		/* low word */
    254  1.1.2.2  cliff 		r = REG_READ(RMIXL_PIC_IRTENTRYC0(i));
    255  1.1.2.2  cliff 		r &= RMIXL_PIC_IRTENTRYC0_RESV;
    256  1.1.2.2  cliff 		r |= 1;					/* Thread Mask */
    257  1.1.2.2  cliff 		REG_WRITE(RMIXL_PIC_IRTENTRYC0(i), r);
    258  1.1.2.2  cliff 	}
    259  1.1.2.1  cliff }
    260  1.1.2.1  cliff 
    261  1.1.2.1  cliff void *
    262  1.1.2.2  cliff rmixl_intr_establish(int irq, int ipl, rmixl_intr_trigger_t trigger,
    263  1.1.2.2  cliff 	rmixl_intr_polarity_t polarity, int (*func)(void *), void *arg)
    264  1.1.2.1  cliff {
    265  1.1.2.1  cliff 	struct evbmips_intrhand *ih;
    266  1.1.2.2  cliff 	uint32_t irtc1;
    267  1.1.2.2  cliff 	int vec;
    268  1.1.2.2  cliff 	int s;
    269  1.1.2.1  cliff 
    270  1.1.2.2  cliff 	/*
    271  1.1.2.2  cliff 	 * check args and assemble an IRT Entry
    272  1.1.2.2  cliff 	 */
    273  1.1.2.1  cliff 	if (irq < 0 || irq >= NIRQS)
    274  1.1.2.2  cliff 		panic("%s: irq %d out of range, max %d",
    275  1.1.2.2  cliff 			__func__, irq, NIRQS - 1);
    276  1.1.2.2  cliff 	if (ipl < 0 || ipl >= _IPL_N)
    277  1.1.2.2  cliff 		panic("%s: ipl %d out of range, max %d",
    278  1.1.2.2  cliff 			__func__, ipl, _IPL_N - 1);
    279  1.1.2.2  cliff 	if (rmixl_irqtab[irq].irq_ih != NULL)
    280  1.1.2.2  cliff 		panic("%s: irq %d busy", __func__, irq);
    281  1.1.2.2  cliff 
    282  1.1.2.2  cliff 	irtc1  = RMIXL_PIC_IRTENTRYC1_VALID;
    283  1.1.2.2  cliff 	irtc1 |= RMIXL_PIC_IRTENTRYC1_GL;	/* local */
    284  1.1.2.2  cliff 
    285  1.1.2.2  cliff 	switch (trigger) {
    286  1.1.2.2  cliff 	case RMIXL_INTR_EDGE:
    287  1.1.2.2  cliff 		break;
    288  1.1.2.2  cliff 	case RMIXL_INTR_LEVEL:
    289  1.1.2.2  cliff 		irtc1 |= RMIXL_PIC_IRTENTRYC1_TRG;
    290  1.1.2.2  cliff 		break;
    291  1.1.2.2  cliff 	default:
    292  1.1.2.2  cliff 		panic("%s: bad trigger %d\n", __func__, trigger);
    293  1.1.2.2  cliff 	}
    294  1.1.2.1  cliff 
    295  1.1.2.2  cliff 	switch (polarity) {
    296  1.1.2.2  cliff 	case RMIXL_INTR_RISING:
    297  1.1.2.2  cliff 	case RMIXL_INTR_HIGH:
    298  1.1.2.2  cliff 		break;
    299  1.1.2.2  cliff 	case RMIXL_INTR_FALLING:
    300  1.1.2.2  cliff 	case RMIXL_INTR_LOW:
    301  1.1.2.2  cliff 		irtc1 |= RMIXL_PIC_IRTENTRYC1_P;
    302  1.1.2.2  cliff 		break;
    303  1.1.2.2  cliff 	default:
    304  1.1.2.2  cliff 		panic("%s: bad polarity %d\n", __func__, polarity);
    305  1.1.2.2  cliff 	}
    306  1.1.2.2  cliff 
    307  1.1.2.2  cliff 	/*
    308  1.1.2.2  cliff 	 * ipl determines which vector to use
    309  1.1.2.2  cliff 	 */
    310  1.1.2.2  cliff 	vec = rmixl_iplvec[ipl];
    311  1.1.2.2  cliff printf("%s: ipl=%d, vec=%d\n", __func__, ipl, vec);
    312  1.1.2.2  cliff 	KASSERT((vec & ~RMIXL_PIC_IRTENTRYC1_INTVEC) == 0);
    313  1.1.2.2  cliff 	irtc1 |= vec;
    314  1.1.2.2  cliff 
    315  1.1.2.2  cliff 	/*
    316  1.1.2.2  cliff 	 * allocate and initialize an interrupt handle
    317  1.1.2.2  cliff 	 */
    318  1.1.2.1  cliff 	ih = malloc(sizeof(*ih), M_DEVBUF, M_NOWAIT);
    319  1.1.2.1  cliff 	if (ih == NULL)
    320  1.1.2.1  cliff 		return NULL;
    321  1.1.2.1  cliff 
    322  1.1.2.1  cliff 	ih->ih_func = func;
    323  1.1.2.1  cliff 	ih->ih_arg = arg;
    324  1.1.2.1  cliff 	ih->ih_irq = irq;
    325  1.1.2.2  cliff 	ih->ih_ipl = ipl;
    326  1.1.2.1  cliff 
    327  1.1.2.1  cliff 	s = splhigh();
    328  1.1.2.1  cliff 
    329  1.1.2.1  cliff 	/*
    330  1.1.2.2  cliff 	 * mark this irq as established, busy
    331  1.1.2.1  cliff 	 */
    332  1.1.2.2  cliff 	rmixl_irqtab[irq].irq_ih = ih;
    333  1.1.2.1  cliff 
    334  1.1.2.2  cliff 	/*
    335  1.1.2.2  cliff 	 * link this ih into the tables and bump reference count
    336  1.1.2.2  cliff 	 */
    337  1.1.2.2  cliff 	LIST_INSERT_HEAD(&rmixl_intrvec[vec].iv_list, ih, ih_q);
    338  1.1.2.2  cliff 	rmixl_intrvec[vec].iv_refcnt++;
    339  1.1.2.1  cliff 
    340  1.1.2.1  cliff 	/*
    341  1.1.2.2  cliff 	 * establish IRT Entry (low word only)
    342  1.1.2.1  cliff 	 */
    343  1.1.2.2  cliff 	REG_WRITE(RMIXL_PIC_IRTENTRYC1(irq), irtc1);
    344  1.1.2.1  cliff 
    345  1.1.2.1  cliff 	splx(s);
    346  1.1.2.1  cliff 
    347  1.1.2.1  cliff 	return ih;
    348  1.1.2.1  cliff }
    349  1.1.2.1  cliff 
    350  1.1.2.1  cliff void
    351  1.1.2.1  cliff rmixl_intr_disestablish(void *cookie)
    352  1.1.2.1  cliff {
    353  1.1.2.1  cliff 	struct evbmips_intrhand *ih = cookie;
    354  1.1.2.2  cliff 	uint32_t r;
    355  1.1.2.2  cliff 	int irq;
    356  1.1.2.2  cliff 	int vec;
    357  1.1.2.2  cliff 	int s;
    358  1.1.2.1  cliff 
    359  1.1.2.1  cliff 	irq = ih->ih_irq;
    360  1.1.2.2  cliff 	vec = rmixl_iplvec[ih->ih_ipl];
    361  1.1.2.1  cliff 
    362  1.1.2.1  cliff 	s = splhigh();
    363  1.1.2.1  cliff 
    364  1.1.2.1  cliff 	/*
    365  1.1.2.2  cliff 	 * remove from the table and adjust the reference count
    366  1.1.2.1  cliff 	 */
    367  1.1.2.1  cliff 	LIST_REMOVE(ih, ih_q);
    368  1.1.2.2  cliff 	rmixl_intrvec[vec].iv_refcnt--;
    369  1.1.2.1  cliff 
    370  1.1.2.1  cliff 	/*
    371  1.1.2.2  cliff 	 * disable the IRT Entry (low word only)
    372  1.1.2.1  cliff 	 */
    373  1.1.2.2  cliff 	r = REG_READ(RMIXL_PIC_IRTENTRYC1(irq));
    374  1.1.2.2  cliff 	r &= RMIXL_PIC_IRTENTRYC1_RESV;
    375  1.1.2.2  cliff 	REG_WRITE(RMIXL_PIC_IRTENTRYC1(irq), r);
    376  1.1.2.1  cliff 
    377  1.1.2.2  cliff 	/*
    378  1.1.2.2  cliff 	 * this irq now disestablished, not busy
    379  1.1.2.2  cliff 	 */
    380  1.1.2.2  cliff 	rmixl_irqtab[irq].irq_ih = NULL;
    381  1.1.2.1  cliff 
    382  1.1.2.1  cliff 	splx(s);
    383  1.1.2.1  cliff 
    384  1.1.2.1  cliff 	free(ih, M_DEVBUF);
    385  1.1.2.1  cliff }
    386  1.1.2.1  cliff 
    387  1.1.2.1  cliff void
    388  1.1.2.1  cliff evbmips_iointr(uint32_t status, uint32_t cause, uint32_t pc, uint32_t ipending)
    389  1.1.2.1  cliff {
    390  1.1.2.1  cliff 	struct evbmips_intrhand *ih;
    391  1.1.2.2  cliff 	uint64_t eirr;
    392  1.1.2.2  cliff 	uint64_t eimr;
    393  1.1.2.2  cliff 	uint32_t sr;
    394  1.1.2.2  cliff 	int vec;
    395  1.1.2.2  cliff 
    396  1.1.2.2  cliff 	printf("\n%s: status: %#x, cause %#x\n", __func__, status, cause);
    397  1.1.2.2  cliff 	asm volatile ("mfc0 %0, $9, 6;" :"=r"(sr));
    398  1.1.2.2  cliff 	printf("%s:%d: SR: %#x\n", __func__, __LINE__, sr);
    399  1.1.2.2  cliff 	asm volatile ("dmfc0 %0, $9, 7;" :"=r"(eimr));
    400  1.1.2.2  cliff 	printf("%s: EIMR: %#lx\n", __func__, eimr);
    401  1.1.2.1  cliff 
    402  1.1.2.2  cliff 	for (vec = NINTRVECS - 1; vec >= 0; vec--) {
    403  1.1.2.2  cliff 		if ((ipending & (MIPS_SOFT_INT_MASK_0 << vec)) == 0)
    404  1.1.2.1  cliff 			continue;
    405  1.1.2.1  cliff 
    406  1.1.2.2  cliff 		/* ack this vec in the EIRR */
    407  1.1.2.2  cliff 		eirr = (1 << vec);
    408  1.1.2.2  cliff 		asm volatile ("dmtc0 %0, $9, 6;" :: "r"(eirr));
    409  1.1.2.2  cliff 
    410  1.1.2.2  cliff 		LIST_FOREACH(ih, &rmixl_intrvec[vec].iv_list, ih_q) {
    411  1.1.2.2  cliff 			if ((*ih->ih_func)(ih->ih_arg) != 0)
    412  1.1.2.2  cliff 				rmixl_irqtab[ih->ih_irq].irq_count.ev_count++;
    413  1.1.2.1  cliff 		}
    414  1.1.2.2  cliff 		cause &= ~(MIPS_SOFT_INT_MASK_0 << vec);
    415  1.1.2.1  cliff 	}
    416  1.1.2.1  cliff 
    417  1.1.2.1  cliff 	/* Re-enable anything that we have processed. */
    418  1.1.2.2  cliff 	printf("%s:%d: re-enable: %#x\n", __func__, __LINE__,
    419  1.1.2.2  cliff 		MIPS_SR_INT_IE | ((status & ~cause) & MIPS_HARD_INT_MASK));
    420  1.1.2.1  cliff 	_splset(MIPS_SR_INT_IE | ((status & ~cause) & MIPS_HARD_INT_MASK));
    421  1.1.2.2  cliff 
    422  1.1.2.2  cliff 	asm volatile ("mfc0 %0, $9, 6;" :"=r"(sr));
    423  1.1.2.2  cliff 	printf("%s: SR: %#x\n", __func__, sr);
    424  1.1.2.2  cliff 
    425  1.1.2.2  cliff 	asm volatile ("dmfc0 %0, $9, 6;" :"=r"(eirr));
    426  1.1.2.2  cliff 	printf("%s: EIRR: %#lx\n", __func__, eirr);
    427  1.1.2.2  cliff 
    428  1.1.2.2  cliff 	asm volatile ("dmfc0 %0, $9, 7;" :"=r"(eimr));
    429  1.1.2.2  cliff 	printf("%s: EIMR: %#lx\n", __func__, eimr);
    430  1.1.2.1  cliff }
    431