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
19unsigned long
20alpha_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}
66EXPORT_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
74void
75alpha_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}
120EXPORT_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
128unsigned long
129alpha_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}
177EXPORT_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
185void
186alpha_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}
232EXPORT_SYMBOL(alpha_write_fp_reg_s);
233