This source file includes following definitions.
- fnop
- fclex
- fpstate_init_soft
- finit
- finit_
- fstsw_ax
- fstsw_
- fp_nop
- fld_i_
- fxch_i
- fcmovCC
- fcmovb
- fcmove
- fcmovbe
- fcmovu
- fcmovnb
- fcmovne
- fcmovnbe
- fcmovnu
- ffree_
- ffreep
- fst_i_
- fstp_i
1
2
3
4
5
6
7
8
9
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
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;
41 soft->twd = 0xffff;
42
43
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(¤t->thread.fpu.state.soft);
57 }
58
59
60
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
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
123 FPU_stack_underflow();
124 } else
125 EXCEPTION(EX_StackUnder);
126 }
127
128 }
129
130 void fxch_i(void)
131 {
132
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
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
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
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
246 FPU_settagi(FPU_rm, TAG_Empty);
247 }
248
249 void ffreep(void)
250 {
251
252 FPU_settagi(FPU_rm, TAG_Empty);
253 FPU_pop();
254 }
255
256 void fst_i_(void)
257 {
258
259 FPU_copy_to_regi(&st(0), FPU_gettag0(), FPU_rm);
260 }
261
262 void fstp_i(void)
263 {
264
265 FPU_copy_to_regi(&st(0), FPU_gettag0(), FPU_rm);
266 FPU_pop();
267 }