1
2
3
4
5
6
7
8
9
10 .macro get_irqnr_preamble, base, tmp
11 mrc p15, 0, \tmp, c15, c1, 0
12 orr \tmp, \tmp, #(1 << 6)
13 mcr p15, 0, \tmp, c15, c1, 0 @ Enable cp6 access
14 mrc p15, 0, \tmp, c15, c1, 0
15 mov \tmp, \tmp
16 sub pc, pc, #4 @ cp_wait
17 .endm
18
19 .macro get_irqnr_and_base, irqnr, irqstat, base, tmp
20 mrc p6, 0, \irqstat, c8, c0, 0 @ Read IINTSRC
21 cmp \irqstat, #0
22 clzne \irqnr, \irqstat
23 rsbne \irqnr, \irqnr, #31
24 .endm
25
26 .macro arch_ret_to_user, tmp1, tmp2
27 mrc p15, 0, \tmp1, c15, c1, 0
28 ands \tmp2, \tmp1, #(1 << 6)
29 bicne \tmp1, \tmp1, #(1 << 6)
30 mcrne p15, 0, \tmp1, c15, c1, 0 @ Disable cp6 access
31 .endm