xref: /openbmc/linux/arch/alpha/lib/fpreg.c (revision ad4455c6)
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