diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /arch/i386/math-emu/reg_ld_str.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'arch/i386/math-emu/reg_ld_str.c')
-rw-r--r-- | arch/i386/math-emu/reg_ld_str.c | 1370 |
1 files changed, 1370 insertions, 0 deletions
diff --git a/arch/i386/math-emu/reg_ld_str.c b/arch/i386/math-emu/reg_ld_str.c new file mode 100644 index 000000000000..f06ed41d191d --- /dev/null +++ b/arch/i386/math-emu/reg_ld_str.c | |||
@@ -0,0 +1,1370 @@ | |||
1 | /*---------------------------------------------------------------------------+ | ||
2 | | reg_ld_str.c | | ||
3 | | | | ||
4 | | All of the functions which transfer data between user memory and FPU_REGs.| | ||
5 | | | | ||
6 | | Copyright (C) 1992,1993,1994,1996,1997 | | ||
7 | | W. Metzenthen, 22 Parker St, Ormond, Vic 3163, Australia | | ||
8 | | E-mail billm@suburbia.net | | ||
9 | | | | ||
10 | | | | ||
11 | +---------------------------------------------------------------------------*/ | ||
12 | |||
13 | /*---------------------------------------------------------------------------+ | ||
14 | | Note: | | ||
15 | | The file contains code which accesses user memory. | | ||
16 | | Emulator static data may change when user memory is accessed, due to | | ||
17 | | other processes using the emulator while swapping is in progress. | | ||
18 | +---------------------------------------------------------------------------*/ | ||
19 | |||
20 | #include "fpu_emu.h" | ||
21 | |||
22 | #include <asm/uaccess.h> | ||
23 | |||
24 | #include "fpu_system.h" | ||
25 | #include "exception.h" | ||
26 | #include "reg_constant.h" | ||
27 | #include "control_w.h" | ||
28 | #include "status_w.h" | ||
29 | |||
30 | |||
31 | #define DOUBLE_Emax 1023 /* largest valid exponent */ | ||
32 | #define DOUBLE_Ebias 1023 | ||
33 | #define DOUBLE_Emin (-1022) /* smallest valid exponent */ | ||
34 | |||
35 | #define SINGLE_Emax 127 /* largest valid exponent */ | ||
36 | #define SINGLE_Ebias 127 | ||
37 | #define SINGLE_Emin (-126) /* smallest valid exponent */ | ||
38 | |||
39 | |||
40 | static u_char normalize_no_excep(FPU_REG *r, int exp, int sign) | ||
41 | { | ||
42 | u_char tag; | ||
43 | |||
44 | setexponent16(r, exp); | ||
45 | |||
46 | tag = FPU_normalize_nuo(r); | ||
47 | stdexp(r); | ||
48 | if ( sign ) | ||
49 | setnegative(r); | ||
50 | |||
51 | return tag; | ||
52 | } | ||
53 | |||
54 | |||
55 | int FPU_tagof(FPU_REG *ptr) | ||
56 | { | ||
57 | int exp; | ||
58 | |||
59 | exp = exponent16(ptr) & 0x7fff; | ||
60 | if ( exp == 0 ) | ||
61 | { | ||
62 | if ( !(ptr->sigh | ptr->sigl) ) | ||
63 | { | ||
64 | return TAG_Zero; | ||
65 | } | ||
66 | /* The number is a de-normal or pseudodenormal. */ | ||
67 | return TAG_Special; | ||
68 | } | ||
69 | |||
70 | if ( exp == 0x7fff ) | ||
71 | { | ||
72 | /* Is an Infinity, a NaN, or an unsupported data type. */ | ||
73 | return TAG_Special; | ||
74 | } | ||
75 | |||
76 | if ( !(ptr->sigh & 0x80000000) ) | ||
77 | { | ||
78 | /* Unsupported data type. */ | ||
79 | /* Valid numbers have the ms bit set to 1. */ | ||
80 | /* Unnormal. */ | ||
81 | return TAG_Special; | ||
82 | } | ||
83 | |||
84 | return TAG_Valid; | ||
85 | } | ||
86 | |||
87 | |||
88 | /* Get a long double from user memory */ | ||
89 | int FPU_load_extended(long double __user *s, int stnr) | ||
90 | { | ||
91 | FPU_REG *sti_ptr = &st(stnr); | ||
92 | |||
93 | RE_ENTRANT_CHECK_OFF; | ||
94 | FPU_access_ok(VERIFY_READ, s, 10); | ||
95 | __copy_from_user(sti_ptr, s, 10); | ||
96 | RE_ENTRANT_CHECK_ON; | ||
97 | |||
98 | return FPU_tagof(sti_ptr); | ||
99 | } | ||
100 | |||
101 | |||
102 | /* Get a double from user memory */ | ||
103 | int FPU_load_double(double __user *dfloat, FPU_REG *loaded_data) | ||
104 | { | ||
105 | int exp, tag, negative; | ||
106 | unsigned m64, l64; | ||
107 | |||
108 | RE_ENTRANT_CHECK_OFF; | ||
109 | FPU_access_ok(VERIFY_READ, dfloat, 8); | ||
110 | FPU_get_user(m64, 1 + (unsigned long __user *) dfloat); | ||
111 | FPU_get_user(l64, (unsigned long __user *) dfloat); | ||
112 | RE_ENTRANT_CHECK_ON; | ||
113 | |||
114 | negative = (m64 & 0x80000000) ? SIGN_Negative : SIGN_Positive; | ||
115 | exp = ((m64 & 0x7ff00000) >> 20) - DOUBLE_Ebias + EXTENDED_Ebias; | ||
116 | m64 &= 0xfffff; | ||
117 | if ( exp > DOUBLE_Emax + EXTENDED_Ebias ) | ||
118 | { | ||
119 | /* Infinity or NaN */ | ||
120 | if ((m64 == 0) && (l64 == 0)) | ||
121 | { | ||
122 | /* +- infinity */ | ||
123 | loaded_data->sigh = 0x80000000; | ||
124 | loaded_data->sigl = 0x00000000; | ||
125 | exp = EXP_Infinity + EXTENDED_Ebias; | ||
126 | tag = TAG_Special; | ||
127 | } | ||
128 | else | ||
129 | { | ||
130 | /* Must be a signaling or quiet NaN */ | ||
131 | exp = EXP_NaN + EXTENDED_Ebias; | ||
132 | loaded_data->sigh = (m64 << 11) | 0x80000000; | ||
133 | loaded_data->sigh |= l64 >> 21; | ||
134 | loaded_data->sigl = l64 << 11; | ||
135 | tag = TAG_Special; /* The calling function must look for NaNs */ | ||
136 | } | ||
137 | } | ||
138 | else if ( exp < DOUBLE_Emin + EXTENDED_Ebias ) | ||
139 | { | ||
140 | /* Zero or de-normal */ | ||
141 | if ((m64 == 0) && (l64 == 0)) | ||
142 | { | ||
143 | /* Zero */ | ||
144 | reg_copy(&CONST_Z, loaded_data); | ||
145 | exp = 0; | ||
146 | tag = TAG_Zero; | ||
147 | } | ||
148 | else | ||
149 | { | ||
150 | /* De-normal */ | ||
151 | loaded_data->sigh = m64 << 11; | ||
152 | loaded_data->sigh |= l64 >> 21; | ||
153 | loaded_data->sigl = l64 << 11; | ||
154 | |||
155 | return normalize_no_excep(loaded_data, DOUBLE_Emin, negative) | ||
156 | | (denormal_operand() < 0 ? FPU_Exception : 0); | ||
157 | } | ||
158 | } | ||
159 | else | ||
160 | { | ||
161 | loaded_data->sigh = (m64 << 11) | 0x80000000; | ||
162 | loaded_data->sigh |= l64 >> 21; | ||
163 | loaded_data->sigl = l64 << 11; | ||
164 | |||
165 | tag = TAG_Valid; | ||
166 | } | ||
167 | |||
168 | setexponent16(loaded_data, exp | negative); | ||
169 | |||
170 | return tag; | ||
171 | } | ||
172 | |||
173 | |||
174 | /* Get a float from user memory */ | ||
175 | int FPU_load_single(float __user *single, FPU_REG *loaded_data) | ||
176 | { | ||
177 | unsigned m32; | ||
178 | int exp, tag, negative; | ||
179 | |||
180 | RE_ENTRANT_CHECK_OFF; | ||
181 | FPU_access_ok(VERIFY_READ, single, 4); | ||
182 | FPU_get_user(m32, (unsigned long __user *) single); | ||
183 | RE_ENTRANT_CHECK_ON; | ||
184 | |||
185 | negative = (m32 & 0x80000000) ? SIGN_Negative : SIGN_Positive; | ||
186 | |||
187 | if (!(m32 & 0x7fffffff)) | ||
188 | { | ||
189 | /* Zero */ | ||
190 | reg_copy(&CONST_Z, loaded_data); | ||
191 | addexponent(loaded_data, negative); | ||
192 | return TAG_Zero; | ||
193 | } | ||
194 | exp = ((m32 & 0x7f800000) >> 23) - SINGLE_Ebias + EXTENDED_Ebias; | ||
195 | m32 = (m32 & 0x7fffff) << 8; | ||
196 | if ( exp < SINGLE_Emin + EXTENDED_Ebias ) | ||
197 | { | ||
198 | /* De-normals */ | ||
199 | loaded_data->sigh = m32; | ||
200 | loaded_data->sigl = 0; | ||
201 | |||
202 | return normalize_no_excep(loaded_data, SINGLE_Emin, negative) | ||
203 | | (denormal_operand() < 0 ? FPU_Exception : 0); | ||
204 | } | ||
205 | else if ( exp > SINGLE_Emax + EXTENDED_Ebias ) | ||
206 | { | ||
207 | /* Infinity or NaN */ | ||
208 | if ( m32 == 0 ) | ||
209 | { | ||
210 | /* +- infinity */ | ||
211 | loaded_data->sigh = 0x80000000; | ||
212 | loaded_data->sigl = 0x00000000; | ||
213 | exp = EXP_Infinity + EXTENDED_Ebias; | ||
214 | tag = TAG_Special; | ||
215 | } | ||
216 | else | ||
217 | { | ||
218 | /* Must be a signaling or quiet NaN */ | ||
219 | exp = EXP_NaN + EXTENDED_Ebias; | ||
220 | loaded_data->sigh = m32 | 0x80000000; | ||
221 | loaded_data->sigl = 0; | ||
222 | tag = TAG_Special; /* The calling function must look for NaNs */ | ||
223 | } | ||
224 | } | ||
225 | else | ||
226 | { | ||
227 | loaded_data->sigh = m32 | 0x80000000; | ||
228 | loaded_data->sigl = 0; | ||
229 | tag = TAG_Valid; | ||
230 | } | ||
231 | |||
232 | setexponent16(loaded_data, exp | negative); /* Set the sign. */ | ||
233 | |||
234 | return tag; | ||
235 | } | ||
236 | |||
237 | |||
238 | /* Get a long long from user memory */ | ||
239 | int FPU_load_int64(long long __user *_s) | ||
240 | { | ||
241 | long long s; | ||
242 | int sign; | ||
243 | FPU_REG *st0_ptr = &st(0); | ||
244 | |||
245 | RE_ENTRANT_CHECK_OFF; | ||
246 | FPU_access_ok(VERIFY_READ, _s, 8); | ||
247 | copy_from_user(&s,_s,8); | ||
248 | RE_ENTRANT_CHECK_ON; | ||
249 | |||
250 | if (s == 0) | ||
251 | { | ||
252 | reg_copy(&CONST_Z, st0_ptr); | ||
253 | return TAG_Zero; | ||
254 | } | ||
255 | |||
256 | if (s > 0) | ||
257 | sign = SIGN_Positive; | ||
258 | else | ||
259 | { | ||
260 | s = -s; | ||
261 | sign = SIGN_Negative; | ||
262 | } | ||
263 | |||
264 | significand(st0_ptr) = s; | ||
265 | |||
266 | return normalize_no_excep(st0_ptr, 63, sign); | ||
267 | } | ||
268 | |||
269 | |||
270 | /* Get a long from user memory */ | ||
271 | int FPU_load_int32(long __user *_s, FPU_REG *loaded_data) | ||
272 | { | ||
273 | long s; | ||
274 | int negative; | ||
275 | |||
276 | RE_ENTRANT_CHECK_OFF; | ||
277 | FPU_access_ok(VERIFY_READ, _s, 4); | ||
278 | FPU_get_user(s, _s); | ||
279 | RE_ENTRANT_CHECK_ON; | ||
280 | |||
281 | if (s == 0) | ||
282 | { reg_copy(&CONST_Z, loaded_data); return TAG_Zero; } | ||
283 | |||
284 | if (s > 0) | ||
285 | negative = SIGN_Positive; | ||
286 | else | ||
287 | { | ||
288 | s = -s; | ||
289 | negative = SIGN_Negative; | ||
290 | } | ||
291 | |||
292 | loaded_data->sigh = s; | ||
293 | loaded_data->sigl = 0; | ||
294 | |||
295 | return normalize_no_excep(loaded_data, 31, negative); | ||
296 | } | ||
297 | |||
298 | |||
299 | /* Get a short from user memory */ | ||
300 | int FPU_load_int16(short __user *_s, FPU_REG *loaded_data) | ||
301 | { | ||
302 | int s, negative; | ||
303 | |||
304 | RE_ENTRANT_CHECK_OFF; | ||
305 | FPU_access_ok(VERIFY_READ, _s, 2); | ||
306 | /* Cast as short to get the sign extended. */ | ||
307 | FPU_get_user(s, _s); | ||
308 | RE_ENTRANT_CHECK_ON; | ||
309 | |||
310 | if (s == 0) | ||
311 | { reg_copy(&CONST_Z, loaded_data); return TAG_Zero; } | ||
312 | |||
313 | if (s > 0) | ||
314 | negative = SIGN_Positive; | ||
315 | else | ||
316 | { | ||
317 | s = -s; | ||
318 | negative = SIGN_Negative; | ||
319 | } | ||
320 | |||
321 | loaded_data->sigh = s << 16; | ||
322 | loaded_data->sigl = 0; | ||
323 | |||
324 | return normalize_no_excep(loaded_data, 15, negative); | ||
325 | } | ||
326 | |||
327 | |||
328 | /* Get a packed bcd array from user memory */ | ||
329 | int FPU_load_bcd(u_char __user *s) | ||
330 | { | ||
331 | FPU_REG *st0_ptr = &st(0); | ||
332 | int pos; | ||
333 | u_char bcd; | ||
334 | long long l=0; | ||
335 | int sign; | ||
336 | |||
337 | RE_ENTRANT_CHECK_OFF; | ||
338 | FPU_access_ok(VERIFY_READ, s, 10); | ||
339 | RE_ENTRANT_CHECK_ON; | ||
340 | for ( pos = 8; pos >= 0; pos--) | ||
341 | { | ||
342 | l *= 10; | ||
343 | RE_ENTRANT_CHECK_OFF; | ||
344 | FPU_get_user(bcd, s+pos); | ||
345 | RE_ENTRANT_CHECK_ON; | ||
346 | l += bcd >> 4; | ||
347 | l *= 10; | ||
348 | l += bcd & 0x0f; | ||
349 | } | ||
350 | |||
351 | RE_ENTRANT_CHECK_OFF; | ||
352 | FPU_get_user(sign, s+9); | ||
353 | sign = sign & 0x80 ? SIGN_Negative : SIGN_Positive; | ||
354 | RE_ENTRANT_CHECK_ON; | ||
355 | |||
356 | if ( l == 0 ) | ||
357 | { | ||
358 | reg_copy(&CONST_Z, st0_ptr); | ||
359 | addexponent(st0_ptr, sign); /* Set the sign. */ | ||
360 | return TAG_Zero; | ||
361 | } | ||
362 | else | ||
363 | { | ||
364 | significand(st0_ptr) = l; | ||
365 | return normalize_no_excep(st0_ptr, 63, sign); | ||
366 | } | ||
367 | } | ||
368 | |||
369 | /*===========================================================================*/ | ||
370 | |||
371 | /* Put a long double into user memory */ | ||
372 | int FPU_store_extended(FPU_REG *st0_ptr, u_char st0_tag, long double __user *d) | ||
373 | { | ||
374 | /* | ||
375 | The only exception raised by an attempt to store to an | ||
376 | extended format is the Invalid Stack exception, i.e. | ||
377 | attempting to store from an empty register. | ||
378 | */ | ||
379 | |||
380 | if ( st0_tag != TAG_Empty ) | ||
381 | { | ||
382 | RE_ENTRANT_CHECK_OFF; | ||
383 | FPU_access_ok(VERIFY_WRITE, d, 10); | ||
384 | |||
385 | FPU_put_user(st0_ptr->sigl, (unsigned long __user *) d); | ||
386 | FPU_put_user(st0_ptr->sigh, (unsigned long __user *) ((u_char __user *)d + 4)); | ||
387 | FPU_put_user(exponent16(st0_ptr), (unsigned short __user *) ((u_char __user *)d + 8)); | ||
388 | RE_ENTRANT_CHECK_ON; | ||
389 | |||
390 | return 1; | ||
391 | } | ||
392 | |||
393 | /* Empty register (stack underflow) */ | ||
394 | EXCEPTION(EX_StackUnder); | ||
395 | if ( control_word & CW_Invalid ) | ||
396 | { | ||
397 | /* The masked response */ | ||
398 | /* Put out the QNaN indefinite */ | ||
399 | RE_ENTRANT_CHECK_OFF; | ||
400 | FPU_access_ok(VERIFY_WRITE,d,10); | ||
401 | FPU_put_user(0, (unsigned long __user *) d); | ||
402 | FPU_put_user(0xc0000000, 1 + (unsigned long __user *) d); | ||
403 | FPU_put_user(0xffff, 4 + (short __user *) d); | ||
404 | RE_ENTRANT_CHECK_ON; | ||
405 | return 1; | ||
406 | } | ||
407 | else | ||
408 | return 0; | ||
409 | |||
410 | } | ||
411 | |||
412 | |||
413 | /* Put a double into user memory */ | ||
414 | int FPU_store_double(FPU_REG *st0_ptr, u_char st0_tag, double __user *dfloat) | ||
415 | { | ||
416 | unsigned long l[2]; | ||
417 | unsigned long increment = 0; /* avoid gcc warnings */ | ||
418 | int precision_loss; | ||
419 | int exp; | ||
420 | FPU_REG tmp; | ||
421 | |||
422 | if ( st0_tag == TAG_Valid ) | ||
423 | { | ||
424 | reg_copy(st0_ptr, &tmp); | ||
425 | exp = exponent(&tmp); | ||
426 | |||
427 | if ( exp < DOUBLE_Emin ) /* It may be a denormal */ | ||
428 | { | ||
429 | addexponent(&tmp, -DOUBLE_Emin + 52); /* largest exp to be 51 */ | ||
430 | |||
431 | denormal_arg: | ||
432 | |||
433 | if ( (precision_loss = FPU_round_to_int(&tmp, st0_tag)) ) | ||
434 | { | ||
435 | #ifdef PECULIAR_486 | ||
436 | /* Did it round to a non-denormal ? */ | ||
437 | /* This behaviour might be regarded as peculiar, it appears | ||
438 | that the 80486 rounds to the dest precision, then | ||
439 | converts to decide underflow. */ | ||
440 | if ( !((tmp.sigh == 0x00100000) && (tmp.sigl == 0) && | ||
441 | (st0_ptr->sigl & 0x000007ff)) ) | ||
442 | #endif /* PECULIAR_486 */ | ||
443 | { | ||
444 | EXCEPTION(EX_Underflow); | ||
445 | /* This is a special case: see sec 16.2.5.1 of | ||
446 | the 80486 book */ | ||
447 | if ( !(control_word & CW_Underflow) ) | ||
448 | return 0; | ||
449 | } | ||
450 | EXCEPTION(precision_loss); | ||
451 | if ( !(control_word & CW_Precision) ) | ||
452 | return 0; | ||
453 | } | ||
454 | l[0] = tmp.sigl; | ||
455 | l[1] = tmp.sigh; | ||
456 | } | ||
457 | else | ||
458 | { | ||
459 | if ( tmp.sigl & 0x000007ff ) | ||
460 | { | ||
461 | precision_loss = 1; | ||
462 | switch (control_word & CW_RC) | ||
463 | { | ||
464 | case RC_RND: | ||
465 | /* Rounding can get a little messy.. */ | ||
466 | increment = ((tmp.sigl & 0x7ff) > 0x400) | /* nearest */ | ||
467 | ((tmp.sigl & 0xc00) == 0xc00); /* odd -> even */ | ||
468 | break; | ||
469 | case RC_DOWN: /* towards -infinity */ | ||
470 | increment = signpositive(&tmp) ? 0 : tmp.sigl & 0x7ff; | ||
471 | break; | ||
472 | case RC_UP: /* towards +infinity */ | ||
473 | increment = signpositive(&tmp) ? tmp.sigl & 0x7ff : 0; | ||
474 | break; | ||
475 | case RC_CHOP: | ||
476 | increment = 0; | ||
477 | break; | ||
478 | } | ||
479 | |||
480 | /* Truncate the mantissa */ | ||
481 | tmp.sigl &= 0xfffff800; | ||
482 | |||
483 | if ( increment ) | ||
484 | { | ||
485 | if ( tmp.sigl >= 0xfffff800 ) | ||
486 | { | ||
487 | /* the sigl part overflows */ | ||
488 | if ( tmp.sigh == 0xffffffff ) | ||
489 | { | ||
490 | /* The sigh part overflows */ | ||
491 | tmp.sigh = 0x80000000; | ||
492 | exp++; | ||
493 | if (exp >= EXP_OVER) | ||
494 | goto overflow; | ||
495 | } | ||
496 | else | ||
497 | { | ||
498 | tmp.sigh ++; | ||
499 | } | ||
500 | tmp.sigl = 0x00000000; | ||
501 | } | ||
502 | else | ||
503 | { | ||
504 | /* We only need to increment sigl */ | ||
505 | tmp.sigl += 0x00000800; | ||
506 | } | ||
507 | } | ||
508 | } | ||
509 | else | ||
510 | precision_loss = 0; | ||
511 | |||
512 | l[0] = (tmp.sigl >> 11) | (tmp.sigh << 21); | ||
513 | l[1] = ((tmp.sigh >> 11) & 0xfffff); | ||
514 | |||
515 | if ( exp > DOUBLE_Emax ) | ||
516 | { | ||
517 | overflow: | ||
518 | EXCEPTION(EX_Overflow); | ||
519 | if ( !(control_word & CW_Overflow) ) | ||
520 | return 0; | ||
521 | set_precision_flag_up(); | ||
522 | if ( !(control_word & CW_Precision) ) | ||
523 | return 0; | ||
524 | |||
525 | /* This is a special case: see sec 16.2.5.1 of the 80486 book */ | ||
526 | /* Overflow to infinity */ | ||
527 | l[0] = 0x00000000; /* Set to */ | ||
528 | l[1] = 0x7ff00000; /* + INF */ | ||
529 | } | ||
530 | else | ||
531 | { | ||
532 | if ( precision_loss ) | ||
533 | { | ||
534 | if ( increment ) | ||
535 | set_precision_flag_up(); | ||
536 | else | ||
537 | set_precision_flag_down(); | ||
538 | } | ||
539 | /* Add the exponent */ | ||
540 | l[1] |= (((exp+DOUBLE_Ebias) & 0x7ff) << 20); | ||
541 | } | ||
542 | } | ||
543 | } | ||
544 | else if (st0_tag == TAG_Zero) | ||
545 | { | ||
546 | /* Number is zero */ | ||
547 | l[0] = 0; | ||
548 | l[1] = 0; | ||
549 | } | ||
550 | else if ( st0_tag == TAG_Special ) | ||
551 | { | ||
552 | st0_tag = FPU_Special(st0_ptr); | ||
553 | if ( st0_tag == TW_Denormal ) | ||
554 | { | ||
555 | /* A denormal will always underflow. */ | ||
556 | #ifndef PECULIAR_486 | ||
557 | /* An 80486 is supposed to be able to generate | ||
558 | a denormal exception here, but... */ | ||
559 | /* Underflow has priority. */ | ||
560 | if ( control_word & CW_Underflow ) | ||
561 | denormal_operand(); | ||
562 | #endif /* PECULIAR_486 */ | ||
563 | reg_copy(st0_ptr, &tmp); | ||
564 | goto denormal_arg; | ||
565 | } | ||
566 | else if (st0_tag == TW_Infinity) | ||
567 | { | ||
568 | l[0] = 0; | ||
569 | l[1] = 0x7ff00000; | ||
570 | } | ||
571 | else if (st0_tag == TW_NaN) | ||
572 | { | ||
573 | /* Is it really a NaN ? */ | ||
574 | if ( (exponent(st0_ptr) == EXP_OVER) | ||
575 | && (st0_ptr->sigh & 0x80000000) ) | ||
576 | { | ||
577 | /* See if we can get a valid NaN from the FPU_REG */ | ||
578 | l[0] = (st0_ptr->sigl >> 11) | (st0_ptr->sigh << 21); | ||
579 | l[1] = ((st0_ptr->sigh >> 11) & 0xfffff); | ||
580 | if ( !(st0_ptr->sigh & 0x40000000) ) | ||
581 | { | ||
582 | /* It is a signalling NaN */ | ||
583 | EXCEPTION(EX_Invalid); | ||
584 | if ( !(control_word & CW_Invalid) ) | ||
585 | return 0; | ||
586 | l[1] |= (0x40000000 >> 11); | ||
587 | } | ||
588 | l[1] |= 0x7ff00000; | ||
589 | } | ||
590 | else | ||
591 | { | ||
592 | /* It is an unsupported data type */ | ||
593 | EXCEPTION(EX_Invalid); | ||
594 | if ( !(control_word & CW_Invalid) ) | ||
595 | return 0; | ||
596 | l[0] = 0; | ||
597 | l[1] = 0xfff80000; | ||
598 | } | ||
599 | } | ||
600 | } | ||
601 | else if ( st0_tag == TAG_Empty ) | ||
602 | { | ||
603 | /* Empty register (stack underflow) */ | ||
604 | EXCEPTION(EX_StackUnder); | ||
605 | if ( control_word & CW_Invalid ) | ||
606 | { | ||
607 | /* The masked response */ | ||
608 | /* Put out the QNaN indefinite */ | ||
609 | RE_ENTRANT_CHECK_OFF; | ||
610 | FPU_access_ok(VERIFY_WRITE,dfloat,8); | ||
611 | FPU_put_user(0, (unsigned long __user *) dfloat); | ||
612 | FPU_put_user(0xfff80000, 1 + (unsigned long __user *) dfloat); | ||
613 | RE_ENTRANT_CHECK_ON; | ||
614 | return 1; | ||
615 | } | ||
616 | else | ||
617 | return 0; | ||
618 | } | ||
619 | if ( getsign(st0_ptr) ) | ||
620 | l[1] |= 0x80000000; | ||
621 | |||
622 | RE_ENTRANT_CHECK_OFF; | ||
623 | FPU_access_ok(VERIFY_WRITE,dfloat,8); | ||
624 | FPU_put_user(l[0], (unsigned long __user *)dfloat); | ||
625 | FPU_put_user(l[1], 1 + (unsigned long __user *)dfloat); | ||
626 | RE_ENTRANT_CHECK_ON; | ||
627 | |||
628 | return 1; | ||
629 | } | ||
630 | |||
631 | |||
632 | /* Put a float into user memory */ | ||
633 | int FPU_store_single(FPU_REG *st0_ptr, u_char st0_tag, float __user *single) | ||
634 | { | ||
635 | long templ = 0; | ||
636 | unsigned long increment = 0; /* avoid gcc warnings */ | ||
637 | int precision_loss; | ||
638 | int exp; | ||
639 | FPU_REG tmp; | ||
640 | |||
641 | if ( st0_tag == TAG_Valid ) | ||
642 | { | ||
643 | |||
644 | reg_copy(st0_ptr, &tmp); | ||
645 | exp = exponent(&tmp); | ||
646 | |||
647 | if ( exp < SINGLE_Emin ) | ||
648 | { | ||
649 | addexponent(&tmp, -SINGLE_Emin + 23); /* largest exp to be 22 */ | ||
650 | |||
651 | denormal_arg: | ||
652 | |||
653 | if ( (precision_loss = FPU_round_to_int(&tmp, st0_tag)) ) | ||
654 | { | ||
655 | #ifdef PECULIAR_486 | ||
656 | /* Did it round to a non-denormal ? */ | ||
657 | /* This behaviour might be regarded as peculiar, it appears | ||
658 | that the 80486 rounds to the dest precision, then | ||
659 | converts to decide underflow. */ | ||
660 | if ( !((tmp.sigl == 0x00800000) && | ||
661 | ((st0_ptr->sigh & 0x000000ff) || st0_ptr->sigl)) ) | ||
662 | #endif /* PECULIAR_486 */ | ||
663 | { | ||
664 | EXCEPTION(EX_Underflow); | ||
665 | /* This is a special case: see sec 16.2.5.1 of | ||
666 | the 80486 book */ | ||
667 | if ( !(control_word & CW_Underflow) ) | ||
668 | return 0; | ||
669 | } | ||
670 | EXCEPTION(precision_loss); | ||
671 | if ( !(control_word & CW_Precision) ) | ||
672 | return 0; | ||
673 | } | ||
674 | templ = tmp.sigl; | ||
675 | } | ||
676 | else | ||
677 | { | ||
678 | if ( tmp.sigl | (tmp.sigh & 0x000000ff) ) | ||
679 | { | ||
680 | unsigned long sigh = tmp.sigh; | ||
681 | unsigned long sigl = tmp.sigl; | ||
682 | |||
683 | precision_loss = 1; | ||
684 | switch (control_word & CW_RC) | ||
685 | { | ||
686 | case RC_RND: | ||
687 | increment = ((sigh & 0xff) > 0x80) /* more than half */ | ||
688 | || (((sigh & 0xff) == 0x80) && sigl) /* more than half */ | ||
689 | || ((sigh & 0x180) == 0x180); /* round to even */ | ||
690 | break; | ||
691 | case RC_DOWN: /* towards -infinity */ | ||
692 | increment = signpositive(&tmp) | ||
693 | ? 0 : (sigl | (sigh & 0xff)); | ||
694 | break; | ||
695 | case RC_UP: /* towards +infinity */ | ||
696 | increment = signpositive(&tmp) | ||
697 | ? (sigl | (sigh & 0xff)) : 0; | ||
698 | break; | ||
699 | case RC_CHOP: | ||
700 | increment = 0; | ||
701 | break; | ||
702 | } | ||
703 | |||
704 | /* Truncate part of the mantissa */ | ||
705 | tmp.sigl = 0; | ||
706 | |||
707 | if (increment) | ||
708 | { | ||
709 | if ( sigh >= 0xffffff00 ) | ||
710 | { | ||
711 | /* The sigh part overflows */ | ||
712 | tmp.sigh = 0x80000000; | ||
713 | exp++; | ||
714 | if ( exp >= EXP_OVER ) | ||
715 | goto overflow; | ||
716 | } | ||
717 | else | ||
718 | { | ||
719 | tmp.sigh &= 0xffffff00; | ||
720 | tmp.sigh += 0x100; | ||
721 | } | ||
722 | } | ||
723 | else | ||
724 | { | ||
725 | tmp.sigh &= 0xffffff00; /* Finish the truncation */ | ||
726 | } | ||
727 | } | ||
728 | else | ||
729 | precision_loss = 0; | ||
730 | |||
731 | templ = (tmp.sigh >> 8) & 0x007fffff; | ||
732 | |||
733 | if ( exp > SINGLE_Emax ) | ||
734 | { | ||
735 | overflow: | ||
736 | EXCEPTION(EX_Overflow); | ||
737 | if ( !(control_word & CW_Overflow) ) | ||
738 | return 0; | ||
739 | set_precision_flag_up(); | ||
740 | if ( !(control_word & CW_Precision) ) | ||
741 | return 0; | ||
742 | |||
743 | /* This is a special case: see sec 16.2.5.1 of the 80486 book. */ | ||
744 | /* Masked response is overflow to infinity. */ | ||
745 | templ = 0x7f800000; | ||
746 | } | ||
747 | else | ||
748 | { | ||
749 | if ( precision_loss ) | ||
750 | { | ||
751 | if ( increment ) | ||
752 | set_precision_flag_up(); | ||
753 | else | ||
754 | set_precision_flag_down(); | ||
755 | } | ||
756 | /* Add the exponent */ | ||
757 | templ |= ((exp+SINGLE_Ebias) & 0xff) << 23; | ||
758 | } | ||
759 | } | ||
760 | } | ||
761 | else if (st0_tag == TAG_Zero) | ||
762 | { | ||
763 | templ = 0; | ||
764 | } | ||
765 | else if ( st0_tag == TAG_Special ) | ||
766 | { | ||
767 | st0_tag = FPU_Special(st0_ptr); | ||
768 | if (st0_tag == TW_Denormal) | ||
769 | { | ||
770 | reg_copy(st0_ptr, &tmp); | ||
771 | |||
772 | /* A denormal will always underflow. */ | ||
773 | #ifndef PECULIAR_486 | ||
774 | /* An 80486 is supposed to be able to generate | ||
775 | a denormal exception here, but... */ | ||
776 | /* Underflow has priority. */ | ||
777 | if ( control_word & CW_Underflow ) | ||
778 | denormal_operand(); | ||
779 | #endif /* PECULIAR_486 */ | ||
780 | goto denormal_arg; | ||
781 | } | ||
782 | else if (st0_tag == TW_Infinity) | ||
783 | { | ||
784 | templ = 0x7f800000; | ||
785 | } | ||
786 | else if (st0_tag == TW_NaN) | ||
787 | { | ||
788 | /* Is it really a NaN ? */ | ||
789 | if ( (exponent(st0_ptr) == EXP_OVER) && (st0_ptr->sigh & 0x80000000) ) | ||
790 | { | ||
791 | /* See if we can get a valid NaN from the FPU_REG */ | ||
792 | templ = st0_ptr->sigh >> 8; | ||
793 | if ( !(st0_ptr->sigh & 0x40000000) ) | ||
794 | { | ||
795 | /* It is a signalling NaN */ | ||
796 | EXCEPTION(EX_Invalid); | ||
797 | if ( !(control_word & CW_Invalid) ) | ||
798 | return 0; | ||
799 | templ |= (0x40000000 >> 8); | ||
800 | } | ||
801 | templ |= 0x7f800000; | ||
802 | } | ||
803 | else | ||
804 | { | ||
805 | /* It is an unsupported data type */ | ||
806 | EXCEPTION(EX_Invalid); | ||
807 | if ( !(control_word & CW_Invalid) ) | ||
808 | return 0; | ||
809 | templ = 0xffc00000; | ||
810 | } | ||
811 | } | ||
812 | #ifdef PARANOID | ||
813 | else | ||
814 | { | ||
815 | EXCEPTION(EX_INTERNAL|0x164); | ||
816 | return 0; | ||
817 | } | ||
818 | #endif | ||
819 | } | ||
820 | else if ( st0_tag == TAG_Empty ) | ||
821 | { | ||
822 | /* Empty register (stack underflow) */ | ||
823 | EXCEPTION(EX_StackUnder); | ||
824 | if ( control_word & EX_Invalid ) | ||
825 | { | ||
826 | /* The masked response */ | ||
827 | /* Put out the QNaN indefinite */ | ||
828 | RE_ENTRANT_CHECK_OFF; | ||
829 | FPU_access_ok(VERIFY_WRITE,single,4); | ||
830 | FPU_put_user(0xffc00000, (unsigned long __user *) single); | ||
831 | RE_ENTRANT_CHECK_ON; | ||
832 | return 1; | ||
833 | } | ||
834 | else | ||
835 | return 0; | ||
836 | } | ||
837 | #ifdef PARANOID | ||
838 | else | ||
839 | { | ||
840 | EXCEPTION(EX_INTERNAL|0x163); | ||
841 | return 0; | ||
842 | } | ||
843 | #endif | ||
844 | if ( getsign(st0_ptr) ) | ||
845 | templ |= 0x80000000; | ||
846 | |||
847 | RE_ENTRANT_CHECK_OFF; | ||
848 | FPU_access_ok(VERIFY_WRITE,single,4); | ||
849 | FPU_put_user(templ,(unsigned long __user *) single); | ||
850 | RE_ENTRANT_CHECK_ON; | ||
851 | |||
852 | return 1; | ||
853 | } | ||
854 | |||
855 | |||
856 | /* Put a long long into user memory */ | ||
857 | int FPU_store_int64(FPU_REG *st0_ptr, u_char st0_tag, long long __user *d) | ||
858 | { | ||
859 | FPU_REG t; | ||
860 | long long tll; | ||
861 | int precision_loss; | ||
862 | |||
863 | if ( st0_tag == TAG_Empty ) | ||
864 | { | ||
865 | /* Empty register (stack underflow) */ | ||
866 | EXCEPTION(EX_StackUnder); | ||
867 | goto invalid_operand; | ||
868 | } | ||
869 | else if ( st0_tag == TAG_Special ) | ||
870 | { | ||
871 | st0_tag = FPU_Special(st0_ptr); | ||
872 | if ( (st0_tag == TW_Infinity) || | ||
873 | (st0_tag == TW_NaN) ) | ||
874 | { | ||
875 | EXCEPTION(EX_Invalid); | ||
876 | goto invalid_operand; | ||
877 | } | ||
878 | } | ||
879 | |||
880 | reg_copy(st0_ptr, &t); | ||
881 | precision_loss = FPU_round_to_int(&t, st0_tag); | ||
882 | ((long *)&tll)[0] = t.sigl; | ||
883 | ((long *)&tll)[1] = t.sigh; | ||
884 | if ( (precision_loss == 1) || | ||
885 | ((t.sigh & 0x80000000) && | ||
886 | !((t.sigh == 0x80000000) && (t.sigl == 0) && | ||
887 | signnegative(&t))) ) | ||
888 | { | ||
889 | EXCEPTION(EX_Invalid); | ||
890 | /* This is a special case: see sec 16.2.5.1 of the 80486 book */ | ||
891 | invalid_operand: | ||
892 | if ( control_word & EX_Invalid ) | ||
893 | { | ||
894 | /* Produce something like QNaN "indefinite" */ | ||
895 | tll = 0x8000000000000000LL; | ||
896 | } | ||
897 | else | ||
898 | return 0; | ||
899 | } | ||
900 | else | ||
901 | { | ||
902 | if ( precision_loss ) | ||
903 | set_precision_flag(precision_loss); | ||
904 | if ( signnegative(&t) ) | ||
905 | tll = - tll; | ||
906 | } | ||
907 | |||
908 | RE_ENTRANT_CHECK_OFF; | ||
909 | FPU_access_ok(VERIFY_WRITE,d,8); | ||
910 | copy_to_user(d, &tll, 8); | ||
911 | RE_ENTRANT_CHECK_ON; | ||
912 | |||
913 | return 1; | ||
914 | } | ||
915 | |||
916 | |||
917 | /* Put a long into user memory */ | ||
918 | int FPU_store_int32(FPU_REG *st0_ptr, u_char st0_tag, long __user *d) | ||
919 | { | ||
920 | FPU_REG t; | ||
921 | int precision_loss; | ||
922 | |||
923 | if ( st0_tag == TAG_Empty ) | ||
924 | { | ||
925 | /* Empty register (stack underflow) */ | ||
926 | EXCEPTION(EX_StackUnder); | ||
927 | goto invalid_operand; | ||
928 | } | ||
929 | else if ( st0_tag == TAG_Special ) | ||
930 | { | ||
931 | st0_tag = FPU_Special(st0_ptr); | ||
932 | if ( (st0_tag == TW_Infinity) || | ||
933 | (st0_tag == TW_NaN) ) | ||
934 | { | ||
935 | EXCEPTION(EX_Invalid); | ||
936 | goto invalid_operand; | ||
937 | } | ||
938 | } | ||
939 | |||
940 | reg_copy(st0_ptr, &t); | ||
941 | precision_loss = FPU_round_to_int(&t, st0_tag); | ||
942 | if (t.sigh || | ||
943 | ((t.sigl & 0x80000000) && | ||
944 | !((t.sigl == 0x80000000) && signnegative(&t))) ) | ||
945 | { | ||
946 | EXCEPTION(EX_Invalid); | ||
947 | /* This is a special case: see sec 16.2.5.1 of the 80486 book */ | ||
948 | invalid_operand: | ||
949 | if ( control_word & EX_Invalid ) | ||
950 | { | ||
951 | /* Produce something like QNaN "indefinite" */ | ||
952 | t.sigl = 0x80000000; | ||
953 | } | ||
954 | else | ||
955 | return 0; | ||
956 | } | ||
957 | else | ||
958 | { | ||
959 | if ( precision_loss ) | ||
960 | set_precision_flag(precision_loss); | ||
961 | if ( signnegative(&t) ) | ||
962 | t.sigl = -(long)t.sigl; | ||
963 | } | ||
964 | |||
965 | RE_ENTRANT_CHECK_OFF; | ||
966 | FPU_access_ok(VERIFY_WRITE,d,4); | ||
967 | FPU_put_user(t.sigl, (unsigned long __user *) d); | ||
968 | RE_ENTRANT_CHECK_ON; | ||
969 | |||
970 | return 1; | ||
971 | } | ||
972 | |||
973 | |||
974 | /* Put a short into user memory */ | ||
975 | int FPU_store_int16(FPU_REG *st0_ptr, u_char st0_tag, short __user *d) | ||
976 | { | ||
977 | FPU_REG t; | ||
978 | int precision_loss; | ||
979 | |||
980 | if ( st0_tag == TAG_Empty ) | ||
981 | { | ||
982 | /* Empty register (stack underflow) */ | ||
983 | EXCEPTION(EX_StackUnder); | ||
984 | goto invalid_operand; | ||
985 | } | ||
986 | else if ( st0_tag == TAG_Special ) | ||
987 | { | ||
988 | st0_tag = FPU_Special(st0_ptr); | ||
989 | if ( (st0_tag == TW_Infinity) || | ||
990 | (st0_tag == TW_NaN) ) | ||
991 | { | ||
992 | EXCEPTION(EX_Invalid); | ||
993 | goto invalid_operand; | ||
994 | } | ||
995 | } | ||
996 | |||
997 | reg_copy(st0_ptr, &t); | ||
998 | precision_loss = FPU_round_to_int(&t, st0_tag); | ||
999 | if (t.sigh || | ||
1000 | ((t.sigl & 0xffff8000) && | ||
1001 | !((t.sigl == 0x8000) && signnegative(&t))) ) | ||
1002 | { | ||
1003 | EXCEPTION(EX_Invalid); | ||
1004 | /* This is a special case: see sec 16.2.5.1 of the 80486 book */ | ||
1005 | invalid_operand: | ||
1006 | if ( control_word & EX_Invalid ) | ||
1007 | { | ||
1008 | /* Produce something like QNaN "indefinite" */ | ||
1009 | t.sigl = 0x8000; | ||
1010 | } | ||
1011 | else | ||
1012 | return 0; | ||
1013 | } | ||
1014 | else | ||
1015 | { | ||
1016 | if ( precision_loss ) | ||
1017 | set_precision_flag(precision_loss); | ||
1018 | if ( signnegative(&t) ) | ||
1019 | t.sigl = -t.sigl; | ||
1020 | } | ||
1021 | |||
1022 | RE_ENTRANT_CHECK_OFF; | ||
1023 | FPU_access_ok(VERIFY_WRITE,d,2); | ||
1024 | FPU_put_user((short)t.sigl, d); | ||
1025 | RE_ENTRANT_CHECK_ON; | ||
1026 | |||
1027 | return 1; | ||
1028 | } | ||
1029 | |||
1030 | |||
1031 | /* Put a packed bcd array into user memory */ | ||
1032 | int FPU_store_bcd(FPU_REG *st0_ptr, u_char st0_tag, u_char __user *d) | ||
1033 | { | ||
1034 | FPU_REG t; | ||
1035 | unsigned long long ll; | ||
1036 | u_char b; | ||
1037 | int i, precision_loss; | ||
1038 | u_char sign = (getsign(st0_ptr) == SIGN_NEG) ? 0x80 : 0; | ||
1039 | |||
1040 | if ( st0_tag == TAG_Empty ) | ||
1041 | { | ||
1042 | /* Empty register (stack underflow) */ | ||
1043 | EXCEPTION(EX_StackUnder); | ||
1044 | goto invalid_operand; | ||
1045 | } | ||
1046 | else if ( st0_tag == TAG_Special ) | ||
1047 | { | ||
1048 | st0_tag = FPU_Special(st0_ptr); | ||
1049 | if ( (st0_tag == TW_Infinity) || | ||
1050 | (st0_tag == TW_NaN) ) | ||
1051 | { | ||
1052 | EXCEPTION(EX_Invalid); | ||
1053 | goto invalid_operand; | ||
1054 | } | ||
1055 | } | ||
1056 | |||
1057 | reg_copy(st0_ptr, &t); | ||
1058 | precision_loss = FPU_round_to_int(&t, st0_tag); | ||
1059 | ll = significand(&t); | ||
1060 | |||
1061 | /* Check for overflow, by comparing with 999999999999999999 decimal. */ | ||
1062 | if ( (t.sigh > 0x0de0b6b3) || | ||
1063 | ((t.sigh == 0x0de0b6b3) && (t.sigl > 0xa763ffff)) ) | ||
1064 | { | ||
1065 | EXCEPTION(EX_Invalid); | ||
1066 | /* This is a special case: see sec 16.2.5.1 of the 80486 book */ | ||
1067 | invalid_operand: | ||
1068 | if ( control_word & CW_Invalid ) | ||
1069 | { | ||
1070 | /* Produce the QNaN "indefinite" */ | ||
1071 | RE_ENTRANT_CHECK_OFF; | ||
1072 | FPU_access_ok(VERIFY_WRITE,d,10); | ||
1073 | for ( i = 0; i < 7; i++) | ||
1074 | FPU_put_user(0, d+i); /* These bytes "undefined" */ | ||
1075 | FPU_put_user(0xc0, d+7); /* This byte "undefined" */ | ||
1076 | FPU_put_user(0xff, d+8); | ||
1077 | FPU_put_user(0xff, d+9); | ||
1078 | RE_ENTRANT_CHECK_ON; | ||
1079 | return 1; | ||
1080 | } | ||
1081 | else | ||
1082 | return 0; | ||
1083 | } | ||
1084 | else if ( precision_loss ) | ||
1085 | { | ||
1086 | /* Precision loss doesn't stop the data transfer */ | ||
1087 | set_precision_flag(precision_loss); | ||
1088 | } | ||
1089 | |||
1090 | RE_ENTRANT_CHECK_OFF; | ||
1091 | FPU_access_ok(VERIFY_WRITE,d,10); | ||
1092 | RE_ENTRANT_CHECK_ON; | ||
1093 | for ( i = 0; i < 9; i++) | ||
1094 | { | ||
1095 | b = FPU_div_small(&ll, 10); | ||
1096 | b |= (FPU_div_small(&ll, 10)) << 4; | ||
1097 | RE_ENTRANT_CHECK_OFF; | ||
1098 | FPU_put_user(b, d+i); | ||
1099 | RE_ENTRANT_CHECK_ON; | ||
1100 | } | ||
1101 | RE_ENTRANT_CHECK_OFF; | ||
1102 | FPU_put_user(sign, d+9); | ||
1103 | RE_ENTRANT_CHECK_ON; | ||
1104 | |||
1105 | return 1; | ||
1106 | } | ||
1107 | |||
1108 | /*===========================================================================*/ | ||
1109 | |||
1110 | /* r gets mangled such that sig is int, sign: | ||
1111 | it is NOT normalized */ | ||
1112 | /* The return value (in eax) is zero if the result is exact, | ||
1113 | if bits are changed due to rounding, truncation, etc, then | ||
1114 | a non-zero value is returned */ | ||
1115 | /* Overflow is signalled by a non-zero return value (in eax). | ||
1116 | In the case of overflow, the returned significand always has the | ||
1117 | largest possible value */ | ||
1118 | int FPU_round_to_int(FPU_REG *r, u_char tag) | ||
1119 | { | ||
1120 | u_char very_big; | ||
1121 | unsigned eax; | ||
1122 | |||
1123 | if (tag == TAG_Zero) | ||
1124 | { | ||
1125 | /* Make sure that zero is returned */ | ||
1126 | significand(r) = 0; | ||
1127 | return 0; /* o.k. */ | ||
1128 | } | ||
1129 | |||
1130 | if (exponent(r) > 63) | ||
1131 | { | ||
1132 | r->sigl = r->sigh = ~0; /* The largest representable number */ | ||
1133 | return 1; /* overflow */ | ||
1134 | } | ||
1135 | |||
1136 | eax = FPU_shrxs(&r->sigl, 63 - exponent(r)); | ||
1137 | very_big = !(~(r->sigh) | ~(r->sigl)); /* test for 0xfff...fff */ | ||
1138 | #define half_or_more (eax & 0x80000000) | ||
1139 | #define frac_part (eax) | ||
1140 | #define more_than_half ((eax & 0x80000001) == 0x80000001) | ||
1141 | switch (control_word & CW_RC) | ||
1142 | { | ||
1143 | case RC_RND: | ||
1144 | if ( more_than_half /* nearest */ | ||
1145 | || (half_or_more && (r->sigl & 1)) ) /* odd -> even */ | ||
1146 | { | ||
1147 | if ( very_big ) return 1; /* overflow */ | ||
1148 | significand(r) ++; | ||
1149 | return PRECISION_LOST_UP; | ||
1150 | } | ||
1151 | break; | ||
1152 | case RC_DOWN: | ||
1153 | if (frac_part && getsign(r)) | ||
1154 | { | ||
1155 | if ( very_big ) return 1; /* overflow */ | ||
1156 | significand(r) ++; | ||
1157 | return PRECISION_LOST_UP; | ||
1158 | } | ||
1159 | break; | ||
1160 | case RC_UP: | ||
1161 | if (frac_part && !getsign(r)) | ||
1162 | { | ||
1163 | if ( very_big ) return 1; /* overflow */ | ||
1164 | significand(r) ++; | ||
1165 | return PRECISION_LOST_UP; | ||
1166 | } | ||
1167 | break; | ||
1168 | case RC_CHOP: | ||
1169 | break; | ||
1170 | } | ||
1171 | |||
1172 | return eax ? PRECISION_LOST_DOWN : 0; | ||
1173 | |||
1174 | } | ||
1175 | |||
1176 | /*===========================================================================*/ | ||
1177 | |||
1178 | u_char __user *fldenv(fpu_addr_modes addr_modes, u_char __user *s) | ||
1179 | { | ||
1180 | unsigned short tag_word = 0; | ||
1181 | u_char tag; | ||
1182 | int i; | ||
1183 | |||
1184 | if ( (addr_modes.default_mode == VM86) || | ||
1185 | ((addr_modes.default_mode == PM16) | ||
1186 | ^ (addr_modes.override.operand_size == OP_SIZE_PREFIX)) ) | ||
1187 | { | ||
1188 | RE_ENTRANT_CHECK_OFF; | ||
1189 | FPU_access_ok(VERIFY_READ, s, 0x0e); | ||
1190 | FPU_get_user(control_word, (unsigned short __user *) s); | ||
1191 | FPU_get_user(partial_status, (unsigned short __user *) (s+2)); | ||
1192 | FPU_get_user(tag_word, (unsigned short __user *) (s+4)); | ||
1193 | FPU_get_user(instruction_address.offset, (unsigned short __user *) (s+6)); | ||
1194 | FPU_get_user(instruction_address.selector, (unsigned short __user *) (s+8)); | ||
1195 | FPU_get_user(operand_address.offset, (unsigned short __user *) (s+0x0a)); | ||
1196 | FPU_get_user(operand_address.selector, (unsigned short __user *) (s+0x0c)); | ||
1197 | RE_ENTRANT_CHECK_ON; | ||
1198 | s += 0x0e; | ||
1199 | if ( addr_modes.default_mode == VM86 ) | ||
1200 | { | ||
1201 | instruction_address.offset | ||
1202 | += (instruction_address.selector & 0xf000) << 4; | ||
1203 | operand_address.offset += (operand_address.selector & 0xf000) << 4; | ||
1204 | } | ||
1205 | } | ||
1206 | else | ||
1207 | { | ||
1208 | RE_ENTRANT_CHECK_OFF; | ||
1209 | FPU_access_ok(VERIFY_READ, s, 0x1c); | ||
1210 | FPU_get_user(control_word, (unsigned short __user *) s); | ||
1211 | FPU_get_user(partial_status, (unsigned short __user *) (s+4)); | ||
1212 | FPU_get_user(tag_word, (unsigned short __user *) (s+8)); | ||
1213 | FPU_get_user(instruction_address.offset, (unsigned long __user *) (s+0x0c)); | ||
1214 | FPU_get_user(instruction_address.selector, (unsigned short __user *) (s+0x10)); | ||
1215 | FPU_get_user(instruction_address.opcode, (unsigned short __user *) (s+0x12)); | ||
1216 | FPU_get_user(operand_address.offset, (unsigned long __user *) (s+0x14)); | ||
1217 | FPU_get_user(operand_address.selector, (unsigned long __user *) (s+0x18)); | ||
1218 | RE_ENTRANT_CHECK_ON; | ||
1219 | s += 0x1c; | ||
1220 | } | ||
1221 | |||
1222 | #ifdef PECULIAR_486 | ||
1223 | control_word &= ~0xe080; | ||
1224 | #endif /* PECULIAR_486 */ | ||
1225 | |||
1226 | top = (partial_status >> SW_Top_Shift) & 7; | ||
1227 | |||
1228 | if ( partial_status & ~control_word & CW_Exceptions ) | ||
1229 | partial_status |= (SW_Summary | SW_Backward); | ||
1230 | else | ||
1231 | partial_status &= ~(SW_Summary | SW_Backward); | ||
1232 | |||
1233 | for ( i = 0; i < 8; i++ ) | ||
1234 | { | ||
1235 | tag = tag_word & 3; | ||
1236 | tag_word >>= 2; | ||
1237 | |||
1238 | if ( tag == TAG_Empty ) | ||
1239 | /* New tag is empty. Accept it */ | ||
1240 | FPU_settag(i, TAG_Empty); | ||
1241 | else if ( FPU_gettag(i) == TAG_Empty ) | ||
1242 | { | ||
1243 | /* Old tag is empty and new tag is not empty. New tag is determined | ||
1244 | by old reg contents */ | ||
1245 | if ( exponent(&fpu_register(i)) == - EXTENDED_Ebias ) | ||
1246 | { | ||
1247 | if ( !(fpu_register(i).sigl | fpu_register(i).sigh) ) | ||
1248 | FPU_settag(i, TAG_Zero); | ||
1249 | else | ||
1250 | FPU_settag(i, TAG_Special); | ||
1251 | } | ||
1252 | else if ( exponent(&fpu_register(i)) == 0x7fff - EXTENDED_Ebias ) | ||
1253 | { | ||
1254 | FPU_settag(i, TAG_Special); | ||
1255 | } | ||
1256 | else if ( fpu_register(i).sigh & 0x80000000 ) | ||
1257 | FPU_settag(i, TAG_Valid); | ||
1258 | else | ||
1259 | FPU_settag(i, TAG_Special); /* An Un-normal */ | ||
1260 | } | ||
1261 | /* Else old tag is not empty and new tag is not empty. Old tag | ||
1262 | remains correct */ | ||
1263 | } | ||
1264 | |||
1265 | return s; | ||
1266 | } | ||
1267 | |||
1268 | |||
1269 | void frstor(fpu_addr_modes addr_modes, u_char __user *data_address) | ||
1270 | { | ||
1271 | int i, regnr; | ||
1272 | u_char __user *s = fldenv(addr_modes, data_address); | ||
1273 | int offset = (top & 7) * 10, other = 80 - offset; | ||
1274 | |||
1275 | /* Copy all registers in stack order. */ | ||
1276 | RE_ENTRANT_CHECK_OFF; | ||
1277 | FPU_access_ok(VERIFY_READ,s,80); | ||
1278 | __copy_from_user(register_base+offset, s, other); | ||
1279 | if ( offset ) | ||
1280 | __copy_from_user(register_base, s+other, offset); | ||
1281 | RE_ENTRANT_CHECK_ON; | ||
1282 | |||
1283 | for ( i = 0; i < 8; i++ ) | ||
1284 | { | ||
1285 | regnr = (i+top) & 7; | ||
1286 | if ( FPU_gettag(regnr) != TAG_Empty ) | ||
1287 | /* The loaded data over-rides all other cases. */ | ||
1288 | FPU_settag(regnr, FPU_tagof(&st(i))); | ||
1289 | } | ||
1290 | |||
1291 | } | ||
1292 | |||
1293 | |||
1294 | u_char __user *fstenv(fpu_addr_modes addr_modes, u_char __user *d) | ||
1295 | { | ||
1296 | if ( (addr_modes.default_mode == VM86) || | ||
1297 | ((addr_modes.default_mode == PM16) | ||
1298 | ^ (addr_modes.override.operand_size == OP_SIZE_PREFIX)) ) | ||
1299 | { | ||
1300 | RE_ENTRANT_CHECK_OFF; | ||
1301 | FPU_access_ok(VERIFY_WRITE,d,14); | ||
1302 | #ifdef PECULIAR_486 | ||
1303 | FPU_put_user(control_word & ~0xe080, (unsigned long __user *) d); | ||
1304 | #else | ||
1305 | FPU_put_user(control_word, (unsigned short __user *) d); | ||
1306 | #endif /* PECULIAR_486 */ | ||
1307 | FPU_put_user(status_word(), (unsigned short __user *) (d+2)); | ||
1308 | FPU_put_user(fpu_tag_word, (unsigned short __user *) (d+4)); | ||
1309 | FPU_put_user(instruction_address.offset, (unsigned short __user *) (d+6)); | ||
1310 | FPU_put_user(operand_address.offset, (unsigned short __user *) (d+0x0a)); | ||
1311 | if ( addr_modes.default_mode == VM86 ) | ||
1312 | { | ||
1313 | FPU_put_user((instruction_address.offset & 0xf0000) >> 4, | ||
1314 | (unsigned short __user *) (d+8)); | ||
1315 | FPU_put_user((operand_address.offset & 0xf0000) >> 4, | ||
1316 | (unsigned short __user *) (d+0x0c)); | ||
1317 | } | ||
1318 | else | ||
1319 | { | ||
1320 | FPU_put_user(instruction_address.selector, (unsigned short __user *) (d+8)); | ||
1321 | FPU_put_user(operand_address.selector, (unsigned short __user *) (d+0x0c)); | ||
1322 | } | ||
1323 | RE_ENTRANT_CHECK_ON; | ||
1324 | d += 0x0e; | ||
1325 | } | ||
1326 | else | ||
1327 | { | ||
1328 | RE_ENTRANT_CHECK_OFF; | ||
1329 | FPU_access_ok(VERIFY_WRITE, d, 7*4); | ||
1330 | #ifdef PECULIAR_486 | ||
1331 | control_word &= ~0xe080; | ||
1332 | /* An 80486 sets nearly all of the reserved bits to 1. */ | ||
1333 | control_word |= 0xffff0040; | ||
1334 | partial_status = status_word() | 0xffff0000; | ||
1335 | fpu_tag_word |= 0xffff0000; | ||
1336 | I387.soft.fcs &= ~0xf8000000; | ||
1337 | I387.soft.fos |= 0xffff0000; | ||
1338 | #endif /* PECULIAR_486 */ | ||
1339 | __copy_to_user(d, &control_word, 7*4); | ||
1340 | RE_ENTRANT_CHECK_ON; | ||
1341 | d += 0x1c; | ||
1342 | } | ||
1343 | |||
1344 | control_word |= CW_Exceptions; | ||
1345 | partial_status &= ~(SW_Summary | SW_Backward); | ||
1346 | |||
1347 | return d; | ||
1348 | } | ||
1349 | |||
1350 | |||
1351 | void fsave(fpu_addr_modes addr_modes, u_char __user *data_address) | ||
1352 | { | ||
1353 | u_char __user *d; | ||
1354 | int offset = (top & 7) * 10, other = 80 - offset; | ||
1355 | |||
1356 | d = fstenv(addr_modes, data_address); | ||
1357 | |||
1358 | RE_ENTRANT_CHECK_OFF; | ||
1359 | FPU_access_ok(VERIFY_WRITE,d,80); | ||
1360 | |||
1361 | /* Copy all registers in stack order. */ | ||
1362 | __copy_to_user(d, register_base+offset, other); | ||
1363 | if ( offset ) | ||
1364 | __copy_to_user(d+other, register_base, offset); | ||
1365 | RE_ENTRANT_CHECK_ON; | ||
1366 | |||
1367 | finit(); | ||
1368 | } | ||
1369 | |||
1370 | /*===========================================================================*/ | ||