entry-macro.S 1.2 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
2
 * arch/arm/mach-pxa/include/mach/entry-macro.S
L
Linus Torvalds 已提交
3 4 5 6 7 8 9
 *
 * Low-level IRQ helper macros for PXA-based platforms
 *
 * This file is licensed under  the terms of the GNU General Public
 * License version 2. This program is licensed "as is" without any
 * warranty of any kind, whether express or implied.
 */
10 11
#include <mach/hardware.h>
#include <mach/irqs.h>
L
Linus Torvalds 已提交
12 13 14 15

		.macro	disable_fiq
		.endm

16 17 18 19 20 21
		.macro  get_irqnr_preamble, base, tmp
		.endm

		.macro  arch_ret_to_user, tmp1, tmp2
		.endm

L
Linus Torvalds 已提交
22
		.macro	get_irqnr_and_base, irqnr, irqstat, base, tmp
23 24 25 26
		mrc	p15, 0, \tmp, c0, c0, 0		@ CPUID
		mov	\tmp, \tmp, lsr #13
		and	\tmp, \tmp, #0x7		@ Core G
		cmp	\tmp, #1
27
		bhi	1002f
28

29
		@ Core Generation 1 (PXA25x)
L
Linus Torvalds 已提交
30 31 32 33
		mov	\base, #io_p2v(0x40000000)	@ IIR Ctl = 0x40d00000
		add	\base, \base, #0x00d00000
		ldr	\irqstat, [\base, #0]		@ ICIP
		ldr	\irqnr, [\base, #4]		@ ICMR
34

35
		ands	\irqnr, \irqstat, \irqnr
36
		beq	1001f
37 38 39
		rsb	\irqstat, \irqnr, #0
		and	\irqstat, \irqstat, \irqnr
		clz	\irqnr, \irqstat
40
		rsb	\irqnr, \irqnr, #(31 + PXA_IRQ(0))
41 42
		b	1001f
1002:
43 44 45
		@ Core Generation 2 (PXA27x) or Core Generation 3 (PXA3xx)
		mrc	p6, 0, \irqstat, c5, c0, 0	@ ICHP
		tst	\irqstat, #0x80000000
L
Linus Torvalds 已提交
46
		beq	1001f
47 48
		bic	\irqstat, \irqstat, #0x80000000
		mov	\irqnr, \irqstat, lsr #16
L
Linus Torvalds 已提交
49 50
1001:
		.endm