GNU Linux-libre 4.14.266-gnu1
[releases.git] / arch / x86 / math-emu / fpu_aux.c
1 // SPDX-License-Identifier: GPL-2.0
2 /*---------------------------------------------------------------------------+
3  |  fpu_aux.c                                                                |
4  |                                                                           |
5  | Code to implement some of the FPU auxiliary instructions.                 |
6  |                                                                           |
7  | Copyright (C) 1992,1993,1994,1997                                         |
8  |                  W. Metzenthen, 22 Parker St, Ormond, Vic 3163, Australia |
9  |                  E-mail   billm@suburbia.net                              |
10  |                                                                           |
11  |                                                                           |
12  +---------------------------------------------------------------------------*/
13
14 #include "fpu_system.h"
15 #include "exception.h"
16 #include "fpu_emu.h"
17 #include "status_w.h"
18 #include "control_w.h"
19
20 static void fnop(void)
21 {
22 }
23
24 static void fclex(void)
25 {
26         partial_status &=
27             ~(SW_Backward | SW_Summary | SW_Stack_Fault | SW_Precision |
28               SW_Underflow | SW_Overflow | SW_Zero_Div | SW_Denorm_Op |
29               SW_Invalid);
30         no_ip_update = 1;
31 }
32
33 /* Needs to be externally visible */
34 void fpstate_init_soft(struct swregs_state *soft)
35 {
36         struct address *oaddr, *iaddr;
37         memset(soft, 0, sizeof(*soft));
38         soft->cwd = 0x037f;
39         soft->swd = 0;
40         soft->ftop = 0; /* We don't keep top in the status word internally. */
41         soft->twd = 0xffff;
42         /* The behaviour is different from that detailed in
43            Section 15.1.6 of the Intel manual */
44         oaddr = (struct address *)&soft->foo;
45         oaddr->offset = 0;
46         oaddr->selector = 0;
47         iaddr = (struct address *)&soft->fip;
48         iaddr->offset = 0;
49         iaddr->selector = 0;
50         iaddr->opcode = 0;
51         soft->no_update = 1;
52 }
53
54 void finit(void)
55 {
56         fpstate_init_soft(&current->thread.fpu.state.soft);
57 }
58
59 /*
60  * These are nops on the i387..
61  */
62 #define feni fnop
63 #define fdisi fnop
64 #define fsetpm fnop
65
66 static FUNC const finit_table[] = {
67         feni, fdisi, fclex, finit,
68         fsetpm, FPU_illegal, FPU_illegal, FPU_illegal
69 };
70
71 void finit_(void)
72 {
73         (finit_table[FPU_rm]) ();
74 }
75
76 static void fstsw_ax(void)
77 {
78         *(short *)&FPU_EAX = status_word();
79         no_ip_update = 1;
80 }
81
82 static FUNC const fstsw_table[] = {
83         fstsw_ax, FPU_illegal, FPU_illegal, FPU_illegal,
84         FPU_illegal, FPU_illegal, FPU_illegal, FPU_illegal
85 };
86
87 void fstsw_(void)
88 {
89         (fstsw_table[FPU_rm]) ();
90 }
91
92 static FUNC const fp_nop_table[] = {
93         fnop, FPU_illegal, FPU_illegal, FPU_illegal,
94         FPU_illegal, FPU_illegal, FPU_illegal, FPU_illegal
95 };
96
97 void fp_nop(void)
98 {
99         (fp_nop_table[FPU_rm]) ();
100 }
101
102 void fld_i_(void)
103 {
104         FPU_REG *st_new_ptr;
105         int i;
106         u_char tag;
107
108         if (STACK_OVERFLOW) {
109                 FPU_stack_overflow();
110                 return;
111         }
112
113         /* fld st(i) */
114         i = FPU_rm;
115         if (NOT_EMPTY(i)) {
116                 reg_copy(&st(i), st_new_ptr);
117                 tag = FPU_gettagi(i);
118                 push();
119                 FPU_settag0(tag);
120         } else {
121                 if (control_word & CW_Invalid) {
122                         /* The masked response */
123                         FPU_stack_underflow();
124                 } else
125                         EXCEPTION(EX_StackUnder);
126         }
127
128 }
129
130 void fxch_i(void)
131 {
132         /* fxch st(i) */
133         FPU_REG t;
134         int i = FPU_rm;
135         FPU_REG *st0_ptr = &st(0), *sti_ptr = &st(i);
136         long tag_word = fpu_tag_word;
137         int regnr = top & 7, regnri = ((regnr + i) & 7);
138         u_char st0_tag = (tag_word >> (regnr * 2)) & 3;
139         u_char sti_tag = (tag_word >> (regnri * 2)) & 3;
140
141         if (st0_tag == TAG_Empty) {
142                 if (sti_tag == TAG_Empty) {
143                         FPU_stack_underflow();
144                         FPU_stack_underflow_i(i);
145                         return;
146                 }
147                 if (control_word & CW_Invalid) {
148                         /* Masked response */
149                         FPU_copy_to_reg0(sti_ptr, sti_tag);
150                 }
151                 FPU_stack_underflow_i(i);
152                 return;
153         }
154         if (sti_tag == TAG_Empty) {
155                 if (control_word & CW_Invalid) {
156                         /* Masked response */
157                         FPU_copy_to_regi(st0_ptr, st0_tag, i);
158                 }
159                 FPU_stack_underflow();
160                 return;
161         }
162         clear_C1();
163
164         reg_copy(st0_ptr, &t);
165         reg_copy(sti_ptr, st0_ptr);
166         reg_copy(&t, sti_ptr);
167
168         tag_word &= ~(3 << (regnr * 2)) & ~(3 << (regnri * 2));
169         tag_word |= (sti_tag << (regnr * 2)) | (st0_tag << (regnri * 2));
170         fpu_tag_word = tag_word;
171 }
172
173 static void fcmovCC(void)
174 {
175         /* fcmovCC st(i) */
176         int i = FPU_rm;
177         FPU_REG *st0_ptr = &st(0);
178         FPU_REG *sti_ptr = &st(i);
179         long tag_word = fpu_tag_word;
180         int regnr = top & 7;
181         int regnri = (top + i) & 7;
182         u_char sti_tag = (tag_word >> (regnri * 2)) & 3;
183
184         if (sti_tag == TAG_Empty) {
185                 FPU_stack_underflow();
186                 clear_C1();
187                 return;
188         }
189         reg_copy(sti_ptr, st0_ptr);
190         tag_word &= ~(3 << (regnr * 2));
191         tag_word |= (sti_tag << (regnr * 2));
192         fpu_tag_word = tag_word;
193 }
194
195 void fcmovb(void)
196 {
197         if (FPU_EFLAGS & X86_EFLAGS_CF)
198                 fcmovCC();
199 }
200
201 void fcmove(void)
202 {
203         if (FPU_EFLAGS & X86_EFLAGS_ZF)
204                 fcmovCC();
205 }
206
207 void fcmovbe(void)
208 {
209         if (FPU_EFLAGS & (X86_EFLAGS_CF|X86_EFLAGS_ZF))
210                 fcmovCC();
211 }
212
213 void fcmovu(void)
214 {
215         if (FPU_EFLAGS & X86_EFLAGS_PF)
216                 fcmovCC();
217 }
218
219 void fcmovnb(void)
220 {
221         if (!(FPU_EFLAGS & X86_EFLAGS_CF))
222                 fcmovCC();
223 }
224
225 void fcmovne(void)
226 {
227         if (!(FPU_EFLAGS & X86_EFLAGS_ZF))
228                 fcmovCC();
229 }
230
231 void fcmovnbe(void)
232 {
233         if (!(FPU_EFLAGS & (X86_EFLAGS_CF|X86_EFLAGS_ZF)))
234                 fcmovCC();
235 }
236
237 void fcmovnu(void)
238 {
239         if (!(FPU_EFLAGS & X86_EFLAGS_PF))
240                 fcmovCC();
241 }
242
243 void ffree_(void)
244 {
245         /* ffree st(i) */
246         FPU_settagi(FPU_rm, TAG_Empty);
247 }
248
249 void ffreep(void)
250 {
251         /* ffree st(i) + pop - unofficial code */
252         FPU_settagi(FPU_rm, TAG_Empty);
253         FPU_pop();
254 }
255
256 void fst_i_(void)
257 {
258         /* fst st(i) */
259         FPU_copy_to_regi(&st(0), FPU_gettag0(), FPU_rm);
260 }
261
262 void fstp_i(void)
263 {
264         /* fstp st(i) */
265         FPU_copy_to_regi(&st(0), FPU_gettag0(), FPU_rm);
266         FPU_pop();
267 }