| /* |
| * 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 |
| |
| /* |
| * Vector entry |
| */ |
| .macro ventry label |
| .align 7 |
| b \label |
| .endm |