Home | History | Annotate | Line # | Download | only in xscale
i80200_irq.S revision 1.8
      1  1.8    bjh21 /*	$NetBSD: i80200_irq.S,v 1.8 2002/10/21 18:09:18 bjh21 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.6  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.6  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.6  thorpej .Lpmc_dispatch:
     66  1.4   briggs 	.word	_C_LABEL(xscale_pmc_dispatch)
     67  1.4   briggs #endif
     68  1.4   briggs 
     69  1.6  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.6  thorpej 	ldr	r0, .Lcurrent_intr_depth
     84  1.6  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.6  thorpej 	beq	.Lpmc_intr_return
    102  1.4   briggs 	mov	r1, r4
    103  1.4   briggs 	mov	r0, sp
    104  1.7    bjh21 	mov	lr, pc
    105  1.6  thorpej 	ldr	pc, .Lpmc_dispatch
    106  1.4   briggs #endif
    107  1.4   briggs 
    108  1.1  thorpej 	/*
    109  1.4   briggs 	 * XXX - any need to handle BMU interrupts?
    110  1.1  thorpej 	 */
    111  1.1  thorpej 
    112  1.1  thorpej 	/*
    113  1.1  thorpej 	 * Check for external IRQs.  If we have one, call the
    114  1.1  thorpej 	 * external IRQ dispatcher.  The argument is a pointer
    115  1.1  thorpej 	 * to the stack frame.  This function will be called with
    116  1.1  thorpej 	 * interrupts disabled, and will return with interrupts
    117  1.1  thorpej 	 * disabled.
    118  1.1  thorpej 	 */
    119  1.1  thorpej 	tst	r4, #(INTSRC_II)
    120  1.6  thorpej 	beq	.Lextirq_return		/* no external IRQ pending */
    121  1.6  thorpej 	ldr	r1, .Lintr_dispatch
    122  1.1  thorpej 	mov	r0, sp
    123  1.7    bjh21 	mov	lr, pc
    124  1.1  thorpej 	ldr	pc, [r1]
    125  1.8    bjh21 .Lextirq_return:
    126  1.1  thorpej 
    127  1.1  thorpej 	/* Decremement the nest count. */
    128  1.6  thorpej 	ldr	r0, .Lcurrent_intr_depth
    129  1.6  thorpej 	ldr	r2, .Lcurrent_intr_depth+4
    130  1.1  thorpej 	ldr	r1, [r0]
    131  1.1  thorpej 	str	r1, [r2]
    132  1.1  thorpej 	sub	r1, r1, #1
    133  1.1  thorpej 	str	r1, [r0]
    134  1.1  thorpej 
    135  1.1  thorpej 	/*
    136  1.1  thorpej 	 * If we're returning to user mode, check for pending ASTs.
    137  1.1  thorpej 	 */
    138  1.1  thorpej 	ldr	r0, [sp]		/* Get the SPSR from stack */
    139  1.1  thorpej 	and	r0, r0, #(PSR_MODE)	/* Test for USR32 mode before the IRQ */
    140  1.1  thorpej 	teq	r0, #(PSR_USR32_MODE)
    141  1.6  thorpej 	bne	.Lirqout		/* Nope, get out now */
    142  1.1  thorpej 
    143  1.6  thorpej .Lastloop:
    144  1.6  thorpej 	ldr	r0, .Lastpending	/* Do we have an AST pending? */
    145  1.1  thorpej 	ldr	r1, [r0]
    146  1.1  thorpej 	teq	r1, #0x00000000
    147  1.6  thorpej 	beq	.Lirqout		/* Nope, get out now */
    148  1.1  thorpej 
    149  1.1  thorpej 	mov	r1, #0x00000000
    150  1.1  thorpej 	str	r1, [r0]		/* Clear astpending */
    151  1.1  thorpej 
    152  1.5  thorpej 	mrs	r4, cpsr		/* save CPSR */
    153  1.1  thorpej 	bic	r0, r4, #(I32_bit)	/* Enable IRQs */
    154  1.5  thorpej 	msr	cpsr_c, r0
    155  1.1  thorpej 
    156  1.1  thorpej 	mov	r0, sp
    157  1.1  thorpej 	bl	_C_LABEL(ast)		/* ast(frame) */
    158  1.1  thorpej 
    159  1.5  thorpej 	msr	cpsr_c, r4		/* Disable IRQs */
    160  1.6  thorpej 	b	.Lastloop		/* Check for more ASTs */
    161  1.1  thorpej 
    162  1.6  thorpej .Lirqout:
    163  1.1  thorpej 	PULLFRAMEFROMSVCANDEXIT
    164  1.1  thorpej 	movs	pc, lr			/* Exit */
    165  1.1  thorpej 
    166  1.1  thorpej 	.bss
    167  1.1  thorpej 	.align	0
    168  1.1  thorpej 
    169  1.1  thorpej 	.global _C_LABEL(astpending)
    170  1.1  thorpej _C_LABEL(astpending):
    171  1.1  thorpej 	.word	0
    172  1.1  thorpej 
    173  1.1  thorpej 	.global	_C_LABEL(current_intr_depth)
    174  1.1  thorpej _C_LABEL(current_intr_depth):
    175  1.1  thorpej 	.word	0
    176  1.1  thorpej 
    177  1.1  thorpej 	.global	_C_LABEL(prev_intr_depth)
    178  1.1  thorpej _C_LABEL(prev_intr_depth):
    179  1.1  thorpej 	.word	0
    180  1.1  thorpej 
    181  1.1  thorpej 	/*
    182  1.1  thorpej 	 * XXX Provide intrnames/intrcnt for legacy code, but
    183  1.1  thorpej 	 * don't actually use them.
    184  1.1  thorpej 	 */
    185  1.1  thorpej 
    186  1.1  thorpej 	.global _C_LABEL(intrnames), _C_LABEL(eintrnames)
    187  1.1  thorpej 	.global _C_LABEL(intrcnt), _C_LABEL(eintrcnt)
    188  1.1  thorpej _C_LABEL(intrnames):
    189  1.1  thorpej _C_LABEL(eintrnames):
    190  1.1  thorpej 
    191  1.1  thorpej 	.global _C_LABEL(intrcnt), _C_LABEL(sintrcnt), _C_LABEL(eintrcnt)
    192  1.1  thorpej _C_LABEL(intrcnt):
    193  1.1  thorpej _C_LABEL(eintrcnt):
    194