Commit | Line | Data |
---|---|---|
cfc5180e MZ |
1 | /* |
2 | * FP/SIMD state saving and restoring macros | |
3 | * | |
4 | * Copyright (C) 2012 ARM Ltd. | |
5 | * Author: Catalin Marinas <catalin.marinas@arm.com> | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License version 2 as | |
9 | * published by the Free Software Foundation. | |
10 | * | |
11 | * This program is distributed in the hope that it will be useful, | |
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
14 | * GNU General Public License for more details. | |
15 | * | |
16 | * You should have received a copy of the GNU General Public License | |
17 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | |
18 | */ | |
19 | ||
20 | .macro fpsimd_save state, tmpnr | |
21 | stp q0, q1, [\state, #16 * 0] | |
22 | stp q2, q3, [\state, #16 * 2] | |
23 | stp q4, q5, [\state, #16 * 4] | |
24 | stp q6, q7, [\state, #16 * 6] | |
25 | stp q8, q9, [\state, #16 * 8] | |
26 | stp q10, q11, [\state, #16 * 10] | |
27 | stp q12, q13, [\state, #16 * 12] | |
28 | stp q14, q15, [\state, #16 * 14] | |
29 | stp q16, q17, [\state, #16 * 16] | |
30 | stp q18, q19, [\state, #16 * 18] | |
31 | stp q20, q21, [\state, #16 * 20] | |
32 | stp q22, q23, [\state, #16 * 22] | |
33 | stp q24, q25, [\state, #16 * 24] | |
34 | stp q26, q27, [\state, #16 * 26] | |
35 | stp q28, q29, [\state, #16 * 28] | |
36 | stp q30, q31, [\state, #16 * 30]! | |
37 | mrs x\tmpnr, fpsr | |
38 | str w\tmpnr, [\state, #16 * 2] | |
39 | mrs x\tmpnr, fpcr | |
40 | str w\tmpnr, [\state, #16 * 2 + 4] | |
41 | .endm | |
42 | ||
43 | .macro fpsimd_restore state, tmpnr | |
44 | ldp q0, q1, [\state, #16 * 0] | |
45 | ldp q2, q3, [\state, #16 * 2] | |
46 | ldp q4, q5, [\state, #16 * 4] | |
47 | ldp q6, q7, [\state, #16 * 6] | |
48 | ldp q8, q9, [\state, #16 * 8] | |
49 | ldp q10, q11, [\state, #16 * 10] | |
50 | ldp q12, q13, [\state, #16 * 12] | |
51 | ldp q14, q15, [\state, #16 * 14] | |
52 | ldp q16, q17, [\state, #16 * 16] | |
53 | ldp q18, q19, [\state, #16 * 18] | |
54 | ldp q20, q21, [\state, #16 * 20] | |
55 | ldp q22, q23, [\state, #16 * 22] | |
56 | ldp q24, q25, [\state, #16 * 24] | |
57 | ldp q26, q27, [\state, #16 * 26] | |
58 | ldp q28, q29, [\state, #16 * 28] | |
59 | ldp q30, q31, [\state, #16 * 30]! | |
60 | ldr w\tmpnr, [\state, #16 * 2] | |
61 | msr fpsr, x\tmpnr | |
62 | ldr w\tmpnr, [\state, #16 * 2 + 4] | |
63 | msr fpcr, x\tmpnr | |
64 | .endm | |
6fa3eb70 S |
65 | |
66 | .altmacro | |
67 | .macro fpsimd_save_partial state, numnr, tmpnr1, tmpnr2 | |
68 | mrs x\tmpnr1, fpsr | |
69 | str w\numnr, [\state, #8] | |
70 | mrs x\tmpnr2, fpcr | |
71 | stp w\tmpnr1, w\tmpnr2, [\state] | |
72 | adr x\tmpnr1, 0f | |
73 | add \state, \state, x\numnr, lsl #4 | |
74 | sub x\tmpnr1, x\tmpnr1, x\numnr, lsl #1 | |
75 | br x\tmpnr1 | |
76 | .irp qa, 30, 28, 26, 24, 22, 20, 18, 16, 14, 12, 10, 8, 6, 4, 2, 0 | |
77 | .irp qb, %(qa + 1) | |
78 | stp q\qa, q\qb, [\state, # -16 * \qa - 16] | |
79 | .endr | |
80 | .endr | |
81 | 0: | |
82 | .endm | |
83 | ||
84 | .macro fpsimd_restore_partial state, tmpnr1, tmpnr2 | |
85 | ldp w\tmpnr1, w\tmpnr2, [\state] | |
86 | msr fpsr, x\tmpnr1 | |
87 | msr fpcr, x\tmpnr2 | |
88 | adr x\tmpnr1, 0f | |
89 | ldr w\tmpnr2, [\state, #8] | |
90 | add \state, \state, x\tmpnr2, lsl #4 | |
91 | sub x\tmpnr1, x\tmpnr1, x\tmpnr2, lsl #1 | |
92 | br x\tmpnr1 | |
93 | .irp qa, 30, 28, 26, 24, 22, 20, 18, 16, 14, 12, 10, 8, 6, 4, 2, 0 | |
94 | .irp qb, %(qa + 1) | |
95 | ldp q\qa, q\qb, [\state, # -16 * \qa - 16] | |
96 | .endr | |
97 | .endr | |
98 | 0: | |
99 | .endm |