• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1/*
2 * arch/arm/mach-pxa/include/mach/entry-macro.S
3 *
4 * Low-level IRQ helper macros for PXA-based platforms
5 *
6 * This file is licensed under  the terms of the GNU General Public
7 * License version 2. This program is licensed "as is" without any
8 * warranty of any kind, whether express or implied.
9 */
10#include <mach/hardware.h>
11#include <mach/irqs.h>
12
13		.macro	disable_fiq
14		.endm
15
16		.macro  get_irqnr_preamble, base, tmp
17		.endm
18
19		.macro  arch_ret_to_user, tmp1, tmp2
20		.endm
21
22		.macro	get_irqnr_and_base, irqnr, irqstat, base, tmp
23		mrc	p15, 0, \tmp, c0, c0, 0		@ CPUID
24		mov	\tmp, \tmp, lsr #13
25		and	\tmp, \tmp, #0x7		@ Core G
26		cmp	\tmp, #1
27		bhi	1004f
28
29		mov	\base, #io_p2v(0x40000000)	@ IIR Ctl = 0x40d00000
30		add	\base, \base, #0x00d00000
31		ldr	\irqstat, [\base, #0]		@ ICIP
32		ldr	\irqnr, [\base, #4]		@ ICMR
33		b	1002f
34
351004:
36		mrc	p6, 0, \irqstat, c6, c0, 0	@ ICIP2
37		mrc	p6, 0, \irqnr, c7, c0, 0	@ ICMR2
38		ands	\irqnr, \irqstat, \irqnr
39		beq	1003f
40		rsb	\irqstat, \irqnr, #0
41		and	\irqstat, \irqstat, \irqnr
42		clz	\irqnr, \irqstat
43		rsb	\irqnr, \irqnr, #31
44		add	\irqnr, \irqnr, #(32 + PXA_IRQ(0))
45		b	1001f
461003:
47		mrc	p6, 0, \irqstat, c0, c0, 0	@ ICIP
48		mrc	p6, 0, \irqnr, c1, c0, 0	@ ICMR
491002:
50		ands	\irqnr, \irqstat, \irqnr
51		beq	1001f
52		rsb	\irqstat, \irqnr, #0
53		and	\irqstat, \irqstat, \irqnr
54		clz	\irqnr, \irqstat
55		rsb	\irqnr, \irqnr, #(31 + PXA_IRQ(0))
561001:
57		.endm
58