2012-03-05 18:49:26 +07:00
|
|
|
/*
|
|
|
|
* Based on arch/arm/include/asm/assembler.h
|
|
|
|
*
|
|
|
|
* Copyright (C) 1996-2000 Russell King
|
|
|
|
* Copyright (C) 2012 ARM Ltd.
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
|
|
* published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
* GNU General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*/
|
|
|
|
#ifndef __ASSEMBLY__
|
|
|
|
#error "Only include this from assembly code"
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#include <asm/ptrace.h>
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Stack pushing/popping (register pairs only). Equivalent to store decrement
|
|
|
|
* before, load increment after.
|
|
|
|
*/
|
|
|
|
.macro push, xreg1, xreg2
|
|
|
|
stp \xreg1, \xreg2, [sp, #-16]!
|
|
|
|
.endm
|
|
|
|
|
|
|
|
.macro pop, xreg1, xreg2
|
|
|
|
ldp \xreg1, \xreg2, [sp], #16
|
|
|
|
.endm
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Enable and disable interrupts.
|
|
|
|
*/
|
|
|
|
.macro disable_irq
|
|
|
|
msr daifset, #2
|
|
|
|
.endm
|
|
|
|
|
|
|
|
.macro enable_irq
|
|
|
|
msr daifclr, #2
|
|
|
|
.endm
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Save/disable and restore interrupts.
|
|
|
|
*/
|
|
|
|
.macro save_and_disable_irqs, olddaif
|
|
|
|
mrs \olddaif, daif
|
|
|
|
disable_irq
|
|
|
|
.endm
|
|
|
|
|
|
|
|
.macro restore_irqs, olddaif
|
|
|
|
msr daif, \olddaif
|
|
|
|
.endm
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Enable and disable debug exceptions.
|
|
|
|
*/
|
|
|
|
.macro disable_dbg
|
|
|
|
msr daifset, #8
|
|
|
|
.endm
|
|
|
|
|
|
|
|
.macro enable_dbg
|
|
|
|
msr daifclr, #8
|
|
|
|
.endm
|
|
|
|
|
|
|
|
.macro disable_step, tmp
|
|
|
|
mrs \tmp, mdscr_el1
|
|
|
|
bic \tmp, \tmp, #1
|
|
|
|
msr mdscr_el1, \tmp
|
|
|
|
.endm
|
|
|
|
|
|
|
|
.macro enable_step, tmp
|
|
|
|
mrs \tmp, mdscr_el1
|
|
|
|
orr \tmp, \tmp, #1
|
|
|
|
msr mdscr_el1, \tmp
|
|
|
|
.endm
|
|
|
|
|
|
|
|
.macro enable_dbg_if_not_stepping, tmp
|
|
|
|
mrs \tmp, mdscr_el1
|
2013-05-17 23:41:22 +07:00
|
|
|
tbnz \tmp, #0, 9990f
|
2012-03-05 18:49:26 +07:00
|
|
|
enable_dbg
|
|
|
|
9990:
|
|
|
|
.endm
|
|
|
|
|
|
|
|
/*
|
|
|
|
* SMP data memory barrier
|
|
|
|
*/
|
|
|
|
.macro smp_dmb, opt
|
|
|
|
#ifdef CONFIG_SMP
|
|
|
|
dmb \opt
|
|
|
|
#endif
|
|
|
|
.endm
|
|
|
|
|
|
|
|
#define USER(l, x...) \
|
|
|
|
9999: x; \
|
|
|
|
.section __ex_table,"a"; \
|
|
|
|
.align 3; \
|
|
|
|
.quad 9999b,l; \
|
|
|
|
.previous
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Register aliases.
|
|
|
|
*/
|
|
|
|
lr .req x30 // link register
|
2012-10-19 23:37:35 +07:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Vector entry
|
|
|
|
*/
|
|
|
|
.macro ventry label
|
|
|
|
.align 7
|
|
|
|
b \label
|
|
|
|
.endm
|
2013-10-11 20:52:15 +07:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Select code when configured for BE.
|
|
|
|
*/
|
|
|
|
#ifdef CONFIG_CPU_BIG_ENDIAN
|
|
|
|
#define CPU_BE(code...) code
|
|
|
|
#else
|
|
|
|
#define CPU_BE(code...)
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Select code when configured for LE.
|
|
|
|
*/
|
|
|
|
#ifdef CONFIG_CPU_BIG_ENDIAN
|
|
|
|
#define CPU_LE(code...)
|
|
|
|
#else
|
|
|
|
#define CPU_LE(code...) code
|
|
|
|
#endif
|
|
|
|
|
2013-10-11 20:52:13 +07:00
|
|
|
/*
|
|
|
|
* Define a macro that constructs a 64-bit value by concatenating two
|
|
|
|
* 32-bit registers. Note that on big endian systems the order of the
|
|
|
|
* registers is swapped.
|
|
|
|
*/
|
|
|
|
#ifndef CONFIG_CPU_BIG_ENDIAN
|
|
|
|
.macro regs_to_64, rd, lbits, hbits
|
|
|
|
#else
|
|
|
|
.macro regs_to_64, rd, hbits, lbits
|
|
|
|
#endif
|
|
|
|
orr \rd, \lbits, \hbits, lsl #32
|
|
|
|
.endm
|