ixp12x0_intr.c revision 1.8.2.3       1  1.8.2.3    skrll /* $NetBSD: ixp12x0_intr.c,v 1.8.2.3 2004/09/21 13:13:32 skrll Exp $ */
      2      1.1   ichiro 
      3      1.1   ichiro /*
      4      1.1   ichiro  * Copyright (c) 2002 The NetBSD Foundation, Inc.
      5      1.1   ichiro  * All rights reserved.
      6      1.1   ichiro  *
      7      1.1   ichiro  * This code is derived from software contributed to The NetBSD Foundation
      8      1.1   ichiro  * by Ichiro FUKUHARA and Naoto Shimazaki.
      9      1.1   ichiro  *
     10      1.1   ichiro  * Redistribution and use in source and binary forms, with or without
     11      1.1   ichiro  * modification, are permitted provided that the following conditions
     12      1.1   ichiro  * are met:
     13      1.1   ichiro  * 1. Redistributions of source code must retain the above copyright
     14      1.1   ichiro  *    notice, this list of conditions and the following disclaimer.
     15      1.1   ichiro  * 2. Redistributions in binary form must reproduce the above copyright
     16      1.1   ichiro  *    notice, this list of conditions and the following disclaimer in the
     17      1.1   ichiro  *    documentation and/or other materials provided with the distribution.
     18      1.1   ichiro  * 3. All advertising materials mentioning features or use of this software
     19      1.1   ichiro  *    must display the following acknowledgement:
     20      1.1   ichiro  *        This product includes software developed by the NetBSD
     21      1.1   ichiro  *        Foundation, Inc. and its contributors.
     22      1.1   ichiro  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23      1.1   ichiro  *    contributors may be used to endorse or promote products derived
     24      1.1   ichiro  *    from this software without specific prior written permission.
     25      1.1   ichiro  *
     26      1.1   ichiro  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27      1.1   ichiro  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28      1.1   ichiro  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29      1.1   ichiro  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30      1.1   ichiro  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31      1.1   ichiro  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32      1.1   ichiro  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33      1.1   ichiro  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34      1.1   ichiro  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35      1.1   ichiro  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36      1.1   ichiro  * POSSIBILITY OF SUCH DAMAGE.
     37      1.1   ichiro  */
     38      1.7      igy 
     39      1.7      igy #include <sys/cdefs.h>
     40  1.8.2.3    skrll __KERNEL_RCSID(0, "$NetBSD: ixp12x0_intr.c,v 1.8.2.3 2004/09/21 13:13:32 skrll Exp $");
     41      1.1   ichiro 
     42      1.1   ichiro /*
     43      1.1   ichiro  * Interrupt support for the Intel ixp12x0
     44      1.1   ichiro  */
     45      1.1   ichiro 
     46      1.1   ichiro #include <sys/param.h>
     47      1.1   ichiro #include <sys/systm.h>
     48      1.1   ichiro #include <sys/malloc.h>
     49      1.4   ichiro #include <sys/termios.h>
     50      1.1   ichiro 
     51      1.1   ichiro #include <uvm/uvm_extern.h>
     52      1.1   ichiro 
     53      1.1   ichiro #include <machine/bus.h>
     54      1.1   ichiro #include <machine/intr.h>
     55      1.1   ichiro 
     56      1.1   ichiro #include <arm/cpufunc.h>
     57      1.1   ichiro 
     58      1.1   ichiro #include <arm/ixp12x0/ixp12x0reg.h>
     59      1.1   ichiro #include <arm/ixp12x0/ixp12x0var.h>
     60      1.1   ichiro #include <arm/ixp12x0/ixp12x0_comreg.h>
     61      1.4   ichiro #include <arm/ixp12x0/ixp12x0_comvar.h>
     62      1.1   ichiro #include <arm/ixp12x0/ixp12x0_pcireg.h>
     63      1.1   ichiro 
     64  1.8.2.1    skrll 
     65      1.1   ichiro extern u_int32_t	ixpcom_cr;	/* current cr from *_com.c */
     66      1.1   ichiro extern u_int32_t	ixpcom_imask;	/* tell mask to *_com.c */
     67      1.1   ichiro 
     68      1.1   ichiro /* Interrupt handler queues. */
     69      1.1   ichiro struct intrq intrq[NIRQ];
     70      1.1   ichiro 
     71      1.1   ichiro /* Interrupts to mask at each level. */
     72      1.1   ichiro static u_int32_t imask[NIPL];
     73      1.1   ichiro static u_int32_t pci_imask[NIPL];
     74      1.1   ichiro 
     75      1.1   ichiro /* Current interrupt priority level. */
     76  1.8.2.1    skrll __volatile int current_spl_level;
     77  1.8.2.1    skrll __volatile int hardware_spl_level;
     78      1.1   ichiro 
     79      1.1   ichiro /* Software copy of the IRQs we have enabled. */
     80      1.1   ichiro __volatile u_int32_t intr_enabled;
     81      1.1   ichiro __volatile u_int32_t pci_intr_enabled;
     82      1.1   ichiro 
     83      1.1   ichiro /* Interrupts pending. */
     84      1.1   ichiro static __volatile int ipending;
     85      1.1   ichiro 
     86      1.1   ichiro /*
     87      1.1   ichiro  * Map a software interrupt queue index (to the unused bits in the
     88      1.1   ichiro  * ICU registers -- XXX will need to revisit this if those bits are
     89      1.1   ichiro  * ever used in future steppings).
     90      1.1   ichiro  */
     91      1.6      igy static const u_int32_t si_to_irqbit[SI_NQUEUES] = {
     92      1.1   ichiro 	IXP12X0_INTR_bit30,		/* SI_SOFT */
     93      1.1   ichiro 	IXP12X0_INTR_bit29,		/* SI_SOFTCLOCK */
     94      1.1   ichiro 	IXP12X0_INTR_bit28,		/* SI_SOFTNET */
     95      1.1   ichiro 	IXP12X0_INTR_bit27,		/* SI_SOFTSERIAL */
     96      1.1   ichiro };
     97      1.1   ichiro 
     98      1.1   ichiro #define	INT_SWMASK							\
     99      1.1   ichiro 	((1U << IXP12X0_INTR_bit30) | (1U << IXP12X0_INTR_bit29) |	\
    100      1.1   ichiro 	 (1U << IXP12X0_INTR_bit28) | (1U << IXP12X0_INTR_bit27))
    101      1.1   ichiro 
    102      1.1   ichiro #define	SI_TO_IRQBIT(si)	(1U << si_to_irqbit[(si)])
    103      1.1   ichiro 
    104      1.1   ichiro /*
    105      1.1   ichiro  * Map a software interrupt queue to an interrupt priority level.
    106      1.1   ichiro  */
    107      1.1   ichiro static const int si_to_ipl[SI_NQUEUES] = {
    108      1.1   ichiro 	IPL_SOFT,		/* SI_SOFT */
    109      1.1   ichiro 	IPL_SOFTCLOCK,		/* SI_SOFTCLOCK */
    110      1.1   ichiro 	IPL_SOFTNET,		/* SI_SOFTNET */
    111      1.1   ichiro 	IPL_SOFTSERIAL,		/* SI_SOFTSERIAL */
    112      1.1   ichiro };
    113      1.1   ichiro 
    114      1.1   ichiro void	ixp12x0_intr_dispatch(struct irqframe *frame);
    115      1.1   ichiro 
    116  1.8.2.1    skrll #define IXPREG(reg)	*((volatile u_int32_t*) (reg))
    117  1.8.2.1    skrll 
    118      1.1   ichiro static __inline u_int32_t
    119      1.1   ichiro ixp12x0_irq_read(void)
    120      1.1   ichiro {
    121      1.1   ichiro 	return IXPREG(IXP12X0_IRQ_VBASE) & IXP12X0_INTR_MASK;
    122      1.1   ichiro }
    123      1.1   ichiro 
    124      1.1   ichiro static __inline u_int32_t
    125      1.1   ichiro ixp12x0_pci_irq_read(void)
    126      1.1   ichiro {
    127      1.1   ichiro 	return IXPREG(IXPPCI_IRQ_STATUS);
    128      1.1   ichiro }
    129      1.1   ichiro 
    130      1.1   ichiro static void
    131      1.1   ichiro ixp12x0_enable_uart_irq(void)
    132      1.1   ichiro {
    133      1.1   ichiro 	ixpcom_imask = 0;
    134      1.4   ichiro 	if (ixpcom_sc)
    135      1.4   ichiro 		bus_space_write_4(ixpcom_sc->sc_iot, ixpcom_sc->sc_ioh,
    136      1.4   ichiro 				  IXPCOM_CR, ixpcom_cr & ~ixpcom_imask);
    137      1.1   ichiro }
    138      1.1   ichiro 
    139      1.1   ichiro static void
    140      1.1   ichiro ixp12x0_disable_uart_irq(void)
    141      1.1   ichiro {
    142      1.1   ichiro 	ixpcom_imask = CR_RIE | CR_XIE;
    143      1.4   ichiro 	if (ixpcom_sc)
    144      1.4   ichiro 		bus_space_write_4(ixpcom_sc->sc_iot, ixpcom_sc->sc_ioh,
    145      1.4   ichiro 				  IXPCOM_CR, ixpcom_cr & ~ixpcom_imask);
    146      1.1   ichiro }
    147      1.1   ichiro 
    148      1.1   ichiro static void
    149      1.1   ichiro ixp12x0_set_intrmask(u_int32_t irqs, u_int32_t pci_irqs)
    150      1.1   ichiro {
    151      1.1   ichiro 	if (irqs & (1U << IXP12X0_INTR_UART)) {
    152      1.1   ichiro 		ixp12x0_disable_uart_irq();
    153      1.1   ichiro 	} else {
    154      1.1   ichiro 		ixp12x0_enable_uart_irq();
    155      1.1   ichiro 	}
    156      1.1   ichiro 	IXPREG(IXPPCI_IRQ_ENABLE_CLEAR) = pci_irqs;
    157      1.1   ichiro 	IXPREG(IXPPCI_IRQ_ENABLE_SET) = pci_intr_enabled & ~pci_irqs;
    158      1.1   ichiro }
    159      1.1   ichiro 
    160      1.1   ichiro static void
    161      1.1   ichiro ixp12x0_enable_irq(int irq)
    162      1.1   ichiro {
    163      1.1   ichiro 	if (irq < SYS_NIRQ) {
    164      1.1   ichiro 		intr_enabled |= (1U << irq);
    165      1.1   ichiro 		switch (irq) {
    166      1.1   ichiro 		case IXP12X0_INTR_UART:
    167      1.1   ichiro 			ixp12x0_enable_uart_irq();
    168      1.1   ichiro 			break;
    169      1.1   ichiro 
    170      1.1   ichiro 		case IXP12X0_INTR_PCI:
    171      1.1   ichiro 			/* nothing to do */
    172      1.1   ichiro 			break;
    173      1.1   ichiro 		default:
    174      1.3   provos 			panic("enable_irq:bad IRQ %d", irq);
    175      1.1   ichiro 		}
    176      1.1   ichiro 	} else {
    177      1.1   ichiro 		pci_intr_enabled |= (1U << (irq - SYS_NIRQ));
    178      1.1   ichiro 		IXPREG(IXPPCI_IRQ_ENABLE_SET) = (1U << (irq - SYS_NIRQ));
    179      1.1   ichiro 	}
    180      1.1   ichiro }
    181      1.1   ichiro 
    182      1.1   ichiro static __inline void
    183      1.1   ichiro ixp12x0_disable_irq(int irq)
    184      1.1   ichiro {
    185      1.1   ichiro 	if (irq < SYS_NIRQ) {
    186      1.1   ichiro 		intr_enabled ^= ~(1U << irq);
    187      1.1   ichiro 		switch (irq) {
    188      1.1   ichiro 		case IXP12X0_INTR_UART:
    189      1.1   ichiro 			ixp12x0_disable_uart_irq();
    190      1.1   ichiro 			break;
    191      1.1   ichiro 
    192      1.1   ichiro 		case IXP12X0_INTR_PCI:
    193      1.1   ichiro 			/* nothing to do */
    194      1.1   ichiro 			break;
    195      1.1   ichiro 		default:
    196      1.1   ichiro 			/* nothing to do */
    197  1.8.2.1    skrll 			break;
    198      1.1   ichiro 		}
    199      1.1   ichiro 	} else {
    200      1.2   ichiro 		pci_intr_enabled &= ~(1U << (irq - SYS_NIRQ));
    201      1.1   ichiro 		IXPREG(IXPPCI_IRQ_ENABLE_CLEAR) = (1U << (irq - SYS_NIRQ));
    202      1.1   ichiro 	}
    203      1.1   ichiro }
    204      1.1   ichiro 
    205      1.1   ichiro /*
    206      1.1   ichiro  * NOTE: This routine must be called with interrupts disabled in the CPSR.
    207      1.1   ichiro  */
    208      1.1   ichiro static void
    209      1.1   ichiro ixp12x0_intr_calculate_masks(void)
    210      1.1   ichiro {
    211      1.1   ichiro 	struct intrq *iq;
    212      1.1   ichiro 	struct intrhand *ih;
    213      1.1   ichiro 	int irq, ipl;
    214      1.1   ichiro 
    215      1.1   ichiro 	/* First, figure out which IPLs each IRQ has. */
    216      1.1   ichiro 	for (irq = 0; irq < NIRQ; irq++) {
    217      1.1   ichiro 		int levels = 0;
    218      1.1   ichiro 		iq = &intrq[irq];
    219      1.1   ichiro 		ixp12x0_disable_irq(irq);
    220      1.1   ichiro 		for (ih = TAILQ_FIRST(&iq->iq_list); ih != NULL;
    221      1.1   ichiro 		     ih = TAILQ_NEXT(ih, ih_list))
    222      1.1   ichiro 			levels |= (1U << ih->ih_ipl);
    223      1.1   ichiro 		iq->iq_levels = levels;
    224      1.1   ichiro 	}
    225      1.1   ichiro 
    226      1.1   ichiro 	/* Next, figure out which IRQs are used by each IPL. */
    227      1.1   ichiro 	for (ipl = 0; ipl < NIPL; ipl++) {
    228      1.1   ichiro 		int irqs = 0;
    229      1.1   ichiro 		int pci_irqs = 0;
    230      1.1   ichiro 		for (irq = 0; irq < SYS_NIRQ; irq++) {
    231      1.1   ichiro 			if (intrq[irq].iq_levels & (1U << ipl))
    232      1.1   ichiro 				irqs |= (1U << irq);
    233      1.1   ichiro 		}
    234      1.1   ichiro 		imask[ipl] = irqs;
    235      1.1   ichiro 		for (irq = 0; irq < SYS_NIRQ; irq++) {
    236      1.1   ichiro 			if (intrq[irq + SYS_NIRQ].iq_levels & (1U << ipl))
    237      1.1   ichiro 				pci_irqs |= (1U << irq);
    238      1.1   ichiro 		}
    239      1.1   ichiro 		pci_imask[ipl] = pci_irqs;
    240      1.1   ichiro 	}
    241      1.1   ichiro 
    242      1.1   ichiro 	imask[IPL_NONE] = 0;
    243      1.1   ichiro 	pci_imask[IPL_NONE] = 0;
    244      1.1   ichiro 
    245      1.1   ichiro 	/*
    246      1.1   ichiro 	 * Initialize the soft interrupt masks to block themselves.
    247      1.1   ichiro 	 */
    248      1.1   ichiro 	imask[IPL_SOFT] = SI_TO_IRQBIT(SI_SOFT);
    249      1.1   ichiro 	imask[IPL_SOFTCLOCK] = SI_TO_IRQBIT(SI_SOFTCLOCK);
    250      1.1   ichiro 	imask[IPL_SOFTNET] = SI_TO_IRQBIT(SI_SOFTNET);
    251      1.1   ichiro 	imask[IPL_SOFTSERIAL] = SI_TO_IRQBIT(SI_SOFTSERIAL);
    252      1.1   ichiro 
    253      1.1   ichiro 	/*
    254      1.1   ichiro 	 * splsoftclock() is the only interface that users of the
    255      1.1   ichiro 	 * generic software interrupt facility have to block their
    256      1.1   ichiro 	 * soft intrs, so splsoftclock() must also block IPL_SOFT.
    257      1.1   ichiro 	 */
    258      1.1   ichiro 	imask[IPL_SOFTCLOCK] |= imask[IPL_SOFT];
    259      1.1   ichiro 	pci_imask[IPL_SOFTCLOCK] |= pci_imask[IPL_SOFT];
    260      1.1   ichiro 
    261      1.1   ichiro 	/*
    262      1.1   ichiro 	 * splsoftnet() must also block splsoftclock(), since we don't
    263      1.1   ichiro 	 * want timer-driven network events to occur while we're
    264      1.1   ichiro 	 * processing incoming packets.
    265      1.1   ichiro 	 */
    266      1.1   ichiro 	imask[IPL_SOFTNET] |= imask[IPL_SOFTCLOCK];
    267      1.1   ichiro 	pci_imask[IPL_SOFTNET] |= pci_imask[IPL_SOFTCLOCK];
    268      1.1   ichiro 
    269      1.1   ichiro 	/*
    270      1.1   ichiro 	 * Enforce a heirarchy that gives "slow" device (or devices with
    271      1.1   ichiro 	 * limited input buffer space/"real-time" requirements) a better
    272      1.1   ichiro 	 * chance at not dropping data.
    273      1.1   ichiro 	 */
    274      1.1   ichiro 	imask[IPL_BIO] |= imask[IPL_SOFTNET];
    275      1.1   ichiro 	pci_imask[IPL_BIO] |= pci_imask[IPL_SOFTNET];
    276      1.1   ichiro 	imask[IPL_NET] |= imask[IPL_BIO];
    277      1.1   ichiro 	pci_imask[IPL_NET] |= pci_imask[IPL_BIO];
    278      1.6      igy 	imask[IPL_SOFTSERIAL] |= imask[IPL_NET];
    279      1.1   ichiro 	pci_imask[IPL_SOFTSERIAL] |= pci_imask[IPL_NET];
    280      1.1   ichiro 	imask[IPL_TTY] |= imask[IPL_SOFTSERIAL];
    281      1.1   ichiro 	pci_imask[IPL_TTY] |= pci_imask[IPL_SOFTSERIAL];
    282      1.1   ichiro 
    283      1.1   ichiro 	/*
    284      1.1   ichiro 	 * splvm() blocks all interrupts that use the kernel memory
    285      1.1   ichiro 	 * allocation facilities.
    286      1.1   ichiro 	 */
    287      1.8  thorpej 	imask[IPL_VM] |= imask[IPL_TTY];
    288      1.8  thorpej 	pci_imask[IPL_VM] |= pci_imask[IPL_TTY];
    289      1.1   ichiro 
    290      1.1   ichiro 	/*
    291      1.1   ichiro 	 * Audio devices are not allowed to perform memory allocation
    292      1.1   ichiro 	 * in their interrupt routines, and they have fairly "real-time"
    293      1.1   ichiro 	 * requirements, so give them a high interrupt priority.
    294      1.1   ichiro 	 */
    295      1.8  thorpej 	imask[IPL_AUDIO] |= imask[IPL_VM];
    296      1.8  thorpej 	pci_imask[IPL_AUDIO] |= pci_imask[IPL_VM];
    297      1.1   ichiro 
    298      1.1   ichiro 	/*
    299      1.1   ichiro 	 * splclock() must block anything that uses the scheduler.
    300      1.1   ichiro 	 */
    301      1.1   ichiro 	imask[IPL_CLOCK] |= imask[IPL_AUDIO];
    302      1.1   ichiro 	pci_imask[IPL_CLOCK] |= pci_imask[IPL_AUDIO];
    303      1.1   ichiro 
    304      1.1   ichiro 	/*
    305      1.5   ichiro 	 * No separate statclock on the IXP12x0.
    306      1.1   ichiro 	 */
    307      1.1   ichiro 	imask[IPL_STATCLOCK] |= imask[IPL_CLOCK];
    308      1.1   ichiro 	pci_imask[IPL_STATCLOCK] |= pci_imask[IPL_CLOCK];
    309      1.1   ichiro 
    310      1.1   ichiro 	/*
    311      1.1   ichiro 	 * splhigh() must block "everything".
    312      1.1   ichiro 	 */
    313      1.1   ichiro 	imask[IPL_HIGH] |= imask[IPL_STATCLOCK];
    314      1.1   ichiro 	pci_imask[IPL_HIGH] |= pci_imask[IPL_STATCLOCK];
    315      1.1   ichiro 
    316      1.1   ichiro 	/*
    317      1.1   ichiro 	 * XXX We need serial drivers to run at the absolute highest priority
    318      1.1   ichiro 	 * in order to avoid overruns, so serial > high.
    319      1.1   ichiro 	 */
    320      1.1   ichiro 	imask[IPL_SERIAL] |= imask[IPL_HIGH];
    321      1.1   ichiro 	pci_imask[IPL_SERIAL] |= pci_imask[IPL_HIGH];
    322      1.1   ichiro 
    323      1.1   ichiro 	/*
    324      1.1   ichiro 	 * Now compute which IRQs must be blocked when servicing any
    325      1.1   ichiro 	 * given IRQ.
    326      1.1   ichiro 	 */
    327      1.1   ichiro 	for (irq = 0; irq < NIRQ; irq++) {
    328      1.1   ichiro 		int	irqs;
    329      1.1   ichiro 		int	pci_irqs;
    330      1.1   ichiro 
    331      1.1   ichiro 		if (irq < SYS_NIRQ) {
    332      1.1   ichiro 			irqs = (1U << irq);
    333      1.1   ichiro 			pci_irqs = 0;
    334      1.1   ichiro 		} else {
    335      1.1   ichiro 			irqs = 0;
    336      1.1   ichiro 			pci_irqs = (1U << (irq - SYS_NIRQ));
    337      1.1   ichiro 		}
    338      1.1   ichiro 		iq = &intrq[irq];
    339      1.1   ichiro 		if (TAILQ_FIRST(&iq->iq_list) != NULL)
    340      1.1   ichiro 			ixp12x0_enable_irq(irq);
    341      1.1   ichiro 		for (ih = TAILQ_FIRST(&iq->iq_list); ih != NULL;
    342      1.1   ichiro 		     ih = TAILQ_NEXT(ih, ih_list)) {
    343      1.1   ichiro 			irqs |= imask[ih->ih_ipl];
    344      1.1   ichiro 			pci_irqs |= pci_imask[ih->ih_ipl];
    345      1.1   ichiro 		}
    346      1.1   ichiro 		iq->iq_mask = irqs;
    347      1.1   ichiro 		iq->iq_pci_mask = pci_irqs;
    348      1.1   ichiro 	}
    349      1.1   ichiro }
    350      1.1   ichiro 
    351      1.1   ichiro static void
    352      1.1   ichiro ixp12x0_do_pending(void)
    353      1.1   ichiro {
    354      1.1   ichiro 	static __cpu_simple_lock_t processing = __SIMPLELOCK_UNLOCKED;
    355      1.1   ichiro 	int	new;
    356      1.1   ichiro 	u_int	oldirqstate;
    357      1.1   ichiro 
    358      1.1   ichiro 	if (__cpu_simple_lock_try(&processing) == 0)
    359      1.1   ichiro 		return;
    360      1.1   ichiro 
    361      1.1   ichiro 	new = current_spl_level;
    362      1.1   ichiro 
    363      1.1   ichiro 	oldirqstate = disable_interrupts(I32_bit);
    364      1.1   ichiro 
    365      1.1   ichiro #define	DO_SOFTINT(si)							\
    366      1.1   ichiro 	if ((ipending & ~imask[new]) & SI_TO_IRQBIT(si)) {		\
    367      1.1   ichiro 		ipending &= ~SI_TO_IRQBIT(si);				\
    368      1.1   ichiro 		current_spl_level = si_to_ipl[(si)];			\
    369      1.1   ichiro 		restore_interrupts(oldirqstate);			\
    370      1.1   ichiro 		softintr_dispatch(si);					\
    371      1.1   ichiro 		oldirqstate = disable_interrupts(I32_bit);		\
    372      1.1   ichiro 		current_spl_level = new;				\
    373      1.1   ichiro 	}
    374      1.1   ichiro 
    375      1.1   ichiro 	DO_SOFTINT(SI_SOFTSERIAL);
    376      1.1   ichiro 	DO_SOFTINT(SI_SOFTNET);
    377      1.1   ichiro 	DO_SOFTINT(SI_SOFTCLOCK);
    378      1.1   ichiro 	DO_SOFTINT(SI_SOFT);
    379      1.1   ichiro 
    380      1.1   ichiro 	__cpu_simple_unlock(&processing);
    381      1.1   ichiro 
    382      1.1   ichiro 	restore_interrupts(oldirqstate);
    383      1.1   ichiro }
    384      1.1   ichiro 
    385      1.1   ichiro __inline void
    386      1.1   ichiro splx(int new)
    387      1.1   ichiro {
    388      1.1   ichiro 	int	old;
    389      1.1   ichiro 	u_int	oldirqstate;
    390      1.1   ichiro 
    391      1.1   ichiro 	oldirqstate = disable_interrupts(I32_bit);
    392      1.1   ichiro 	old = current_spl_level;
    393      1.1   ichiro 	current_spl_level = new;
    394  1.8.2.1    skrll 	if (new != hardware_spl_level) {
    395  1.8.2.1    skrll 		hardware_spl_level = new;
    396  1.8.2.1    skrll 		ixp12x0_set_intrmask(imask[new], pci_imask[new]);
    397  1.8.2.1    skrll 	}
    398      1.1   ichiro 	restore_interrupts(oldirqstate);
    399      1.1   ichiro 
    400      1.1   ichiro 	/* If there are software interrupts to process, do it. */
    401      1.1   ichiro 	if ((ipending & INT_SWMASK) & ~imask[new])
    402      1.1   ichiro 		ixp12x0_do_pending();
    403      1.1   ichiro }
    404      1.1   ichiro 
    405      1.1   ichiro int
    406      1.1   ichiro _splraise(int ipl)
    407      1.1   ichiro {
    408  1.8.2.1    skrll 	int	old;
    409  1.8.2.1    skrll 	u_int	oldirqstate;
    410      1.1   ichiro 
    411  1.8.2.1    skrll 	oldirqstate = disable_interrupts(I32_bit);
    412  1.8.2.1    skrll 	old = current_spl_level;
    413  1.8.2.1    skrll 	current_spl_level = ipl;
    414  1.8.2.1    skrll 	restore_interrupts(oldirqstate);
    415      1.1   ichiro 	return (old);
    416      1.1   ichiro }
    417      1.1   ichiro 
    418      1.1   ichiro int
    419      1.1   ichiro _spllower(int ipl)
    420      1.1   ichiro {
    421      1.1   ichiro 	int	old = current_spl_level;
    422      1.1   ichiro 
    423      1.1   ichiro 	if (old <= ipl)
    424      1.1   ichiro 		return (old);
    425      1.1   ichiro 	splx(ipl);
    426      1.1   ichiro 	return (old);
    427      1.1   ichiro }
    428      1.1   ichiro 
    429      1.1   ichiro void
    430      1.1   ichiro _setsoftintr(int si)
    431      1.1   ichiro {
    432      1.1   ichiro 	u_int	oldirqstate;
    433      1.1   ichiro 
    434      1.1   ichiro 	oldirqstate = disable_interrupts(I32_bit);
    435      1.1   ichiro 	ipending |= SI_TO_IRQBIT(si);
    436      1.1   ichiro 	restore_interrupts(oldirqstate);
    437      1.1   ichiro 
    438      1.1   ichiro 	/* Process unmasked pending soft interrupts. */
    439      1.1   ichiro 	if ((ipending & INT_SWMASK) & ~imask[current_spl_level])
    440      1.1   ichiro 		ixp12x0_do_pending();
    441      1.1   ichiro }
    442      1.1   ichiro 
    443      1.1   ichiro /*
    444      1.1   ichiro  * ixp12x0_intr_init:
    445      1.1   ichiro  *
    446      1.1   ichiro  *	Initialize the rest of the interrupt subsystem, making it
    447      1.1   ichiro  *	ready to handle interrupts from devices.
    448      1.1   ichiro  */
    449      1.1   ichiro void
    450      1.1   ichiro ixp12x0_intr_init(void)
    451      1.1   ichiro {
    452      1.1   ichiro 	struct intrq *iq;
    453      1.1   ichiro 	int i;
    454      1.1   ichiro 
    455      1.1   ichiro 	intr_enabled = 0;
    456      1.1   ichiro 	pci_intr_enabled = 0;
    457      1.1   ichiro 
    458      1.1   ichiro 	for (i = 0; i < NIRQ; i++) {
    459      1.1   ichiro 		iq = &intrq[i];
    460      1.1   ichiro 		TAILQ_INIT(&iq->iq_list);
    461      1.1   ichiro 
    462      1.1   ichiro 		sprintf(iq->iq_name, "ipl %d", i);
    463      1.1   ichiro 		evcnt_attach_dynamic(&iq->iq_ev, EVCNT_TYPE_INTR,
    464      1.1   ichiro 				     NULL, "ixpintr", iq->iq_name);
    465      1.1   ichiro 	}
    466      1.1   ichiro 	current_intr_depth = 0;
    467      1.1   ichiro 	current_spl_level = 0;
    468  1.8.2.1    skrll 	hardware_spl_level = 0;
    469      1.1   ichiro 
    470      1.5   ichiro 	ixp12x0_intr_calculate_masks();
    471      1.5   ichiro 
    472      1.1   ichiro 	/* Enable IRQs (don't yet use FIQs). */
    473      1.1   ichiro 	enable_interrupts(I32_bit);
    474      1.1   ichiro }
    475      1.1   ichiro 
    476      1.1   ichiro void *
    477      1.1   ichiro ixp12x0_intr_establish(int irq, int ipl, int (*ih_func)(void *), void *arg)
    478      1.1   ichiro {
    479      1.1   ichiro 	struct intrq*		iq;
    480      1.1   ichiro 	struct intrhand*	ih;
    481      1.1   ichiro 	u_int			oldirqstate;
    482      1.1   ichiro #ifdef DEBUG
    483      1.5   ichiro 	printf("ixp12x0_intr_establish(irq=%d, ipl=%d, ih_func=%08x, arg=%08x)\n",
    484      1.1   ichiro 	       irq, ipl, (u_int32_t) ih_func, (u_int32_t) arg);
    485      1.1   ichiro #endif
    486      1.1   ichiro 	if (irq < 0 || irq > NIRQ)
    487      1.1   ichiro 		panic("ixp12x0_intr_establish: IRQ %d out of range", ipl);
    488      1.1   ichiro 	if (ipl < 0 || ipl > NIPL)
    489      1.1   ichiro 		panic("ixp12x0_intr_establish: IPL %d out of range", ipl);
    490      1.1   ichiro 
    491      1.1   ichiro 	ih = malloc(sizeof(*ih), M_DEVBUF, M_NOWAIT);
    492      1.1   ichiro 	if (ih == NULL)
    493      1.1   ichiro 		return (NULL);
    494      1.1   ichiro 
    495      1.1   ichiro 	ih->ih_func = ih_func;
    496      1.1   ichiro 	ih->ih_arg = arg;
    497      1.1   ichiro 	ih->ih_irq = irq;
    498      1.1   ichiro 	ih->ih_ipl = ipl;
    499      1.1   ichiro 
    500      1.1   ichiro 	iq = &intrq[irq];
    501      1.5   ichiro 	iq->iq_ist = IST_LEVEL;
    502      1.1   ichiro 
    503      1.1   ichiro 	oldirqstate = disable_interrupts(I32_bit);
    504      1.1   ichiro 	TAILQ_INSERT_TAIL(&iq->iq_list, ih, ih_list);
    505      1.1   ichiro 	ixp12x0_intr_calculate_masks();
    506      1.1   ichiro 	restore_interrupts(oldirqstate);
    507      1.1   ichiro 
    508      1.1   ichiro 	return (ih);
    509      1.1   ichiro }
    510      1.1   ichiro 
    511      1.1   ichiro void
    512      1.1   ichiro ixp12x0_intr_disestablish(void *cookie)
    513      1.1   ichiro {
    514      1.1   ichiro 	struct intrhand*	ih = cookie;
    515      1.1   ichiro 	struct intrq*		iq = &intrq[ih->ih_ipl];
    516      1.1   ichiro 	u_int			oldirqstate;
    517      1.1   ichiro 
    518      1.1   ichiro 	oldirqstate = disable_interrupts(I32_bit);
    519      1.1   ichiro 	TAILQ_REMOVE(&iq->iq_list, ih, ih_list);
    520      1.1   ichiro 	ixp12x0_intr_calculate_masks();
    521      1.1   ichiro 	restore_interrupts(oldirqstate);
    522      1.1   ichiro }
    523      1.1   ichiro 
    524      1.1   ichiro void
    525      1.1   ichiro ixp12x0_intr_dispatch(struct clockframe *frame)
    526      1.1   ichiro {
    527      1.1   ichiro 	struct intrq*		iq;
    528      1.1   ichiro 	struct intrhand*	ih;
    529      1.1   ichiro 	u_int			oldirqstate;
    530      1.1   ichiro 	int			pcpl;
    531      1.1   ichiro 	u_int32_t		hwpend;
    532      1.1   ichiro 	u_int32_t		pci_hwpend;
    533      1.1   ichiro 	int			irq;
    534      1.1   ichiro 	u_int32_t		ibit;
    535      1.1   ichiro 
    536      1.1   ichiro 	pcpl = current_spl_level;
    537      1.1   ichiro 
    538      1.1   ichiro 	hwpend = ixp12x0_irq_read();
    539      1.1   ichiro 	pci_hwpend = ixp12x0_pci_irq_read();
    540      1.1   ichiro 
    541  1.8.2.1    skrll 	hardware_spl_level = pcpl;
    542  1.8.2.1    skrll 	ixp12x0_set_intrmask(imask[pcpl] | hwpend,
    543  1.8.2.1    skrll 			     pci_imask[pcpl] | pci_hwpend);
    544  1.8.2.1    skrll 
    545  1.8.2.1    skrll 	hwpend &= ~imask[pcpl];
    546  1.8.2.1    skrll 	pci_hwpend &= ~pci_imask[pcpl];
    547  1.8.2.1    skrll 
    548      1.1   ichiro 	while (hwpend) {
    549      1.1   ichiro 		irq = ffs(hwpend) - 1;
    550      1.1   ichiro 		ibit = (1U << irq);
    551      1.1   ichiro 
    552      1.1   ichiro 		iq = &intrq[irq];
    553      1.1   ichiro 		iq->iq_ev.ev_count++;
    554      1.1   ichiro 		uvmexp.intrs++;
    555      1.1   ichiro 		for (ih = TAILQ_FIRST(&iq->iq_list); ih != NULL;
    556      1.1   ichiro 		     ih = TAILQ_NEXT(ih, ih_list)) {
    557  1.8.2.1    skrll 			int	ipl;
    558  1.8.2.1    skrll 
    559      1.1   ichiro 			current_spl_level = ipl = ih->ih_ipl;
    560      1.1   ichiro 			oldirqstate = enable_interrupts(I32_bit);
    561      1.1   ichiro 			(void) (*ih->ih_func)(ih->ih_arg ? ih->ih_arg : frame);
    562      1.1   ichiro 			restore_interrupts(oldirqstate);
    563      1.1   ichiro 			hwpend &= ~ibit;
    564      1.1   ichiro 		}
    565      1.1   ichiro 	}
    566      1.1   ichiro 	while (pci_hwpend) {
    567      1.1   ichiro 		irq = ffs(pci_hwpend) - 1;
    568      1.1   ichiro 		ibit = (1U << irq);
    569      1.1   ichiro 
    570      1.1   ichiro 		iq = &intrq[irq + SYS_NIRQ];
    571      1.1   ichiro 		iq->iq_ev.ev_count++;
    572      1.1   ichiro 		uvmexp.intrs++;
    573      1.1   ichiro 		for (ih = TAILQ_FIRST(&iq->iq_list); ih != NULL;
    574      1.1   ichiro 		     ih = TAILQ_NEXT(ih, ih_list)) {
    575      1.1   ichiro 			int	ipl;
    576      1.1   ichiro 
    577      1.1   ichiro 			current_spl_level = ipl = ih->ih_ipl;
    578      1.1   ichiro 			oldirqstate = enable_interrupts(I32_bit);
    579      1.1   ichiro 			(void) (*ih->ih_func)(ih->ih_arg ? ih->ih_arg : frame);
    580      1.1   ichiro 			restore_interrupts(oldirqstate);
    581      1.1   ichiro 			pci_hwpend &= ~ibit;
    582      1.1   ichiro 		}
    583      1.1   ichiro 	}
    584      1.1   ichiro 
    585  1.8.2.1    skrll 	current_spl_level = pcpl;
    586  1.8.2.1    skrll 	hardware_spl_level = pcpl;
    587  1.8.2.1    skrll 	ixp12x0_set_intrmask(imask[pcpl], pci_imask[pcpl]);
    588      1.1   ichiro 
    589      1.1   ichiro 	/* Check for pendings soft intrs. */
    590      1.1   ichiro 	if ((ipending & INT_SWMASK) & ~imask[pcpl]) {
    591      1.1   ichiro 		oldirqstate = enable_interrupts(I32_bit);
    592      1.1   ichiro 		ixp12x0_do_pending();
    593      1.1   ichiro 		restore_interrupts(oldirqstate);
    594      1.1   ichiro 	}
    595      1.1   ichiro }
    596