release/src-rt-6.x.4708/linux/linux-2.6.36/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 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 }