1
2
3
4
5
6
7
8
9
10
11 #ifndef _ASM_NIOS2_ASMMACROS_H
12 #define _ASM_NIOS2_ASMMACROS_H
13
14
15
16
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
35
36
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
54
55
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
73
74
75
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
92
93
94
95
96
97 .macro BTBZ reg1, reg2, bit, label
98 BT \reg1, \reg2, \bit
99 beq \reg1, r0, \label
100 .endm
101
102
103
104
105
106
107
108
109 .macro BTBNZ reg1, reg2, bit, label
110 BT \reg1, \reg2, \bit
111 bne \reg1, r0, \label
112 .endm
113
114
115
116
117
118
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
137
138
139
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
158
159
160
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
179
180
181
182
183
184
185 .macro BTCBZ reg1, reg2, bit, label
186 BTC \reg1, \reg2, \bit
187 beq \reg1, r0, \label
188 .endm
189
190
191
192
193
194
195
196
197
198 .macro BTCBNZ reg1, reg2, bit, label
199 BTC \reg1, \reg2, \bit
200 bne \reg1, r0, \label
201 .endm
202
203
204
205
206
207
208
209
210
211 .macro BTSBZ reg1, reg2, bit, label
212 BTS \reg1, \reg2, \bit
213 beq \reg1, r0, \label
214 .endm
215
216
217
218
219
220
221
222
223
224 .macro BTSBNZ reg1, reg2, bit, label
225 BTS \reg1, \reg2, \bit
226 bne \reg1, r0, \label
227 .endm
228
229
230
231
232
233
234
235
236
237 .macro BTRBZ reg1, reg2, bit, label
238 BTR \reg1, \reg2, \bit
239 bne \reg1, r0, \label
240 .endm
241
242
243
244
245
246
247
248
249
250 .macro BTRBNZ reg1, reg2, bit, label
251 BTR \reg1, \reg2, \bit
252 bne \reg1, r0, \label
253 .endm
254
255
256
257
258
259
260
261
262 .macro TSTBZ reg1, reg2, mask, label
263 ANDI32 \reg1, \reg2, \mask
264 beq \reg1, r0, \label
265 .endm
266
267
268
269
270
271
272
273
274 .macro TSTBNZ reg1, reg2, mask, label
275 ANDI32 \reg1, \reg2, \mask
276 bne \reg1, r0, \label
277 .endm
278
279
280
281
282
283 .macro PUSH reg
284 addi sp, sp, -4
285 stw \reg, 0(sp)
286 .endm
287
288
289
290
291
292 .macro POP reg
293 ldw \reg, 0(sp)
294 addi sp, sp, 4
295 .endm
296
297
298 #endif