Merge branches 'omap1-upstream' and 'omap2-upstream' into devel
[linux-2.6] / arch / x86 / math-emu / reg_compare.c
1 /*---------------------------------------------------------------------------+
2  |  reg_compare.c                                                            |
3  |                                                                           |
4  | Compare two floating point registers                                      |
5  |                                                                           |
6  | Copyright (C) 1992,1993,1994,1997                                         |
7  |                  W. Metzenthen, 22 Parker St, Ormond, Vic 3163, Australia |
8  |                  E-mail   billm@suburbia.net                              |
9  |                                                                           |
10  |                                                                           |
11  +---------------------------------------------------------------------------*/
12
13 /*---------------------------------------------------------------------------+
14  | compare() is the core FPU_REG comparison function                         |
15  +---------------------------------------------------------------------------*/
16
17 #include "fpu_system.h"
18 #include "exception.h"
19 #include "fpu_emu.h"
20 #include "control_w.h"
21 #include "status_w.h"
22
23
24 static int compare(FPU_REG const *b, int tagb)
25 {
26   int diff, exp0, expb;
27   u_char                st0_tag;
28   FPU_REG       *st0_ptr;
29   FPU_REG       x, y;
30   u_char                st0_sign, signb = getsign(b);
31
32   st0_ptr = &st(0);
33   st0_tag = FPU_gettag0();
34   st0_sign = getsign(st0_ptr);
35
36   if ( tagb == TAG_Special )
37     tagb = FPU_Special(b);
38   if ( st0_tag == TAG_Special )
39     st0_tag = FPU_Special(st0_ptr);
40
41   if ( ((st0_tag != TAG_Valid) && (st0_tag != TW_Denormal))
42        || ((tagb != TAG_Valid) && (tagb != TW_Denormal)) )
43     {
44       if ( st0_tag == TAG_Zero )
45         {
46           if ( tagb == TAG_Zero ) return COMP_A_eq_B;
47           if ( tagb == TAG_Valid )
48             return ((signb == SIGN_POS) ? COMP_A_lt_B : COMP_A_gt_B);
49           if ( tagb == TW_Denormal )
50             return ((signb == SIGN_POS) ? COMP_A_lt_B : COMP_A_gt_B)
51             | COMP_Denormal;
52         }
53       else if ( tagb == TAG_Zero )
54         {
55           if ( st0_tag == TAG_Valid )
56             return ((st0_sign == SIGN_POS) ? COMP_A_gt_B : COMP_A_lt_B);
57           if ( st0_tag == TW_Denormal )
58             return ((st0_sign == SIGN_POS) ? COMP_A_gt_B : COMP_A_lt_B)
59             | COMP_Denormal;
60         }
61
62       if ( st0_tag == TW_Infinity )
63         {
64           if ( (tagb == TAG_Valid) || (tagb == TAG_Zero) )
65             return ((st0_sign == SIGN_POS) ? COMP_A_gt_B : COMP_A_lt_B);
66           else if ( tagb == TW_Denormal )
67             return ((st0_sign == SIGN_POS) ? COMP_A_gt_B : COMP_A_lt_B)
68               | COMP_Denormal;
69           else if ( tagb == TW_Infinity )
70             {
71               /* The 80486 book says that infinities can be equal! */
72               return (st0_sign == signb) ? COMP_A_eq_B :
73                 ((st0_sign == SIGN_POS) ? COMP_A_gt_B : COMP_A_lt_B);
74             }
75           /* Fall through to the NaN code */
76         }
77       else if ( tagb == TW_Infinity )
78         {
79           if ( (st0_tag == TAG_Valid) || (st0_tag == TAG_Zero) )
80             return ((signb == SIGN_POS) ? COMP_A_lt_B : COMP_A_gt_B);
81           if ( st0_tag == TW_Denormal )
82             return ((signb == SIGN_POS) ? COMP_A_lt_B : COMP_A_gt_B)
83                 | COMP_Denormal;
84           /* Fall through to the NaN code */
85         }
86
87       /* The only possibility now should be that one of the arguments
88          is a NaN */
89       if ( (st0_tag == TW_NaN) || (tagb == TW_NaN) )
90         {
91           int signalling = 0, unsupported = 0;
92           if ( st0_tag == TW_NaN )
93             {
94               signalling = (st0_ptr->sigh & 0xc0000000) == 0x80000000;
95               unsupported = !((exponent(st0_ptr) == EXP_OVER)
96                               && (st0_ptr->sigh & 0x80000000));
97             }
98           if ( tagb == TW_NaN )
99             {
100               signalling |= (b->sigh & 0xc0000000) == 0x80000000;
101               unsupported |= !((exponent(b) == EXP_OVER)
102                                && (b->sigh & 0x80000000));
103             }
104           if ( signalling || unsupported )
105             return COMP_No_Comp | COMP_SNaN | COMP_NaN;
106           else
107             /* Neither is a signaling NaN */
108             return COMP_No_Comp | COMP_NaN;
109         }
110       
111       EXCEPTION(EX_Invalid);
112     }
113   
114   if (st0_sign != signb)
115     {
116       return ((st0_sign == SIGN_POS) ? COMP_A_gt_B : COMP_A_lt_B)
117         | ( ((st0_tag == TW_Denormal) || (tagb == TW_Denormal)) ?
118             COMP_Denormal : 0);
119     }
120
121   if ( (st0_tag == TW_Denormal) || (tagb == TW_Denormal) )
122     {
123       FPU_to_exp16(st0_ptr, &x);
124       FPU_to_exp16(b, &y);
125       st0_ptr = &x;
126       b = &y;
127       exp0 = exponent16(st0_ptr);
128       expb = exponent16(b);
129     }
130   else
131     {
132       exp0 = exponent(st0_ptr);
133       expb = exponent(b);
134     }
135
136 #ifdef PARANOID
137   if (!(st0_ptr->sigh & 0x80000000)) EXCEPTION(EX_Invalid);
138   if (!(b->sigh & 0x80000000)) EXCEPTION(EX_Invalid);
139 #endif /* PARANOID */
140
141   diff = exp0 - expb;
142   if ( diff == 0 )
143     {
144       diff = st0_ptr->sigh - b->sigh;  /* Works only if ms bits are
145                                               identical */
146       if ( diff == 0 )
147         {
148         diff = st0_ptr->sigl > b->sigl;
149         if ( diff == 0 )
150           diff = -(st0_ptr->sigl < b->sigl);
151         }
152     }
153
154   if ( diff > 0 )
155     {
156       return ((st0_sign == SIGN_POS) ? COMP_A_gt_B : COMP_A_lt_B)
157         | ( ((st0_tag == TW_Denormal) || (tagb == TW_Denormal)) ?
158             COMP_Denormal : 0);
159     }
160   if ( diff < 0 )
161     {
162       return ((st0_sign == SIGN_POS) ? COMP_A_lt_B : COMP_A_gt_B)
163         | ( ((st0_tag == TW_Denormal) || (tagb == TW_Denormal)) ?
164             COMP_Denormal : 0);
165     }
166
167   return COMP_A_eq_B
168     | ( ((st0_tag == TW_Denormal) || (tagb == TW_Denormal)) ?
169         COMP_Denormal : 0);
170
171 }
172
173
174 /* This function requires that st(0) is not empty */
175 int FPU_compare_st_data(FPU_REG const *loaded_data, u_char loaded_tag)
176 {
177   int f = 0, c;
178
179   c = compare(loaded_data, loaded_tag);
180
181   if (c & COMP_NaN)
182     {
183       EXCEPTION(EX_Invalid);
184       f = SW_C3 | SW_C2 | SW_C0;
185     }
186   else
187     switch (c & 7)
188       {
189       case COMP_A_lt_B:
190         f = SW_C0;
191         break;
192       case COMP_A_eq_B:
193         f = SW_C3;
194         break;
195       case COMP_A_gt_B:
196         f = 0;
197         break;
198       case COMP_No_Comp:
199         f = SW_C3 | SW_C2 | SW_C0;
200         break;
201 #ifdef PARANOID
202       default:
203         EXCEPTION(EX_INTERNAL|0x121);
204         f = SW_C3 | SW_C2 | SW_C0;
205         break;
206 #endif /* PARANOID */
207       }
208   setcc(f);
209   if (c & COMP_Denormal)
210     {
211       return denormal_operand() < 0;
212     }
213   return 0;
214 }
215
216
217 static int compare_st_st(int nr)
218 {
219   int f = 0, c;
220   FPU_REG *st_ptr;
221
222   if ( !NOT_EMPTY(0) || !NOT_EMPTY(nr) )
223     {
224       setcc(SW_C3 | SW_C2 | SW_C0);
225       /* Stack fault */
226       EXCEPTION(EX_StackUnder);
227       return !(control_word & CW_Invalid);
228     }
229
230   st_ptr = &st(nr);
231   c = compare(st_ptr, FPU_gettagi(nr));
232   if (c & COMP_NaN)
233     {
234       setcc(SW_C3 | SW_C2 | SW_C0);
235       EXCEPTION(EX_Invalid);
236       return !(control_word & CW_Invalid);
237     }
238   else
239     switch (c & 7)
240       {
241       case COMP_A_lt_B:
242         f = SW_C0;
243         break;
244       case COMP_A_eq_B:
245         f = SW_C3;
246         break;
247       case COMP_A_gt_B:
248         f = 0;
249         break;
250       case COMP_No_Comp:
251         f = SW_C3 | SW_C2 | SW_C0;
252         break;
253 #ifdef PARANOID
254       default:
255         EXCEPTION(EX_INTERNAL|0x122);
256         f = SW_C3 | SW_C2 | SW_C0;
257         break;
258 #endif /* PARANOID */
259       }
260   setcc(f);
261   if (c & COMP_Denormal)
262     {
263       return denormal_operand() < 0;
264     }
265   return 0;
266 }
267
268
269 static int compare_u_st_st(int nr)
270 {
271   int f = 0, c;
272   FPU_REG *st_ptr;
273
274   if ( !NOT_EMPTY(0) || !NOT_EMPTY(nr) )
275     {
276       setcc(SW_C3 | SW_C2 | SW_C0);
277       /* Stack fault */
278       EXCEPTION(EX_StackUnder);
279       return !(control_word & CW_Invalid);
280     }
281
282   st_ptr = &st(nr);
283   c = compare(st_ptr, FPU_gettagi(nr));
284   if (c & COMP_NaN)
285     {
286       setcc(SW_C3 | SW_C2 | SW_C0);
287       if (c & COMP_SNaN)       /* This is the only difference between
288                                   un-ordered and ordinary comparisons */
289         {
290           EXCEPTION(EX_Invalid);
291           return !(control_word & CW_Invalid);
292         }
293       return 0;
294     }
295   else
296     switch (c & 7)
297       {
298       case COMP_A_lt_B:
299         f = SW_C0;
300         break;
301       case COMP_A_eq_B:
302         f = SW_C3;
303         break;
304       case COMP_A_gt_B:
305         f = 0;
306         break;
307       case COMP_No_Comp:
308         f = SW_C3 | SW_C2 | SW_C0;
309         break;
310 #ifdef PARANOID
311       default:
312         EXCEPTION(EX_INTERNAL|0x123);
313         f = SW_C3 | SW_C2 | SW_C0;
314         break;
315 #endif /* PARANOID */ 
316       }
317   setcc(f);
318   if (c & COMP_Denormal)
319     {
320       return denormal_operand() < 0;
321     }
322   return 0;
323 }
324
325 /*---------------------------------------------------------------------------*/
326
327 void fcom_st(void)
328 {
329   /* fcom st(i) */
330   compare_st_st(FPU_rm);
331 }
332
333
334 void fcompst(void)
335 {
336   /* fcomp st(i) */
337   if ( !compare_st_st(FPU_rm) )
338     FPU_pop();
339 }
340
341
342 void fcompp(void)
343 {
344   /* fcompp */
345   if (FPU_rm != 1)
346     {
347       FPU_illegal();
348       return;
349     }
350   if ( !compare_st_st(1) )
351       poppop();
352 }
353
354
355 void fucom_(void)
356 {
357   /* fucom st(i) */
358   compare_u_st_st(FPU_rm);
359
360 }
361
362
363 void fucomp(void)
364 {
365   /* fucomp st(i) */
366   if ( !compare_u_st_st(FPU_rm) )
367     FPU_pop();
368 }
369
370
371 void fucompp(void)
372 {
373   /* fucompp */
374   if (FPU_rm == 1)
375     {
376       if ( !compare_u_st_st(1) )
377         poppop();
378     }
379   else
380     FPU_illegal();
381 }