nios2: Assembly macros and definitions
This patch add assembly macros and definitions used in the .S files across arch/nios2/ and together with asm-offsets.c. Signed-off-by: Ley Foon Tan <lftan@altera.com>
This commit is contained in:
Ley Foon Tan
309
arch/nios2/include/asm/asm-macros.h
Normal file
309
arch/nios2/include/asm/asm-macros.h
Normal file
@@ -0,0 +1,309 @@
|
||||
/*
|
||||
* Macro used to simplify coding multi-line assembler.
|
||||
* Some of the bit test macro can simplify down to one line
|
||||
* depending on the mask value.
|
||||
*
|
||||
* Copyright (C) 2004 Microtronix Datacom Ltd.
|
||||
*
|
||||
* All rights reserved.
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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, GOOD TITLE or
|
||||
* NON INFRINGEMENT. See the GNU General Public License for more
|
||||
* details.
|
||||
*
|
||||
*/
|
||||
#ifndef _ASM_NIOS2_ASMMACROS_H
|
||||
#define _ASM_NIOS2_ASMMACROS_H
|
||||
/*
|
||||
* ANDs reg2 with mask and places the result in reg1.
|
||||
*
|
||||
* You cannnot use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro ANDI32 reg1, reg2, mask
|
||||
.if \mask & 0xffff
|
||||
.if \mask & 0xffff0000
|
||||
movhi \reg1, %hi(\mask)
|
||||
movui \reg1, %lo(\mask)
|
||||
and \reg1, \reg1, \reg2
|
||||
.else
|
||||
andi \reg1, \reg2, %lo(\mask)
|
||||
.endif
|
||||
.else
|
||||
andhi \reg1, \reg2, %hi(\mask)
|
||||
.endif
|
||||
.endm
|
||||
|
||||
/*
|
||||
* ORs reg2 with mask and places the result in reg1.
|
||||
*
|
||||
* It is safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro ORI32 reg1, reg2, mask
|
||||
.if \mask & 0xffff
|
||||
.if \mask & 0xffff0000
|
||||
orhi \reg1, \reg2, %hi(\mask)
|
||||
ori \reg1, \reg2, %lo(\mask)
|
||||
.else
|
||||
ori \reg1, \reg2, %lo(\mask)
|
||||
.endif
|
||||
.else
|
||||
orhi \reg1, \reg2, %hi(\mask)
|
||||
.endif
|
||||
.endm
|
||||
|
||||
/*
|
||||
* XORs reg2 with mask and places the result in reg1.
|
||||
*
|
||||
* It is safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro XORI32 reg1, reg2, mask
|
||||
.if \mask & 0xffff
|
||||
.if \mask & 0xffff0000
|
||||
xorhi \reg1, \reg2, %hi(\mask)
|
||||
xori \reg1, \reg1, %lo(\mask)
|
||||
.else
|
||||
xori \reg1, \reg2, %lo(\mask)
|
||||
.endif
|
||||
.else
|
||||
xorhi \reg1, \reg2, %hi(\mask)
|
||||
.endif
|
||||
.endm
|
||||
|
||||
/*
|
||||
* This is a support macro for BTBZ & BTBNZ. It checks
|
||||
* the bit to make sure it is valid 32 value.
|
||||
*
|
||||
* It is safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro BT reg1, reg2, bit
|
||||
.if \bit > 31
|
||||
.err
|
||||
.else
|
||||
.if \bit < 16
|
||||
andi \reg1, \reg2, (1 << \bit)
|
||||
.else
|
||||
andhi \reg1, \reg2, (1 << (\bit - 16))
|
||||
.endif
|
||||
.endif
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Tests the bit in reg2 and branches to label if the
|
||||
* bit is zero. The result of the bit test is stored in reg1.
|
||||
*
|
||||
* It is safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro BTBZ reg1, reg2, bit, label
|
||||
BT \reg1, \reg2, \bit
|
||||
beq \reg1, r0, \label
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Tests the bit in reg2 and branches to label if the
|
||||
* bit is non-zero. The result of the bit test is stored in reg1.
|
||||
*
|
||||
* It is safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro BTBNZ reg1, reg2, bit, label
|
||||
BT \reg1, \reg2, \bit
|
||||
bne \reg1, r0, \label
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Tests the bit in reg2 and then compliments the bit in reg2.
|
||||
* The result of the bit test is stored in reg1.
|
||||
*
|
||||
* It is NOT safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro BTC reg1, reg2, bit
|
||||
.if \bit > 31
|
||||
.err
|
||||
.else
|
||||
.if \bit < 16
|
||||
andi \reg1, \reg2, (1 << \bit)
|
||||
xori \reg2, \reg2, (1 << \bit)
|
||||
.else
|
||||
andhi \reg1, \reg2, (1 << (\bit - 16))
|
||||
xorhi \reg2, \reg2, (1 << (\bit - 16))
|
||||
.endif
|
||||
.endif
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Tests the bit in reg2 and then sets the bit in reg2.
|
||||
* The result of the bit test is stored in reg1.
|
||||
*
|
||||
* It is NOT safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro BTS reg1, reg2, bit
|
||||
.if \bit > 31
|
||||
.err
|
||||
.else
|
||||
.if \bit < 16
|
||||
andi \reg1, \reg2, (1 << \bit)
|
||||
ori \reg2, \reg2, (1 << \bit)
|
||||
.else
|
||||
andhi \reg1, \reg2, (1 << (\bit - 16))
|
||||
orhi \reg2, \reg2, (1 << (\bit - 16))
|
||||
.endif
|
||||
.endif
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Tests the bit in reg2 and then resets the bit in reg2.
|
||||
* The result of the bit test is stored in reg1.
|
||||
*
|
||||
* It is NOT safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro BTR reg1, reg2, bit
|
||||
.if \bit > 31
|
||||
.err
|
||||
.else
|
||||
.if \bit < 16
|
||||
andi \reg1, \reg2, (1 << \bit)
|
||||
andi \reg2, \reg2, %lo(~(1 << \bit))
|
||||
.else
|
||||
andhi \reg1, \reg2, (1 << (\bit - 16))
|
||||
andhi \reg2, \reg2, %lo(~(1 << (\bit - 16)))
|
||||
.endif
|
||||
.endif
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Tests the bit in reg2 and then compliments the bit in reg2.
|
||||
* The result of the bit test is stored in reg1. If the
|
||||
* original bit was zero it branches to label.
|
||||
*
|
||||
* It is NOT safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro BTCBZ reg1, reg2, bit, label
|
||||
BTC \reg1, \reg2, \bit
|
||||
beq \reg1, r0, \label
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Tests the bit in reg2 and then compliments the bit in reg2.
|
||||
* The result of the bit test is stored in reg1. If the
|
||||
* original bit was non-zero it branches to label.
|
||||
*
|
||||
* It is NOT safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro BTCBNZ reg1, reg2, bit, label
|
||||
BTC \reg1, \reg2, \bit
|
||||
bne \reg1, r0, \label
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Tests the bit in reg2 and then sets the bit in reg2.
|
||||
* The result of the bit test is stored in reg1. If the
|
||||
* original bit was zero it branches to label.
|
||||
*
|
||||
* It is NOT safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro BTSBZ reg1, reg2, bit, label
|
||||
BTS \reg1, \reg2, \bit
|
||||
beq \reg1, r0, \label
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Tests the bit in reg2 and then sets the bit in reg2.
|
||||
* The result of the bit test is stored in reg1. If the
|
||||
* original bit was non-zero it branches to label.
|
||||
*
|
||||
* It is NOT safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro BTSBNZ reg1, reg2, bit, label
|
||||
BTS \reg1, \reg2, \bit
|
||||
bne \reg1, r0, \label
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Tests the bit in reg2 and then resets the bit in reg2.
|
||||
* The result of the bit test is stored in reg1. If the
|
||||
* original bit was zero it branches to label.
|
||||
*
|
||||
* It is NOT safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro BTRBZ reg1, reg2, bit, label
|
||||
BTR \reg1, \reg2, \bit
|
||||
bne \reg1, r0, \label
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Tests the bit in reg2 and then resets the bit in reg2.
|
||||
* The result of the bit test is stored in reg1. If the
|
||||
* original bit was non-zero it branches to label.
|
||||
*
|
||||
* It is NOT safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro BTRBNZ reg1, reg2, bit, label
|
||||
BTR \reg1, \reg2, \bit
|
||||
bne \reg1, r0, \label
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Tests the bits in mask against reg2 stores the result in reg1.
|
||||
* If the all the bits in the mask are zero it branches to label.
|
||||
*
|
||||
* It is safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro TSTBZ reg1, reg2, mask, label
|
||||
ANDI32 \reg1, \reg2, \mask
|
||||
beq \reg1, r0, \label
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Tests the bits in mask against reg2 stores the result in reg1.
|
||||
* If the any of the bits in the mask are 1 it branches to label.
|
||||
*
|
||||
* It is safe to use the same register for reg1 & reg2.
|
||||
*/
|
||||
|
||||
.macro TSTBNZ reg1, reg2, mask, label
|
||||
ANDI32 \reg1, \reg2, \mask
|
||||
bne \reg1, r0, \label
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Pushes reg onto the stack.
|
||||
*/
|
||||
|
||||
.macro PUSH reg
|
||||
addi sp, sp, -4
|
||||
stw \reg, 0(sp)
|
||||
.endm
|
||||
|
||||
/*
|
||||
* Pops the top of the stack into reg.
|
||||
*/
|
||||
|
||||
.macro POP reg
|
||||
ldw \reg, 0(sp)
|
||||
addi sp, sp, 4
|
||||
.endm
|
||||
|
||||
|
||||
#endif /* _ASM_NIOS2_ASMMACROS_H */
|
||||
Reference in New Issue
Block a user