1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* |
3 | * arch/alpha/lib/fpreg.c |
4 | * |
5 | * (C) Copyright 1998 Linus Torvalds |
6 | */ |
7 | |
8 | #include <linux/compiler.h> |
9 | #include <linux/export.h> |
10 | #include <linux/preempt.h> |
11 | #include <asm/thread_info.h> |
12 | |
13 | #if defined(CONFIG_ALPHA_EV6) || defined(CONFIG_ALPHA_EV67) |
14 | #define STT(reg,val) asm volatile ("ftoit $f"#reg",%0" : "=r"(val)); |
15 | #else |
16 | #define STT(reg,val) asm volatile ("stt $f"#reg",%0" : "=m"(val)); |
17 | #endif |
18 | |
19 | unsigned long |
20 | alpha_read_fp_reg (unsigned long reg) |
21 | { |
22 | unsigned long val; |
23 | |
24 | if (unlikely(reg >= 32)) |
25 | return 0; |
26 | preempt_disable(); |
27 | if (current_thread_info()->status & TS_SAVED_FP) |
28 | val = current_thread_info()->fp[reg]; |
29 | else switch (reg) { |
30 | case 0: STT( 0, val); break; |
31 | case 1: STT( 1, val); break; |
32 | case 2: STT( 2, val); break; |
33 | case 3: STT( 3, val); break; |
34 | case 4: STT( 4, val); break; |
35 | case 5: STT( 5, val); break; |
36 | case 6: STT( 6, val); break; |
37 | case 7: STT( 7, val); break; |
38 | case 8: STT( 8, val); break; |
39 | case 9: STT( 9, val); break; |
40 | case 10: STT(10, val); break; |
41 | case 11: STT(11, val); break; |
42 | case 12: STT(12, val); break; |
43 | case 13: STT(13, val); break; |
44 | case 14: STT(14, val); break; |
45 | case 15: STT(15, val); break; |
46 | case 16: STT(16, val); break; |
47 | case 17: STT(17, val); break; |
48 | case 18: STT(18, val); break; |
49 | case 19: STT(19, val); break; |
50 | case 20: STT(20, val); break; |
51 | case 21: STT(21, val); break; |
52 | case 22: STT(22, val); break; |
53 | case 23: STT(23, val); break; |
54 | case 24: STT(24, val); break; |
55 | case 25: STT(25, val); break; |
56 | case 26: STT(26, val); break; |
57 | case 27: STT(27, val); break; |
58 | case 28: STT(28, val); break; |
59 | case 29: STT(29, val); break; |
60 | case 30: STT(30, val); break; |
61 | case 31: STT(31, val); break; |
62 | } |
63 | preempt_enable(); |
64 | return val; |
65 | } |
66 | EXPORT_SYMBOL(alpha_read_fp_reg); |
67 | |
68 | #if defined(CONFIG_ALPHA_EV6) || defined(CONFIG_ALPHA_EV67) |
69 | #define LDT(reg,val) asm volatile ("itoft %0,$f"#reg : : "r"(val)); |
70 | #else |
71 | #define LDT(reg,val) asm volatile ("ldt $f"#reg",%0" : : "m"(val)); |
72 | #endif |
73 | |
74 | void |
75 | alpha_write_fp_reg (unsigned long reg, unsigned long val) |
76 | { |
77 | if (unlikely(reg >= 32)) |
78 | return; |
79 | |
80 | preempt_disable(); |
81 | if (current_thread_info()->status & TS_SAVED_FP) { |
82 | current_thread_info()->status |= TS_RESTORE_FP; |
83 | current_thread_info()->fp[reg] = val; |
84 | } else switch (reg) { |
85 | case 0: LDT( 0, val); break; |
86 | case 1: LDT( 1, val); break; |
87 | case 2: LDT( 2, val); break; |
88 | case 3: LDT( 3, val); break; |
89 | case 4: LDT( 4, val); break; |
90 | case 5: LDT( 5, val); break; |
91 | case 6: LDT( 6, val); break; |
92 | case 7: LDT( 7, val); break; |
93 | case 8: LDT( 8, val); break; |
94 | case 9: LDT( 9, val); break; |
95 | case 10: LDT(10, val); break; |
96 | case 11: LDT(11, val); break; |
97 | case 12: LDT(12, val); break; |
98 | case 13: LDT(13, val); break; |
99 | case 14: LDT(14, val); break; |
100 | case 15: LDT(15, val); break; |
101 | case 16: LDT(16, val); break; |
102 | case 17: LDT(17, val); break; |
103 | case 18: LDT(18, val); break; |
104 | case 19: LDT(19, val); break; |
105 | case 20: LDT(20, val); break; |
106 | case 21: LDT(21, val); break; |
107 | case 22: LDT(22, val); break; |
108 | case 23: LDT(23, val); break; |
109 | case 24: LDT(24, val); break; |
110 | case 25: LDT(25, val); break; |
111 | case 26: LDT(26, val); break; |
112 | case 27: LDT(27, val); break; |
113 | case 28: LDT(28, val); break; |
114 | case 29: LDT(29, val); break; |
115 | case 30: LDT(30, val); break; |
116 | case 31: LDT(31, val); break; |
117 | } |
118 | preempt_enable(); |
119 | } |
120 | EXPORT_SYMBOL(alpha_write_fp_reg); |
121 | |
122 | #if defined(CONFIG_ALPHA_EV6) || defined(CONFIG_ALPHA_EV67) |
123 | #define STS(reg,val) asm volatile ("ftois $f"#reg",%0" : "=r"(val)); |
124 | #else |
125 | #define STS(reg,val) asm volatile ("sts $f"#reg",%0" : "=m"(val)); |
126 | #endif |
127 | |
128 | unsigned long |
129 | alpha_read_fp_reg_s (unsigned long reg) |
130 | { |
131 | unsigned long val; |
132 | |
133 | if (unlikely(reg >= 32)) |
134 | return 0; |
135 | |
136 | preempt_disable(); |
137 | if (current_thread_info()->status & TS_SAVED_FP) { |
138 | LDT(0, current_thread_info()->fp[reg]); |
139 | STS(0, val); |
140 | } else switch (reg) { |
141 | case 0: STS( 0, val); break; |
142 | case 1: STS( 1, val); break; |
143 | case 2: STS( 2, val); break; |
144 | case 3: STS( 3, val); break; |
145 | case 4: STS( 4, val); break; |
146 | case 5: STS( 5, val); break; |
147 | case 6: STS( 6, val); break; |
148 | case 7: STS( 7, val); break; |
149 | case 8: STS( 8, val); break; |
150 | case 9: STS( 9, val); break; |
151 | case 10: STS(10, val); break; |
152 | case 11: STS(11, val); break; |
153 | case 12: STS(12, val); break; |
154 | case 13: STS(13, val); break; |
155 | case 14: STS(14, val); break; |
156 | case 15: STS(15, val); break; |
157 | case 16: STS(16, val); break; |
158 | case 17: STS(17, val); break; |
159 | case 18: STS(18, val); break; |
160 | case 19: STS(19, val); break; |
161 | case 20: STS(20, val); break; |
162 | case 21: STS(21, val); break; |
163 | case 22: STS(22, val); break; |
164 | case 23: STS(23, val); break; |
165 | case 24: STS(24, val); break; |
166 | case 25: STS(25, val); break; |
167 | case 26: STS(26, val); break; |
168 | case 27: STS(27, val); break; |
169 | case 28: STS(28, val); break; |
170 | case 29: STS(29, val); break; |
171 | case 30: STS(30, val); break; |
172 | case 31: STS(31, val); break; |
173 | } |
174 | preempt_enable(); |
175 | return val; |
176 | } |
177 | EXPORT_SYMBOL(alpha_read_fp_reg_s); |
178 | |
179 | #if defined(CONFIG_ALPHA_EV6) || defined(CONFIG_ALPHA_EV67) |
180 | #define LDS(reg,val) asm volatile ("itofs %0,$f"#reg : : "r"(val)); |
181 | #else |
182 | #define LDS(reg,val) asm volatile ("lds $f"#reg",%0" : : "m"(val)); |
183 | #endif |
184 | |
185 | void |
186 | alpha_write_fp_reg_s (unsigned long reg, unsigned long val) |
187 | { |
188 | if (unlikely(reg >= 32)) |
189 | return; |
190 | |
191 | preempt_disable(); |
192 | if (current_thread_info()->status & TS_SAVED_FP) { |
193 | current_thread_info()->status |= TS_RESTORE_FP; |
194 | LDS(0, val); |
195 | STT(0, current_thread_info()->fp[reg]); |
196 | } else switch (reg) { |
197 | case 0: LDS( 0, val); break; |
198 | case 1: LDS( 1, val); break; |
199 | case 2: LDS( 2, val); break; |
200 | case 3: LDS( 3, val); break; |
201 | case 4: LDS( 4, val); break; |
202 | case 5: LDS( 5, val); break; |
203 | case 6: LDS( 6, val); break; |
204 | case 7: LDS( 7, val); break; |
205 | case 8: LDS( 8, val); break; |
206 | case 9: LDS( 9, val); break; |
207 | case 10: LDS(10, val); break; |
208 | case 11: LDS(11, val); break; |
209 | case 12: LDS(12, val); break; |
210 | case 13: LDS(13, val); break; |
211 | case 14: LDS(14, val); break; |
212 | case 15: LDS(15, val); break; |
213 | case 16: LDS(16, val); break; |
214 | case 17: LDS(17, val); break; |
215 | case 18: LDS(18, val); break; |
216 | case 19: LDS(19, val); break; |
217 | case 20: LDS(20, val); break; |
218 | case 21: LDS(21, val); break; |
219 | case 22: LDS(22, val); break; |
220 | case 23: LDS(23, val); break; |
221 | case 24: LDS(24, val); break; |
222 | case 25: LDS(25, val); break; |
223 | case 26: LDS(26, val); break; |
224 | case 27: LDS(27, val); break; |
225 | case 28: LDS(28, val); break; |
226 | case 29: LDS(29, val); break; |
227 | case 30: LDS(30, val); break; |
228 | case 31: LDS(31, val); break; |
229 | } |
230 | preempt_enable(); |
231 | } |
232 | EXPORT_SYMBOL(alpha_write_fp_reg_s); |
233 | |