]>
Commit | Line | Data |
---|---|---|
1 | /* | |
2 | * This file is subject to the terms and conditions of the GNU General Public | |
3 | * License. See the file "COPYING" in the main directory of this archive | |
4 | * for more details. | |
5 | * | |
6 | * Copyright (C) 2003 Ralf Baechle | |
7 | */ | |
8 | #ifndef _ASM_ASMMACRO_H | |
9 | #define _ASM_ASMMACRO_H | |
10 | ||
11 | #include <asm/hazards.h> | |
12 | #include <asm/asm-offsets.h> | |
13 | #include <asm/msa.h> | |
14 | ||
15 | #ifdef CONFIG_32BIT | |
16 | #include <asm/asmmacro-32.h> | |
17 | #endif | |
18 | #ifdef CONFIG_64BIT | |
19 | #include <asm/asmmacro-64.h> | |
20 | #endif | |
21 | ||
22 | /* preprocessor replaces the fp in ".set fp=64" with $30 otherwise */ | |
23 | #undef fp | |
24 | ||
25 | /* | |
26 | * Helper macros for generating raw instruction encodings. | |
27 | */ | |
28 | #ifdef CONFIG_CPU_MICROMIPS | |
29 | .macro insn32_if_mm enc | |
30 | .insn | |
31 | .hword ((\enc) >> 16) | |
32 | .hword ((\enc) & 0xffff) | |
33 | .endm | |
34 | ||
35 | .macro insn_if_mips enc | |
36 | .endm | |
37 | #else | |
38 | .macro insn32_if_mm enc | |
39 | .endm | |
40 | ||
41 | .macro insn_if_mips enc | |
42 | .insn | |
43 | .word (\enc) | |
44 | .endm | |
45 | #endif | |
46 | ||
47 | #if defined(CONFIG_CPU_MIPSR2) || defined(CONFIG_CPU_MIPSR6) | |
48 | .macro local_irq_enable reg=t0 | |
49 | ei | |
50 | irq_enable_hazard | |
51 | .endm | |
52 | ||
53 | .macro local_irq_disable reg=t0 | |
54 | di | |
55 | irq_disable_hazard | |
56 | .endm | |
57 | #else | |
58 | .macro local_irq_enable reg=t0 | |
59 | mfc0 \reg, CP0_STATUS | |
60 | ori \reg, \reg, 1 | |
61 | mtc0 \reg, CP0_STATUS | |
62 | irq_enable_hazard | |
63 | .endm | |
64 | ||
65 | .macro local_irq_disable reg=t0 | |
66 | #ifdef CONFIG_PREEMPT | |
67 | lw \reg, TI_PRE_COUNT($28) | |
68 | addi \reg, \reg, 1 | |
69 | sw \reg, TI_PRE_COUNT($28) | |
70 | #endif | |
71 | mfc0 \reg, CP0_STATUS | |
72 | ori \reg, \reg, 1 | |
73 | xori \reg, \reg, 1 | |
74 | mtc0 \reg, CP0_STATUS | |
75 | irq_disable_hazard | |
76 | #ifdef CONFIG_PREEMPT | |
77 | lw \reg, TI_PRE_COUNT($28) | |
78 | addi \reg, \reg, -1 | |
79 | sw \reg, TI_PRE_COUNT($28) | |
80 | #endif | |
81 | .endm | |
82 | #endif /* CONFIG_CPU_MIPSR2 */ | |
83 | ||
84 | .macro fpu_save_16even thread tmp=t0 | |
85 | .set push | |
86 | SET_HARDFLOAT | |
87 | cfc1 \tmp, fcr31 | |
88 | sdc1 $f0, THREAD_FPR0(\thread) | |
89 | sdc1 $f2, THREAD_FPR2(\thread) | |
90 | sdc1 $f4, THREAD_FPR4(\thread) | |
91 | sdc1 $f6, THREAD_FPR6(\thread) | |
92 | sdc1 $f8, THREAD_FPR8(\thread) | |
93 | sdc1 $f10, THREAD_FPR10(\thread) | |
94 | sdc1 $f12, THREAD_FPR12(\thread) | |
95 | sdc1 $f14, THREAD_FPR14(\thread) | |
96 | sdc1 $f16, THREAD_FPR16(\thread) | |
97 | sdc1 $f18, THREAD_FPR18(\thread) | |
98 | sdc1 $f20, THREAD_FPR20(\thread) | |
99 | sdc1 $f22, THREAD_FPR22(\thread) | |
100 | sdc1 $f24, THREAD_FPR24(\thread) | |
101 | sdc1 $f26, THREAD_FPR26(\thread) | |
102 | sdc1 $f28, THREAD_FPR28(\thread) | |
103 | sdc1 $f30, THREAD_FPR30(\thread) | |
104 | sw \tmp, THREAD_FCR31(\thread) | |
105 | .set pop | |
106 | .endm | |
107 | ||
108 | .macro fpu_save_16odd thread | |
109 | .set push | |
110 | .set mips64r2 | |
111 | .set fp=64 | |
112 | SET_HARDFLOAT | |
113 | sdc1 $f1, THREAD_FPR1(\thread) | |
114 | sdc1 $f3, THREAD_FPR3(\thread) | |
115 | sdc1 $f5, THREAD_FPR5(\thread) | |
116 | sdc1 $f7, THREAD_FPR7(\thread) | |
117 | sdc1 $f9, THREAD_FPR9(\thread) | |
118 | sdc1 $f11, THREAD_FPR11(\thread) | |
119 | sdc1 $f13, THREAD_FPR13(\thread) | |
120 | sdc1 $f15, THREAD_FPR15(\thread) | |
121 | sdc1 $f17, THREAD_FPR17(\thread) | |
122 | sdc1 $f19, THREAD_FPR19(\thread) | |
123 | sdc1 $f21, THREAD_FPR21(\thread) | |
124 | sdc1 $f23, THREAD_FPR23(\thread) | |
125 | sdc1 $f25, THREAD_FPR25(\thread) | |
126 | sdc1 $f27, THREAD_FPR27(\thread) | |
127 | sdc1 $f29, THREAD_FPR29(\thread) | |
128 | sdc1 $f31, THREAD_FPR31(\thread) | |
129 | .set pop | |
130 | .endm | |
131 | ||
132 | .macro fpu_save_double thread status tmp | |
133 | #if defined(CONFIG_64BIT) || defined(CONFIG_CPU_MIPSR2) || \ | |
134 | defined(CONFIG_CPU_MIPSR6) | |
135 | sll \tmp, \status, 5 | |
136 | bgez \tmp, 10f | |
137 | fpu_save_16odd \thread | |
138 | 10: | |
139 | #endif | |
140 | fpu_save_16even \thread \tmp | |
141 | .endm | |
142 | ||
143 | .macro fpu_restore_16even thread tmp=t0 | |
144 | .set push | |
145 | SET_HARDFLOAT | |
146 | lw \tmp, THREAD_FCR31(\thread) | |
147 | ldc1 $f0, THREAD_FPR0(\thread) | |
148 | ldc1 $f2, THREAD_FPR2(\thread) | |
149 | ldc1 $f4, THREAD_FPR4(\thread) | |
150 | ldc1 $f6, THREAD_FPR6(\thread) | |
151 | ldc1 $f8, THREAD_FPR8(\thread) | |
152 | ldc1 $f10, THREAD_FPR10(\thread) | |
153 | ldc1 $f12, THREAD_FPR12(\thread) | |
154 | ldc1 $f14, THREAD_FPR14(\thread) | |
155 | ldc1 $f16, THREAD_FPR16(\thread) | |
156 | ldc1 $f18, THREAD_FPR18(\thread) | |
157 | ldc1 $f20, THREAD_FPR20(\thread) | |
158 | ldc1 $f22, THREAD_FPR22(\thread) | |
159 | ldc1 $f24, THREAD_FPR24(\thread) | |
160 | ldc1 $f26, THREAD_FPR26(\thread) | |
161 | ldc1 $f28, THREAD_FPR28(\thread) | |
162 | ldc1 $f30, THREAD_FPR30(\thread) | |
163 | ctc1 \tmp, fcr31 | |
164 | .set pop | |
165 | .endm | |
166 | ||
167 | .macro fpu_restore_16odd thread | |
168 | .set push | |
169 | .set mips64r2 | |
170 | .set fp=64 | |
171 | SET_HARDFLOAT | |
172 | ldc1 $f1, THREAD_FPR1(\thread) | |
173 | ldc1 $f3, THREAD_FPR3(\thread) | |
174 | ldc1 $f5, THREAD_FPR5(\thread) | |
175 | ldc1 $f7, THREAD_FPR7(\thread) | |
176 | ldc1 $f9, THREAD_FPR9(\thread) | |
177 | ldc1 $f11, THREAD_FPR11(\thread) | |
178 | ldc1 $f13, THREAD_FPR13(\thread) | |
179 | ldc1 $f15, THREAD_FPR15(\thread) | |
180 | ldc1 $f17, THREAD_FPR17(\thread) | |
181 | ldc1 $f19, THREAD_FPR19(\thread) | |
182 | ldc1 $f21, THREAD_FPR21(\thread) | |
183 | ldc1 $f23, THREAD_FPR23(\thread) | |
184 | ldc1 $f25, THREAD_FPR25(\thread) | |
185 | ldc1 $f27, THREAD_FPR27(\thread) | |
186 | ldc1 $f29, THREAD_FPR29(\thread) | |
187 | ldc1 $f31, THREAD_FPR31(\thread) | |
188 | .set pop | |
189 | .endm | |
190 | ||
191 | .macro fpu_restore_double thread status tmp | |
192 | #if defined(CONFIG_64BIT) || defined(CONFIG_CPU_MIPSR2) || \ | |
193 | defined(CONFIG_CPU_MIPSR6) | |
194 | sll \tmp, \status, 5 | |
195 | bgez \tmp, 10f # 16 register mode? | |
196 | ||
197 | fpu_restore_16odd \thread | |
198 | 10: | |
199 | #endif | |
200 | fpu_restore_16even \thread \tmp | |
201 | .endm | |
202 | ||
203 | #if defined(CONFIG_CPU_MIPSR2) || defined(CONFIG_CPU_MIPSR6) | |
204 | .macro _EXT rd, rs, p, s | |
205 | ext \rd, \rs, \p, \s | |
206 | .endm | |
207 | #else /* !CONFIG_CPU_MIPSR2 || !CONFIG_CPU_MIPSR6 */ | |
208 | .macro _EXT rd, rs, p, s | |
209 | srl \rd, \rs, \p | |
210 | andi \rd, \rd, (1 << \s) - 1 | |
211 | .endm | |
212 | #endif /* !CONFIG_CPU_MIPSR2 || !CONFIG_CPU_MIPSR6 */ | |
213 | ||
214 | /* | |
215 | * Temporary until all gas have MT ASE support | |
216 | */ | |
217 | .macro DMT reg=0 | |
218 | .word 0x41600bc1 | (\reg << 16) | |
219 | .endm | |
220 | ||
221 | .macro EMT reg=0 | |
222 | .word 0x41600be1 | (\reg << 16) | |
223 | .endm | |
224 | ||
225 | .macro DVPE reg=0 | |
226 | .word 0x41600001 | (\reg << 16) | |
227 | .endm | |
228 | ||
229 | .macro EVPE reg=0 | |
230 | .word 0x41600021 | (\reg << 16) | |
231 | .endm | |
232 | ||
233 | .macro MFTR rt=0, rd=0, u=0, sel=0 | |
234 | .word 0x41000000 | (\rt << 16) | (\rd << 11) | (\u << 5) | (\sel) | |
235 | .endm | |
236 | ||
237 | .macro MTTR rt=0, rd=0, u=0, sel=0 | |
238 | .word 0x41800000 | (\rt << 16) | (\rd << 11) | (\u << 5) | (\sel) | |
239 | .endm | |
240 | ||
241 | #ifdef TOOLCHAIN_SUPPORTS_MSA | |
242 | .macro _cfcmsa rd, cs | |
243 | .set push | |
244 | .set mips32r2 | |
245 | .set fp=64 | |
246 | .set msa | |
247 | cfcmsa \rd, $\cs | |
248 | .set pop | |
249 | .endm | |
250 | ||
251 | .macro _ctcmsa cd, rs | |
252 | .set push | |
253 | .set mips32r2 | |
254 | .set fp=64 | |
255 | .set msa | |
256 | ctcmsa $\cd, \rs | |
257 | .set pop | |
258 | .endm | |
259 | ||
260 | .macro ld_b wd, off, base | |
261 | .set push | |
262 | .set mips32r2 | |
263 | .set fp=64 | |
264 | .set msa | |
265 | ld.b $w\wd, \off(\base) | |
266 | .set pop | |
267 | .endm | |
268 | ||
269 | .macro ld_h wd, off, base | |
270 | .set push | |
271 | .set mips32r2 | |
272 | .set fp=64 | |
273 | .set msa | |
274 | ld.h $w\wd, \off(\base) | |
275 | .set pop | |
276 | .endm | |
277 | ||
278 | .macro ld_w wd, off, base | |
279 | .set push | |
280 | .set mips32r2 | |
281 | .set fp=64 | |
282 | .set msa | |
283 | ld.w $w\wd, \off(\base) | |
284 | .set pop | |
285 | .endm | |
286 | ||
287 | .macro ld_d wd, off, base | |
288 | .set push | |
289 | .set mips32r2 | |
290 | .set fp=64 | |
291 | .set msa | |
292 | ld.d $w\wd, \off(\base) | |
293 | .set pop | |
294 | .endm | |
295 | ||
296 | .macro st_b wd, off, base | |
297 | .set push | |
298 | .set mips32r2 | |
299 | .set fp=64 | |
300 | .set msa | |
301 | st.b $w\wd, \off(\base) | |
302 | .set pop | |
303 | .endm | |
304 | ||
305 | .macro st_h wd, off, base | |
306 | .set push | |
307 | .set mips32r2 | |
308 | .set fp=64 | |
309 | .set msa | |
310 | st.h $w\wd, \off(\base) | |
311 | .set pop | |
312 | .endm | |
313 | ||
314 | .macro st_w wd, off, base | |
315 | .set push | |
316 | .set mips32r2 | |
317 | .set fp=64 | |
318 | .set msa | |
319 | st.w $w\wd, \off(\base) | |
320 | .set pop | |
321 | .endm | |
322 | ||
323 | .macro st_d wd, off, base | |
324 | .set push | |
325 | .set mips32r2 | |
326 | .set fp=64 | |
327 | .set msa | |
328 | st.d $w\wd, \off(\base) | |
329 | .set pop | |
330 | .endm | |
331 | ||
332 | .macro copy_s_w ws, n | |
333 | .set push | |
334 | .set mips32r2 | |
335 | .set fp=64 | |
336 | .set msa | |
337 | copy_s.w $1, $w\ws[\n] | |
338 | .set pop | |
339 | .endm | |
340 | ||
341 | .macro copy_s_d ws, n | |
342 | .set push | |
343 | .set mips64r2 | |
344 | .set fp=64 | |
345 | .set msa | |
346 | copy_s.d $1, $w\ws[\n] | |
347 | .set pop | |
348 | .endm | |
349 | ||
350 | .macro insert_w wd, n | |
351 | .set push | |
352 | .set mips32r2 | |
353 | .set fp=64 | |
354 | .set msa | |
355 | insert.w $w\wd[\n], $1 | |
356 | .set pop | |
357 | .endm | |
358 | ||
359 | .macro insert_d wd, n | |
360 | .set push | |
361 | .set mips64r2 | |
362 | .set fp=64 | |
363 | .set msa | |
364 | insert.d $w\wd[\n], $1 | |
365 | .set pop | |
366 | .endm | |
367 | #else | |
368 | ||
369 | /* | |
370 | * Temporary until all toolchains in use include MSA support. | |
371 | */ | |
372 | .macro _cfcmsa rd, cs | |
373 | .set push | |
374 | .set noat | |
375 | SET_HARDFLOAT | |
376 | insn_if_mips 0x787e0059 | (\cs << 11) | |
377 | insn32_if_mm 0x587e0056 | (\cs << 11) | |
378 | move \rd, $1 | |
379 | .set pop | |
380 | .endm | |
381 | ||
382 | .macro _ctcmsa cd, rs | |
383 | .set push | |
384 | .set noat | |
385 | SET_HARDFLOAT | |
386 | move $1, \rs | |
387 | insn_if_mips 0x783e0819 | (\cd << 6) | |
388 | insn32_if_mm 0x583e0816 | (\cd << 6) | |
389 | .set pop | |
390 | .endm | |
391 | ||
392 | .macro ld_b wd, off, base | |
393 | .set push | |
394 | .set noat | |
395 | SET_HARDFLOAT | |
396 | PTR_ADDU $1, \base, \off | |
397 | insn_if_mips 0x78000820 | (\wd << 6) | |
398 | insn32_if_mm 0x58000807 | (\wd << 6) | |
399 | .set pop | |
400 | .endm | |
401 | ||
402 | .macro ld_h wd, off, base | |
403 | .set push | |
404 | .set noat | |
405 | SET_HARDFLOAT | |
406 | PTR_ADDU $1, \base, \off | |
407 | insn_if_mips 0x78000821 | (\wd << 6) | |
408 | insn32_if_mm 0x58000817 | (\wd << 6) | |
409 | .set pop | |
410 | .endm | |
411 | ||
412 | .macro ld_w wd, off, base | |
413 | .set push | |
414 | .set noat | |
415 | SET_HARDFLOAT | |
416 | PTR_ADDU $1, \base, \off | |
417 | insn_if_mips 0x78000822 | (\wd << 6) | |
418 | insn32_if_mm 0x58000827 | (\wd << 6) | |
419 | .set pop | |
420 | .endm | |
421 | ||
422 | .macro ld_d wd, off, base | |
423 | .set push | |
424 | .set noat | |
425 | SET_HARDFLOAT | |
426 | PTR_ADDU $1, \base, \off | |
427 | insn_if_mips 0x78000823 | (\wd << 6) | |
428 | insn32_if_mm 0x58000837 | (\wd << 6) | |
429 | .set pop | |
430 | .endm | |
431 | ||
432 | .macro st_b wd, off, base | |
433 | .set push | |
434 | .set noat | |
435 | SET_HARDFLOAT | |
436 | PTR_ADDU $1, \base, \off | |
437 | insn_if_mips 0x78000824 | (\wd << 6) | |
438 | insn32_if_mm 0x5800080f | (\wd << 6) | |
439 | .set pop | |
440 | .endm | |
441 | ||
442 | .macro st_h wd, off, base | |
443 | .set push | |
444 | .set noat | |
445 | SET_HARDFLOAT | |
446 | PTR_ADDU $1, \base, \off | |
447 | insn_if_mips 0x78000825 | (\wd << 6) | |
448 | insn32_if_mm 0x5800081f | (\wd << 6) | |
449 | .set pop | |
450 | .endm | |
451 | ||
452 | .macro st_w wd, off, base | |
453 | .set push | |
454 | .set noat | |
455 | SET_HARDFLOAT | |
456 | PTR_ADDU $1, \base, \off | |
457 | insn_if_mips 0x78000826 | (\wd << 6) | |
458 | insn32_if_mm 0x5800082f | (\wd << 6) | |
459 | .set pop | |
460 | .endm | |
461 | ||
462 | .macro st_d wd, off, base | |
463 | .set push | |
464 | .set noat | |
465 | SET_HARDFLOAT | |
466 | PTR_ADDU $1, \base, \off | |
467 | insn_if_mips 0x78000827 | (\wd << 6) | |
468 | insn32_if_mm 0x5800083f | (\wd << 6) | |
469 | .set pop | |
470 | .endm | |
471 | ||
472 | .macro copy_s_w ws, n | |
473 | .set push | |
474 | .set noat | |
475 | SET_HARDFLOAT | |
476 | insn_if_mips 0x78b00059 | (\n << 16) | (\ws << 11) | |
477 | insn32_if_mm 0x58b00056 | (\n << 16) | (\ws << 11) | |
478 | .set pop | |
479 | .endm | |
480 | ||
481 | .macro copy_s_d ws, n | |
482 | .set push | |
483 | .set noat | |
484 | SET_HARDFLOAT | |
485 | insn_if_mips 0x78b80059 | (\n << 16) | (\ws << 11) | |
486 | insn32_if_mm 0x58b80056 | (\n << 16) | (\ws << 11) | |
487 | .set pop | |
488 | .endm | |
489 | ||
490 | .macro insert_w wd, n | |
491 | .set push | |
492 | .set noat | |
493 | SET_HARDFLOAT | |
494 | insn_if_mips 0x79300819 | (\n << 16) | (\wd << 6) | |
495 | insn32_if_mm 0x59300816 | (\n << 16) | (\wd << 6) | |
496 | .set pop | |
497 | .endm | |
498 | ||
499 | .macro insert_d wd, n | |
500 | .set push | |
501 | .set noat | |
502 | SET_HARDFLOAT | |
503 | insn_if_mips 0x79380819 | (\n << 16) | (\wd << 6) | |
504 | insn32_if_mm 0x59380816 | (\n << 16) | (\wd << 6) | |
505 | .set pop | |
506 | .endm | |
507 | #endif | |
508 | ||
509 | #ifdef TOOLCHAIN_SUPPORTS_MSA | |
510 | #define FPR_BASE_OFFS THREAD_FPR0 | |
511 | #define FPR_BASE $1 | |
512 | #else | |
513 | #define FPR_BASE_OFFS 0 | |
514 | #define FPR_BASE \thread | |
515 | #endif | |
516 | ||
517 | .macro msa_save_all thread | |
518 | .set push | |
519 | .set noat | |
520 | #ifdef TOOLCHAIN_SUPPORTS_MSA | |
521 | PTR_ADDU FPR_BASE, \thread, FPR_BASE_OFFS | |
522 | #endif | |
523 | st_d 0, THREAD_FPR0 - FPR_BASE_OFFS, FPR_BASE | |
524 | st_d 1, THREAD_FPR1 - FPR_BASE_OFFS, FPR_BASE | |
525 | st_d 2, THREAD_FPR2 - FPR_BASE_OFFS, FPR_BASE | |
526 | st_d 3, THREAD_FPR3 - FPR_BASE_OFFS, FPR_BASE | |
527 | st_d 4, THREAD_FPR4 - FPR_BASE_OFFS, FPR_BASE | |
528 | st_d 5, THREAD_FPR5 - FPR_BASE_OFFS, FPR_BASE | |
529 | st_d 6, THREAD_FPR6 - FPR_BASE_OFFS, FPR_BASE | |
530 | st_d 7, THREAD_FPR7 - FPR_BASE_OFFS, FPR_BASE | |
531 | st_d 8, THREAD_FPR8 - FPR_BASE_OFFS, FPR_BASE | |
532 | st_d 9, THREAD_FPR9 - FPR_BASE_OFFS, FPR_BASE | |
533 | st_d 10, THREAD_FPR10 - FPR_BASE_OFFS, FPR_BASE | |
534 | st_d 11, THREAD_FPR11 - FPR_BASE_OFFS, FPR_BASE | |
535 | st_d 12, THREAD_FPR12 - FPR_BASE_OFFS, FPR_BASE | |
536 | st_d 13, THREAD_FPR13 - FPR_BASE_OFFS, FPR_BASE | |
537 | st_d 14, THREAD_FPR14 - FPR_BASE_OFFS, FPR_BASE | |
538 | st_d 15, THREAD_FPR15 - FPR_BASE_OFFS, FPR_BASE | |
539 | st_d 16, THREAD_FPR16 - FPR_BASE_OFFS, FPR_BASE | |
540 | st_d 17, THREAD_FPR17 - FPR_BASE_OFFS, FPR_BASE | |
541 | st_d 18, THREAD_FPR18 - FPR_BASE_OFFS, FPR_BASE | |
542 | st_d 19, THREAD_FPR19 - FPR_BASE_OFFS, FPR_BASE | |
543 | st_d 20, THREAD_FPR20 - FPR_BASE_OFFS, FPR_BASE | |
544 | st_d 21, THREAD_FPR21 - FPR_BASE_OFFS, FPR_BASE | |
545 | st_d 22, THREAD_FPR22 - FPR_BASE_OFFS, FPR_BASE | |
546 | st_d 23, THREAD_FPR23 - FPR_BASE_OFFS, FPR_BASE | |
547 | st_d 24, THREAD_FPR24 - FPR_BASE_OFFS, FPR_BASE | |
548 | st_d 25, THREAD_FPR25 - FPR_BASE_OFFS, FPR_BASE | |
549 | st_d 26, THREAD_FPR26 - FPR_BASE_OFFS, FPR_BASE | |
550 | st_d 27, THREAD_FPR27 - FPR_BASE_OFFS, FPR_BASE | |
551 | st_d 28, THREAD_FPR28 - FPR_BASE_OFFS, FPR_BASE | |
552 | st_d 29, THREAD_FPR29 - FPR_BASE_OFFS, FPR_BASE | |
553 | st_d 30, THREAD_FPR30 - FPR_BASE_OFFS, FPR_BASE | |
554 | st_d 31, THREAD_FPR31 - FPR_BASE_OFFS, FPR_BASE | |
555 | SET_HARDFLOAT | |
556 | _cfcmsa $1, MSA_CSR | |
557 | sw $1, THREAD_MSA_CSR(\thread) | |
558 | .set pop | |
559 | .endm | |
560 | ||
561 | .macro msa_restore_all thread | |
562 | .set push | |
563 | .set noat | |
564 | SET_HARDFLOAT | |
565 | lw $1, THREAD_MSA_CSR(\thread) | |
566 | _ctcmsa MSA_CSR, $1 | |
567 | #ifdef TOOLCHAIN_SUPPORTS_MSA | |
568 | PTR_ADDU FPR_BASE, \thread, FPR_BASE_OFFS | |
569 | #endif | |
570 | ld_d 0, THREAD_FPR0 - FPR_BASE_OFFS, FPR_BASE | |
571 | ld_d 1, THREAD_FPR1 - FPR_BASE_OFFS, FPR_BASE | |
572 | ld_d 2, THREAD_FPR2 - FPR_BASE_OFFS, FPR_BASE | |
573 | ld_d 3, THREAD_FPR3 - FPR_BASE_OFFS, FPR_BASE | |
574 | ld_d 4, THREAD_FPR4 - FPR_BASE_OFFS, FPR_BASE | |
575 | ld_d 5, THREAD_FPR5 - FPR_BASE_OFFS, FPR_BASE | |
576 | ld_d 6, THREAD_FPR6 - FPR_BASE_OFFS, FPR_BASE | |
577 | ld_d 7, THREAD_FPR7 - FPR_BASE_OFFS, FPR_BASE | |
578 | ld_d 8, THREAD_FPR8 - FPR_BASE_OFFS, FPR_BASE | |
579 | ld_d 9, THREAD_FPR9 - FPR_BASE_OFFS, FPR_BASE | |
580 | ld_d 10, THREAD_FPR10 - FPR_BASE_OFFS, FPR_BASE | |
581 | ld_d 11, THREAD_FPR11 - FPR_BASE_OFFS, FPR_BASE | |
582 | ld_d 12, THREAD_FPR12 - FPR_BASE_OFFS, FPR_BASE | |
583 | ld_d 13, THREAD_FPR13 - FPR_BASE_OFFS, FPR_BASE | |
584 | ld_d 14, THREAD_FPR14 - FPR_BASE_OFFS, FPR_BASE | |
585 | ld_d 15, THREAD_FPR15 - FPR_BASE_OFFS, FPR_BASE | |
586 | ld_d 16, THREAD_FPR16 - FPR_BASE_OFFS, FPR_BASE | |
587 | ld_d 17, THREAD_FPR17 - FPR_BASE_OFFS, FPR_BASE | |
588 | ld_d 18, THREAD_FPR18 - FPR_BASE_OFFS, FPR_BASE | |
589 | ld_d 19, THREAD_FPR19 - FPR_BASE_OFFS, FPR_BASE | |
590 | ld_d 20, THREAD_FPR20 - FPR_BASE_OFFS, FPR_BASE | |
591 | ld_d 21, THREAD_FPR21 - FPR_BASE_OFFS, FPR_BASE | |
592 | ld_d 22, THREAD_FPR22 - FPR_BASE_OFFS, FPR_BASE | |
593 | ld_d 23, THREAD_FPR23 - FPR_BASE_OFFS, FPR_BASE | |
594 | ld_d 24, THREAD_FPR24 - FPR_BASE_OFFS, FPR_BASE | |
595 | ld_d 25, THREAD_FPR25 - FPR_BASE_OFFS, FPR_BASE | |
596 | ld_d 26, THREAD_FPR26 - FPR_BASE_OFFS, FPR_BASE | |
597 | ld_d 27, THREAD_FPR27 - FPR_BASE_OFFS, FPR_BASE | |
598 | ld_d 28, THREAD_FPR28 - FPR_BASE_OFFS, FPR_BASE | |
599 | ld_d 29, THREAD_FPR29 - FPR_BASE_OFFS, FPR_BASE | |
600 | ld_d 30, THREAD_FPR30 - FPR_BASE_OFFS, FPR_BASE | |
601 | ld_d 31, THREAD_FPR31 - FPR_BASE_OFFS, FPR_BASE | |
602 | .set pop | |
603 | .endm | |
604 | ||
605 | #undef FPR_BASE_OFFS | |
606 | #undef FPR_BASE | |
607 | ||
608 | .macro msa_init_upper wd | |
609 | #ifdef CONFIG_64BIT | |
610 | insert_d \wd, 1 | |
611 | #else | |
612 | insert_w \wd, 2 | |
613 | insert_w \wd, 3 | |
614 | #endif | |
615 | .endm | |
616 | ||
617 | .macro msa_init_all_upper | |
618 | .set push | |
619 | .set noat | |
620 | SET_HARDFLOAT | |
621 | not $1, zero | |
622 | msa_init_upper 0 | |
623 | msa_init_upper 1 | |
624 | msa_init_upper 2 | |
625 | msa_init_upper 3 | |
626 | msa_init_upper 4 | |
627 | msa_init_upper 5 | |
628 | msa_init_upper 6 | |
629 | msa_init_upper 7 | |
630 | msa_init_upper 8 | |
631 | msa_init_upper 9 | |
632 | msa_init_upper 10 | |
633 | msa_init_upper 11 | |
634 | msa_init_upper 12 | |
635 | msa_init_upper 13 | |
636 | msa_init_upper 14 | |
637 | msa_init_upper 15 | |
638 | msa_init_upper 16 | |
639 | msa_init_upper 17 | |
640 | msa_init_upper 18 | |
641 | msa_init_upper 19 | |
642 | msa_init_upper 20 | |
643 | msa_init_upper 21 | |
644 | msa_init_upper 22 | |
645 | msa_init_upper 23 | |
646 | msa_init_upper 24 | |
647 | msa_init_upper 25 | |
648 | msa_init_upper 26 | |
649 | msa_init_upper 27 | |
650 | msa_init_upper 28 | |
651 | msa_init_upper 29 | |
652 | msa_init_upper 30 | |
653 | msa_init_upper 31 | |
654 | .set pop | |
655 | .endm | |
656 | ||
657 | #endif /* _ASM_ASMMACRO_H */ |