Home | History | Annotate | Line # | Download | only in xscale
i80200_irq.S revision 1.4
      1  1.4   briggs /*	$NetBSD: i80200_irq.S,v 1.4 2002/08/07 05:15:01 briggs Exp $	*/
      2  1.1  thorpej 
      3  1.1  thorpej /*
      4  1.1  thorpej  * Copyright (c) 2002 Wasabi Systems, Inc.
      5  1.1  thorpej  * All rights reserved.
      6  1.1  thorpej  *
      7  1.1  thorpej  * Written by Jason R. Thorpe for Wasabi Systems, Inc.
      8  1.1  thorpej  *
      9  1.1  thorpej  * Redistribution and use in source and binary forms, with or without
     10  1.1  thorpej  * modification, are permitted provided that the following conditions
     11  1.1  thorpej  * are met:
     12  1.1  thorpej  * 1. Redistributions of source code must retain the above copyright
     13  1.1  thorpej  *    notice, this list of conditions and the following disclaimer.
     14  1.1  thorpej  * 2. Redistributions in binary form must reproduce the above copyright
     15  1.1  thorpej  *    notice, this list of conditions and the following disclaimer in the
     16  1.1  thorpej  *    documentation and/or other materials provided with the distribution.
     17  1.1  thorpej  * 3. All advertising materials mentioning features or use of this software
     18  1.1  thorpej  *    must display the following acknowledgement:
     19  1.1  thorpej  *	This product includes software developed for the NetBSD Project by
     20  1.1  thorpej  *	Wasabi Systems, Inc.
     21  1.1  thorpej  * 4. The name of Wasabi Systems, Inc. may not be used to endorse
     22  1.1  thorpej  *    or promote products derived from this software without specific prior
     23  1.1  thorpej  *    written permission.
     24  1.1  thorpej  *
     25  1.1  thorpej  * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
     26  1.1  thorpej  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     27  1.1  thorpej  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     28  1.1  thorpej  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL WASABI SYSTEMS, INC
     29  1.1  thorpej  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     30  1.1  thorpej  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     31  1.1  thorpej  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     32  1.1  thorpej  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     33  1.1  thorpej  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     34  1.1  thorpej  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     35  1.1  thorpej  * POSSIBILITY OF SUCH DAMAGE.
     36  1.1  thorpej  */
     37  1.1  thorpej 
     38  1.1  thorpej #include "assym.h"
     39  1.4   briggs #include "opt_perfctrs.h"
     40  1.1  thorpej 
     41  1.1  thorpej #include <machine/asm.h>
     42  1.1  thorpej #include <machine/cpu.h>
     43  1.1  thorpej #include <machine/frame.h>
     44  1.1  thorpej 
     45  1.1  thorpej #include <arm/xscale/i80200reg.h>
     46  1.1  thorpej 
     47  1.1  thorpej /*
     48  1.1  thorpej  * irq_entry:
     49  1.1  thorpej  *
     50  1.3  thorpej  *	Main entry point for the IRQ vector on i80200 CPUs.  Calls
     51  1.3  thorpej  *	board-specific external interrupt dispatch routine.
     52  1.1  thorpej  */
     53  1.1  thorpej 
     54  1.1  thorpej 	.text
     55  1.1  thorpej 	.align	0
     56  1.1  thorpej 
     57  1.1  thorpej Lcurrent_intr_depth:
     58  1.1  thorpej 	.word	_C_LABEL(current_intr_depth)
     59  1.1  thorpej 	.word	_C_LABEL(prev_intr_depth)
     60  1.1  thorpej 
     61  1.1  thorpej Lintr_dispatch:
     62  1.1  thorpej 	.word	_C_LABEL(i80200_extirq_dispatch)
     63  1.1  thorpej 
     64  1.4   briggs #if defined(PERFCTRS)
     65  1.4   briggs Lpmc_dispatch:
     66  1.4   briggs 	.word	_C_LABEL(xscale_pmc_dispatch)
     67  1.4   briggs #endif
     68  1.4   briggs 
     69  1.1  thorpej Lastpending:
     70  1.1  thorpej 	.word	_C_LABEL(astpending)
     71  1.1  thorpej 
     72  1.1  thorpej ASENTRY_NP(irq_entry)
     73  1.1  thorpej 	sub	lr, lr, #0x00000004	/* Adjust the lr */
     74  1.1  thorpej 
     75  1.1  thorpej 	PUSHFRAMEINSVC			/* Push an interrupt frame */
     76  1.1  thorpej 
     77  1.1  thorpej 	/*
     78  1.1  thorpej 	 * Note that we have entered the IRQ handler.  We are
     79  1.1  thorpej 	 * in SVC mode so we cannot use the processor mode to
     80  1.1  thorpej 	 * determine if we are in an IRQ.  Instead, we will
     81  1.1  thorpej 	 * count each time the interrupt handler is nested.
     82  1.1  thorpej 	 */
     83  1.1  thorpej 	ldr	r0, Lcurrent_intr_depth
     84  1.1  thorpej 	ldr	r2, Lcurrent_intr_depth+4
     85  1.1  thorpej 	ldr	r1, [r0]
     86  1.1  thorpej 	str	r1, [r2]
     87  1.1  thorpej 	add	r1, r1, #1
     88  1.1  thorpej 	str	r1, [r0]
     89  1.1  thorpej 
     90  1.1  thorpej 	/*
     91  1.1  thorpej 	 * Get the interrupt status into a callee-save register.
     92  1.1  thorpej 	 */
     93  1.2  thorpej 	mrc	p13, 0, r4, c4, c0, 0
     94  1.1  thorpej 
     95  1.4   briggs #if defined(PERFCTRS)
     96  1.4   briggs 	/*
     97  1.4   briggs 	 * Check for PMU interrupts.
     98  1.4   briggs 	 * If we have one, call the routine to handle it.
     99  1.4   briggs 	 */
    100  1.4   briggs 	tst	r4, #(INTSRC_PI)
    101  1.4   briggs 	beq	Lpmc_intr_return
    102  1.4   briggs 	mov	r1, r4
    103  1.4   briggs 	add	lr, pc, #Lpmc_intr_return - . - 8
    104  1.4   briggs 	mov	r0, sp
    105  1.4   briggs 	ldr	pc, Lpmc_dispatch
    106  1.4   briggs Lpmc_intr_return:
    107  1.4   briggs #endif
    108  1.4   briggs 
    109  1.1  thorpej 	/*
    110  1.4   briggs 	 * XXX - any need to handle BMU interrupts?
    111  1.1  thorpej 	 */
    112  1.1  thorpej 
    113  1.1  thorpej 	/*
    114  1.1  thorpej 	 * Check for external IRQs.  If we have one, call the
    115  1.1  thorpej 	 * external IRQ dispatcher.  The argument is a pointer
    116  1.1  thorpej 	 * to the stack frame.  This function will be called with
    117  1.1  thorpej 	 * interrupts disabled, and will return with interrupts
    118  1.1  thorpej 	 * disabled.
    119  1.1  thorpej 	 */
    120  1.1  thorpej 	tst	r4, #(INTSRC_II)
    121  1.2  thorpej 	beq	Lextirq_return		/* no external IRQ pending */
    122  1.1  thorpej 	ldr	r1, Lintr_dispatch
    123  1.1  thorpej 	add	lr, pc, #Lextirq_return - . - 8
    124  1.1  thorpej 	mov	r0, sp
    125  1.1  thorpej 	ldr	pc, [r1]
    126  1.1  thorpej Lextirq_return:
    127  1.1  thorpej 
    128  1.1  thorpej 	/* Decremement the nest count. */
    129  1.1  thorpej 	ldr	r0, Lcurrent_intr_depth
    130  1.1  thorpej 	ldr	r2, Lcurrent_intr_depth+4
    131  1.1  thorpej 	ldr	r1, [r0]
    132  1.1  thorpej 	str	r1, [r2]
    133  1.1  thorpej 	sub	r1, r1, #1
    134  1.1  thorpej 	str	r1, [r0]
    135  1.1  thorpej 
    136  1.1  thorpej 	/*
    137  1.1  thorpej 	 * If we're returning to user mode, check for pending ASTs.
    138  1.1  thorpej 	 */
    139  1.1  thorpej 	ldr	r0, [sp]		/* Get the SPSR from stack */
    140  1.1  thorpej 	and	r0, r0, #(PSR_MODE)	/* Test for USR32 mode before the IRQ */
    141  1.1  thorpej 	teq	r0, #(PSR_USR32_MODE)
    142  1.1  thorpej 	bne	Lirqout			/* Nope, get out now */
    143  1.1  thorpej 
    144  1.1  thorpej Lastloop:
    145  1.1  thorpej 	ldr	r0, Lastpending		/* Do we have an AST pending? */
    146  1.1  thorpej 	ldr	r1, [r0]
    147  1.1  thorpej 	teq	r1, #0x00000000
    148  1.1  thorpej 	beq	Lirqout			/* Nope, get out now */
    149  1.1  thorpej 
    150  1.1  thorpej 	mov	r1, #0x00000000
    151  1.1  thorpej 	str	r1, [r0]		/* Clear astpending */
    152  1.1  thorpej 
    153  1.1  thorpej 	mrs	r4, cpsr_all		/* save CPSR */
    154  1.1  thorpej 	bic	r0, r4, #(I32_bit)	/* Enable IRQs */
    155  1.1  thorpej 	msr	cpsr_all, r0
    156  1.1  thorpej 
    157  1.1  thorpej 	mov	r0, sp
    158  1.1  thorpej 	bl	_C_LABEL(ast)		/* ast(frame) */
    159  1.1  thorpej 
    160  1.1  thorpej 	msr	cpsr_all, r4		/* Disable IRQs */
    161  1.1  thorpej 	b	Lastloop		/* Check for more ASTs */
    162  1.1  thorpej 
    163  1.1  thorpej Lirqout:
    164  1.1  thorpej 	PULLFRAMEFROMSVCANDEXIT
    165  1.1  thorpej 	movs	pc, lr			/* Exit */
    166  1.1  thorpej 
    167  1.1  thorpej 	.bss
    168  1.1  thorpej 	.align	0
    169  1.1  thorpej 
    170  1.1  thorpej 	.global _C_LABEL(astpending)
    171  1.1  thorpej _C_LABEL(astpending):
    172  1.1  thorpej 	.word	0
    173  1.1  thorpej 
    174  1.1  thorpej 	.global	_C_LABEL(current_intr_depth)
    175  1.1  thorpej _C_LABEL(current_intr_depth):
    176  1.1  thorpej 	.word	0
    177  1.1  thorpej 
    178  1.1  thorpej 	.global	_C_LABEL(prev_intr_depth)
    179  1.1  thorpej _C_LABEL(prev_intr_depth):
    180  1.1  thorpej 	.word	0
    181  1.1  thorpej 
    182  1.1  thorpej 	/*
    183  1.1  thorpej 	 * XXX Provide intrnames/intrcnt for legacy code, but
    184  1.1  thorpej 	 * don't actually use them.
    185  1.1  thorpej 	 */
    186  1.1  thorpej 
    187  1.1  thorpej 	.global _C_LABEL(intrnames), _C_LABEL(eintrnames)
    188  1.1  thorpej 	.global _C_LABEL(intrcnt), _C_LABEL(eintrcnt)
    189  1.1  thorpej _C_LABEL(intrnames):
    190  1.1  thorpej _C_LABEL(eintrnames):
    191  1.1  thorpej 
    192  1.1  thorpej 	.global _C_LABEL(intrcnt), _C_LABEL(sintrcnt), _C_LABEL(eintrcnt)
    193  1.1  thorpej _C_LABEL(intrcnt):
    194  1.1  thorpej _C_LABEL(eintrcnt):
    195