Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ]
Version: [ 2.6.11.8 ] [ 2.6.25 ] [ 2.6.25.8 ] [ 2.6.31.13 ] Architecture: [ i386 ]
  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 static int compare(FPU_REG const *b, int tagb)
 24 {
 25         int diff, exp0, expb;
 26         u_char st0_tag;
 27         FPU_REG *st0_ptr;
 28         FPU_REG x, y;
 29         u_char st0_sign, signb = getsign(b);
 30 
 31         st0_ptr = &st(0);
 32         st0_tag = FPU_gettag0();
 33         st0_sign = getsign(st0_ptr);
 34 
 35         if (tagb == TAG_Special)
 36                 tagb = FPU_Special(b);
 37         if (st0_tag == TAG_Special)
 38                 st0_tag = FPU_Special(st0_ptr);
 39 
 40         if (((st0_tag != TAG_Valid) && (st0_tag != TW_Denormal))
 41             || ((tagb != TAG_Valid) && (tagb != TW_Denormal))) {
 42                 if (st0_tag == TAG_Zero) {
 43                         if (tagb == TAG_Zero)
 44                                 return COMP_A_eq_B;
 45                         if (tagb == TAG_Valid)
 46                                 return ((signb ==
 47                                          SIGN_POS) ? COMP_A_lt_B : COMP_A_gt_B);
 48                         if (tagb == TW_Denormal)
 49                                 return ((signb ==
 50                                          SIGN_POS) ? COMP_A_lt_B : COMP_A_gt_B)
 51                                     | COMP_Denormal;
 52                 } else if (tagb == TAG_Zero) {
 53                         if (st0_tag == TAG_Valid)
 54                                 return ((st0_sign ==
 55                                          SIGN_POS) ? COMP_A_gt_B : COMP_A_lt_B);
 56                         if (st0_tag == TW_Denormal)
 57                                 return ((st0_sign ==
 58                                          SIGN_POS) ? COMP_A_gt_B : COMP_A_lt_B)
 59                                     | COMP_Denormal;
 60                 }
 61 
 62                 if (st0_tag == TW_Infinity) {
 63                         if ((tagb == TAG_Valid) || (tagb == TAG_Zero))
 64                                 return ((st0_sign ==
 65                                          SIGN_POS) ? COMP_A_gt_B : COMP_A_lt_B);
 66                         else if (tagb == TW_Denormal)
 67                                 return ((st0_sign ==
 68                                          SIGN_POS) ? COMP_A_gt_B : COMP_A_lt_B)
 69                                     | COMP_Denormal;
 70                         else if (tagb == TW_Infinity) {
 71                                 /* The 80486 book says that infinities can be equal! */
 72                                 return (st0_sign == signb) ? COMP_A_eq_B :
 73                                     ((st0_sign ==
 74                                       SIGN_POS) ? COMP_A_gt_B : COMP_A_lt_B);
 75                         }
 76                         /* Fall through to the NaN code */
 77                 } else if (tagb == TW_Infinity) {
 78                         if ((st0_tag == TAG_Valid) || (st0_tag == TAG_Zero))
 79                                 return ((signb ==
 80                                          SIGN_POS) ? COMP_A_lt_B : COMP_A_gt_B);
 81                         if (st0_tag == TW_Denormal)
 82                                 return ((signb ==
 83                                          SIGN_POS) ? COMP_A_lt_B : COMP_A_gt_B)
 84                                     | COMP_Denormal;
 85                         /* Fall through to the NaN code */
 86                 }
 87 
 88                 /* The only possibility now should be that one of the arguments
 89                    is a NaN */
 90                 if ((st0_tag == TW_NaN) || (tagb == TW_NaN)) {
 91                         int signalling = 0, unsupported = 0;
 92                         if (st0_tag == TW_NaN) {
 93                                 signalling =
 94                                     (st0_ptr->sigh & 0xc0000000) == 0x80000000;
 95                                 unsupported = !((exponent(st0_ptr) == EXP_OVER)
 96                                                 && (st0_ptr->
 97                                                     sigh & 0x80000000));
 98                         }
 99                         if (tagb == TW_NaN) {
100                                 signalling |=
101                                     (b->sigh & 0xc0000000) == 0x80000000;
102                                 unsupported |= !((exponent(b) == EXP_OVER)
103                                                  && (b->sigh & 0x80000000));
104                         }
105                         if (signalling || unsupported)
106                                 return COMP_No_Comp | COMP_SNaN | COMP_NaN;
107                         else
108                                 /* Neither is a signaling NaN */
109                                 return COMP_No_Comp | COMP_NaN;
110                 }
111 
112                 EXCEPTION(EX_Invalid);
113         }
114 
115         if (st0_sign != signb) {
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                 FPU_to_exp16(st0_ptr, &x);
123                 FPU_to_exp16(b, &y);
124                 st0_ptr = &x;
125                 b = &y;
126                 exp0 = exponent16(st0_ptr);
127                 expb = exponent16(b);
128         } else {
129                 exp0 = exponent(st0_ptr);
130                 expb = exponent(b);
131         }
132 
133 #ifdef PARANOID
134         if (!(st0_ptr->sigh & 0x80000000))
135                 EXCEPTION(EX_Invalid);
136         if (!(b->sigh & 0x80000000))
137                 EXCEPTION(EX_Invalid);
138 #endif /* PARANOID */
139 
140         diff = exp0 - expb;
141         if (diff == 0) {
142                 diff = st0_ptr->sigh - b->sigh; /* Works only if ms bits are
143                                                    identical */
144                 if (diff == 0) {
145                         diff = st0_ptr->sigl > b->sigl;
146                         if (diff == 0)
147                                 diff = -(st0_ptr->sigl < b->sigl);
148                 }
149         }
150 
151         if (diff > 0) {
152                 return ((st0_sign == SIGN_POS) ? COMP_A_gt_B : COMP_A_lt_B)
153                     | (((st0_tag == TW_Denormal) || (tagb == TW_Denormal)) ?
154                        COMP_Denormal : 0);
155         }
156         if (diff < 0) {
157                 return ((st0_sign == SIGN_POS) ? COMP_A_lt_B : COMP_A_gt_B)
158                     | (((st0_tag == TW_Denormal) || (tagb == TW_Denormal)) ?
159                        COMP_Denormal : 0);
160         }
161 
162         return COMP_A_eq_B
163             | (((st0_tag == TW_Denormal) || (tagb == TW_Denormal)) ?
164                COMP_Denormal : 0);
165 
166 }
167 
168 /* This function requires that st(0) is not empty */
169 int FPU_compare_st_data(FPU_REG const *loaded_data, u_char loaded_tag)
170 {
171         int f = 0, c;
172 
173         c = compare(loaded_data, loaded_tag);
174 
175         if (c & COMP_NaN) {
176                 EXCEPTION(EX_Invalid);
177                 f = SW_C3 | SW_C2 | SW_C0;
178         } else
179                 switch (c & 7) {
180                 case COMP_A_lt_B:
181                         f = SW_C0;
182                         break;
183                 case COMP_A_eq_B:
184                         f = SW_C3;
185                         break;
186                 case COMP_A_gt_B:
187                         f = 0;
188                         break;
189                 case COMP_No_Comp:
190                         f = SW_C3 | SW_C2 | SW_C0;
191                         break;
192 #ifdef PARANOID
193                 default:
194                         EXCEPTION(EX_INTERNAL | 0x121);
195                         f = SW_C3 | SW_C2 | SW_C0;
196                         break;
197 #endif /* PARANOID */
198                 }
199         setcc(f);
200         if (c & COMP_Denormal) {
201                 return denormal_operand() < 0;
202         }
203         return 0;
204 }
205 
206 static int compare_st_st(int nr)
207 {
208         int f = 0, c;
209         FPU_REG *st_ptr;
210 
211         if (!NOT_EMPTY(0) || !NOT_EMPTY(nr)) {
212                 setcc(SW_C3 | SW_C2 | SW_C0);
213                 /* Stack fault */
214                 EXCEPTION(EX_StackUnder);
215                 return !(control_word & CW_Invalid);
216         }
217 
218         st_ptr = &st(nr);
219         c = compare(st_ptr, FPU_gettagi(nr));
220         if (c & COMP_NaN) {
221                 setcc(SW_C3 | SW_C2 | SW_C0);
222                 EXCEPTION(EX_Invalid);
223                 return !(control_word & CW_Invalid);
224         } else
225                 switch (c & 7) {
226                 case COMP_A_lt_B:
227                         f = SW_C0;
228                         break;
229                 case COMP_A_eq_B:
230                         f = SW_C3;
231                         break;
232                 case COMP_A_gt_B:
233                         f = 0;
234                         break;
235                 case COMP_No_Comp:
236                         f = SW_C3 | SW_C2 | SW_C0;
237                         break;
238 #ifdef PARANOID
239                 default:
240                         EXCEPTION(EX_INTERNAL | 0x122);
241                         f = SW_C3 | SW_C2 | SW_C0;
242                         break;
243 #endif /* PARANOID */
244                 }
245         setcc(f);
246         if (c & COMP_Denormal) {
247                 return denormal_operand() < 0;
248         }
249         return 0;
250 }
251 
252 static int compare_u_st_st(int nr)
253 {
254         int f = 0, c;
255         FPU_REG *st_ptr;
256 
257         if (!NOT_EMPTY(0) || !NOT_EMPTY(nr)) {
258                 setcc(SW_C3 | SW_C2 | SW_C0);
259                 /* Stack fault */
260                 EXCEPTION(EX_StackUnder);
261                 return !(control_word & CW_Invalid);
262         }
263 
264         st_ptr = &st(nr);
265         c = compare(st_ptr, FPU_gettagi(nr));
266         if (c & COMP_NaN) {
267                 setcc(SW_C3 | SW_C2 | SW_C0);
268                 if (c & COMP_SNaN) {    /* This is the only difference between
269                                            un-ordered and ordinary comparisons */
270                         EXCEPTION(EX_Invalid);
271                         return !(control_word & CW_Invalid);
272                 }
273                 return 0;
274         } else
275                 switch (c & 7) {
276                 case COMP_A_lt_B:
277                         f = SW_C0;
278                         break;
279                 case COMP_A_eq_B:
280                         f = SW_C3;
281                         break;
282                 case COMP_A_gt_B:
283                         f = 0;
284                         break;
285                 case COMP_No_Comp:
286                         f = SW_C3 | SW_C2 | SW_C0;
287                         break;
288 #ifdef PARANOID
289                 default:
290                         EXCEPTION(EX_INTERNAL | 0x123);
291                         f = SW_C3 | SW_C2 | SW_C0;
292                         break;
293 #endif /* PARANOID */
294                 }
295         setcc(f);
296         if (c & COMP_Denormal) {
297                 return denormal_operand() < 0;
298         }
299         return 0;
300 }
301 
302 /*---------------------------------------------------------------------------*/
303 
304 void fcom_st(void)
305 {
306         /* fcom st(i) */
307         compare_st_st(FPU_rm);
308 }
309 
310 void fcompst(void)
311 {
312         /* fcomp st(i) */
313         if (!compare_st_st(FPU_rm))
314                 FPU_pop();
315 }
316 
317 void fcompp(void)
318 {
319         /* fcompp */
320         if (FPU_rm != 1) {
321                 FPU_illegal();
322                 return;
323         }
324         if (!compare_st_st(1))
325                 poppop();
326 }
327 
328 void fucom_(void)
329 {
330         /* fucom st(i) */
331         compare_u_st_st(FPU_rm);
332 
333 }
334 
335 void fucomp(void)
336 {
337         /* fucomp st(i) */
338         if (!compare_u_st_st(FPU_rm))
339                 FPU_pop();
340 }
341 
342 void fucompp(void)
343 {
344         /* fucompp */
345         if (FPU_rm == 1) {
346                 if (!compare_u_st_st(1))
347                         poppop();
348         } else
349                 FPU_illegal();
350 }
351 
  This page was automatically generated by the LXR engine.