1 /* SPDX-License-Identifier: GPL-2.0-or-later */ 2 /* 3 * Macro used to simplify coding multi-line assembler. 4 * Some of the bit test macro can simplify down to one line 5 * depending on the mask value. 6 * 7 * Copyright (C) 2004 Microtronix Datacom Ltd. 8 * 9 * All rights reserved. 10 */ 11 #ifndef _ASM_NIOS2_ASMMACROS_H 12 #define _ASM_NIOS2_ASMMACROS_H 13 /* 14 * ANDs reg2 with mask and places the result in reg1. 15 * 16 * You cannnot use the same register for reg1 & reg2. 17 */ 18 19 .macro ANDI32 reg1, reg2, mask 20 .if \mask & 0xffff 21 .if \mask & 0xffff0000 22 movhi \reg1, %hi(\mask) 23 movui \reg1, %lo(\mask) 24 and \reg1, \reg1, \reg2 25 .else 26 andi \reg1, \reg2, %lo(\mask) 27 .endif 28 .else 29 andhi \reg1, \reg2, %hi(\mask) 30 .endif 31 .endm 32 33 /* 34 * ORs reg2 with mask and places the result in reg1. 35 * 36 * It is safe to use the same register for reg1 & reg2. 37 */ 38 39 .macro ORI32 reg1, reg2, mask 40 .if \mask & 0xffff 41 .if \mask & 0xffff0000 42 orhi \reg1, \reg2, %hi(\mask) 43 ori \reg1, \reg2, %lo(\mask) 44 .else 45 ori \reg1, \reg2, %lo(\mask) 46 .endif 47 .else 48 orhi \reg1, \reg2, %hi(\mask) 49 .endif 50 .endm 51 52 /* 53 * XORs reg2 with mask and places the result in reg1. 54 * 55 * It is safe to use the same register for reg1 & reg2. 56 */ 57 58 .macro XORI32 reg1, reg2, mask 59 .if \mask & 0xffff 60 .if \mask & 0xffff0000 61 xorhi \reg1, \reg2, %hi(\mask) 62 xori \reg1, \reg1, %lo(\mask) 63 .else 64 xori \reg1, \reg2, %lo(\mask) 65 .endif 66 .else 67 xorhi \reg1, \reg2, %hi(\mask) 68 .endif 69 .endm 70 71 /* 72 * This is a support macro for BTBZ & BTBNZ. It checks 73 * the bit to make sure it is valid 32 value. 74 * 75 * It is safe to use the same register for reg1 & reg2. 76 */ 77 78 .macro BT reg1, reg2, bit 79 .if \bit > 31 80 .err 81 .else 82 .if \bit < 16 83 andi \reg1, \reg2, (1 << \bit) 84 .else 85 andhi \reg1, \reg2, (1 << (\bit - 16)) 86 .endif 87 .endif 88 .endm 89 90 /* 91 * Tests the bit in reg2 and branches to label if the 92 * bit is zero. The result of the bit test is stored in reg1. 93 * 94 * It is safe to use the same register for reg1 & reg2. 95 */ 96 97 .macro BTBZ reg1, reg2, bit, label 98 BT \reg1, \reg2, \bit 99 beq \reg1, r0, \label 100 .endm 101 102 /* 103 * Tests the bit in reg2 and branches to label if the 104 * bit is non-zero. The result of the bit test is stored in reg1. 105 * 106 * It is safe to use the same register for reg1 & reg2. 107 */ 108 109 .macro BTBNZ reg1, reg2, bit, label 110 BT \reg1, \reg2, \bit 111 bne \reg1, r0, \label 112 .endm 113 114 /* 115 * Tests the bit in reg2 and then compliments the bit in reg2. 116 * The result of the bit test is stored in reg1. 117 * 118 * It is NOT safe to use the same register for reg1 & reg2. 119 */ 120 121 .macro BTC reg1, reg2, bit 122 .if \bit > 31 123 .err 124 .else 125 .if \bit < 16 126 andi \reg1, \reg2, (1 << \bit) 127 xori \reg2, \reg2, (1 << \bit) 128 .else 129 andhi \reg1, \reg2, (1 << (\bit - 16)) 130 xorhi \reg2, \reg2, (1 << (\bit - 16)) 131 .endif 132 .endif 133 .endm 134 135 /* 136 * Tests the bit in reg2 and then sets the bit in reg2. 137 * The result of the bit test is stored in reg1. 138 * 139 * It is NOT safe to use the same register for reg1 & reg2. 140 */ 141 142 .macro BTS reg1, reg2, bit 143 .if \bit > 31 144 .err 145 .else 146 .if \bit < 16 147 andi \reg1, \reg2, (1 << \bit) 148 ori \reg2, \reg2, (1 << \bit) 149 .else 150 andhi \reg1, \reg2, (1 << (\bit - 16)) 151 orhi \reg2, \reg2, (1 << (\bit - 16)) 152 .endif 153 .endif 154 .endm 155 156 /* 157 * Tests the bit in reg2 and then resets the bit in reg2. 158 * The result of the bit test is stored in reg1. 159 * 160 * It is NOT safe to use the same register for reg1 & reg2. 161 */ 162 163 .macro BTR reg1, reg2, bit 164 .if \bit > 31 165 .err 166 .else 167 .if \bit < 16 168 andi \reg1, \reg2, (1 << \bit) 169 andi \reg2, \reg2, %lo(~(1 << \bit)) 170 .else 171 andhi \reg1, \reg2, (1 << (\bit - 16)) 172 andhi \reg2, \reg2, %lo(~(1 << (\bit - 16))) 173 .endif 174 .endif 175 .endm 176 177 /* 178 * Tests the bit in reg2 and then compliments the bit in reg2. 179 * The result of the bit test is stored in reg1. If the 180 * original bit was zero it branches to label. 181 * 182 * It is NOT safe to use the same register for reg1 & reg2. 183 */ 184 185 .macro BTCBZ reg1, reg2, bit, label 186 BTC \reg1, \reg2, \bit 187 beq \reg1, r0, \label 188 .endm 189 190 /* 191 * Tests the bit in reg2 and then compliments the bit in reg2. 192 * The result of the bit test is stored in reg1. If the 193 * original bit was non-zero it branches to label. 194 * 195 * It is NOT safe to use the same register for reg1 & reg2. 196 */ 197 198 .macro BTCBNZ reg1, reg2, bit, label 199 BTC \reg1, \reg2, \bit 200 bne \reg1, r0, \label 201 .endm 202 203 /* 204 * Tests the bit in reg2 and then sets the bit in reg2. 205 * The result of the bit test is stored in reg1. If the 206 * original bit was zero it branches to label. 207 * 208 * It is NOT safe to use the same register for reg1 & reg2. 209 */ 210 211 .macro BTSBZ reg1, reg2, bit, label 212 BTS \reg1, \reg2, \bit 213 beq \reg1, r0, \label 214 .endm 215 216 /* 217 * Tests the bit in reg2 and then sets the bit in reg2. 218 * The result of the bit test is stored in reg1. If the 219 * original bit was non-zero it branches to label. 220 * 221 * It is NOT safe to use the same register for reg1 & reg2. 222 */ 223 224 .macro BTSBNZ reg1, reg2, bit, label 225 BTS \reg1, \reg2, \bit 226 bne \reg1, r0, \label 227 .endm 228 229 /* 230 * Tests the bit in reg2 and then resets the bit in reg2. 231 * The result of the bit test is stored in reg1. If the 232 * original bit was zero it branches to label. 233 * 234 * It is NOT safe to use the same register for reg1 & reg2. 235 */ 236 237 .macro BTRBZ reg1, reg2, bit, label 238 BTR \reg1, \reg2, \bit 239 bne \reg1, r0, \label 240 .endm 241 242 /* 243 * Tests the bit in reg2 and then resets the bit in reg2. 244 * The result of the bit test is stored in reg1. If the 245 * original bit was non-zero it branches to label. 246 * 247 * It is NOT safe to use the same register for reg1 & reg2. 248 */ 249 250 .macro BTRBNZ reg1, reg2, bit, label 251 BTR \reg1, \reg2, \bit 252 bne \reg1, r0, \label 253 .endm 254 255 /* 256 * Tests the bits in mask against reg2 stores the result in reg1. 257 * If the all the bits in the mask are zero it branches to label. 258 * 259 * It is safe to use the same register for reg1 & reg2. 260 */ 261 262 .macro TSTBZ reg1, reg2, mask, label 263 ANDI32 \reg1, \reg2, \mask 264 beq \reg1, r0, \label 265 .endm 266 267 /* 268 * Tests the bits in mask against reg2 stores the result in reg1. 269 * If the any of the bits in the mask are 1 it branches to label. 270 * 271 * It is safe to use the same register for reg1 & reg2. 272 */ 273 274 .macro TSTBNZ reg1, reg2, mask, label 275 ANDI32 \reg1, \reg2, \mask 276 bne \reg1, r0, \label 277 .endm 278 279 /* 280 * Pushes reg onto the stack. 281 */ 282 283 .macro PUSH reg 284 addi sp, sp, -4 285 stw \reg, 0(sp) 286 .endm 287 288 /* 289 * Pops the top of the stack into reg. 290 */ 291 292 .macro POP reg 293 ldw \reg, 0(sp) 294 addi sp, sp, 4 295 .endm 296 297 298 #endif /* _ASM_NIOS2_ASMMACROS_H */ 299