forked from Minki/linux
110 lines
2.0 KiB
C
110 lines
2.0 KiB
C
|
/*
|
||
|
|
* 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
|
||
|
|
tbnz \tmp, #1, 9990f
|
||
|
|
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
|