1/*
2 * arch/arm/mach-iop33x/include/mach/entry-macro.S
3 *
4 * Low-level IRQ helper macros for IOP33x-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/iop33x.h>
11
12	.macro get_irqnr_preamble, base, tmp
13	mrc	p15, 0, \tmp, c15, c1, 0
14	orr	\tmp, \tmp, #(1 << 6)
15	mcr	p15, 0, \tmp, c15, c1, 0	@ Enable cp6 access
16	mrc	p15, 0, \tmp, c15, c1, 0
17	mov	\tmp, \tmp
18	sub	pc, pc, #4			@ cp_wait
19	.endm
20
21	.macro  get_irqnr_and_base, irqnr, irqstat, base, tmp
22	mrc     p6, 0, \irqstat, c14, c0, 0     @ Read IINTVEC
23	cmp     \irqstat, #0
24	mrceq   p6, 0, \irqstat, c14, c0, 0     @ erratum 63 workaround
25	adds    \irqnr, \irqstat, #1
26	movne   \irqnr, \irqstat, lsr #2
27	.endm
28
29	.macro arch_ret_to_user, tmp1, tmp2
30	mrc	p15, 0, \tmp1, c15, c1, 0
31	ands	\tmp2, \tmp1, #(1 << 6)
32	bicne	\tmp1, \tmp1, #(1 << 6)
33	mcrne	p15, 0, \tmp1, c15, c1, 0	@ Disable cp6 access
34	.endm
35