kernel/arch/x86/math-emu/poly_tan.c

   1 /*---------------------------------------------------------------------------+
   2  |  poly_tan.c                                                               |
   3  |                                                                           |
   4  | Compute the tan of a FPU_REG, using a polynomial approximation.           |
   5  |                                                                           |
   6  | Copyright (C) 1992,1993,1994,1997,1999                                    |
   7  |                       W. Metzenthen, 22 Parker St, Ormond, Vic 3163,      |
   8  |                       Australia.  E-mail   billm@melbpc.org.au            |
   9  |                                                                           |
  10  |                                                                           |
  11  +---------------------------------------------------------------------------*/
  12
  13 #include "exception.h"
  14 #include "reg_constant.h"
  15 #include "fpu_emu.h"
  16 #include "fpu_system.h"
  17 #include "control_w.h"
  18 #include "poly.h"
  19
  20 #define HiPOWERop       3       /* odd poly, positive terms */
  21 static const unsigned long long oddplterm[HiPOWERop] = {
  22         0x0000000000000000LL,
  23         0x0051a1cf08fca228LL,
  24         0x0000000071284ff7LL
  25 };
  26
  27 #define HiPOWERon       2       /* odd poly, negative terms */
  28 static const unsigned long long oddnegterm[HiPOWERon] = {
  29         0x1291a9a184244e80LL,
  30         0x0000583245819c21LL
  31 };
  32
  33 #define HiPOWERep       2       /* even poly, positive terms */
  34 static const unsigned long long evenplterm[HiPOWERep] = {
  35         0x0e848884b539e888LL,
  36         0x00003c7f18b887daLL
  37 };
  38
  39 #define HiPOWERen       2       /* even poly, negative terms */
  40 static const unsigned long long evennegterm[HiPOWERen] = {
  41         0xf1f0200fd51569ccLL,
  42         0x003afb46105c4432LL
  43 };
  44
  45 static const unsigned long long twothirds = 0xaaaaaaaaaaaaaaabLL;
  46
  47 /*--- poly_tan() ------------------------------------------------------------+
  48  |                                                                           |
  49  +---------------------------------------------------------------------------*/
  50 void poly_tan(FPU_REG *st0_ptr)
  51 {
  52         long int exponent;
  53         int invert;
  54         Xsig argSq, argSqSq, accumulatoro, accumulatore, accum,
  55             argSignif, fix_up;
  56         unsigned long adj;
  57
  58         exponent = exponent(st0_ptr);
  59
  60 #ifdef PARANOID
  61         if (signnegative(st0_ptr)) {    /* Can't hack a number < 0.0 */
  62                 arith_invalid(0);
  63                 return;
  64         }                       /* Need a positive number */
  65 #endif /* PARANOID */
  66
  67         /* Split the problem into two domains, smaller and larger than pi/4 */
  68         if ((exponent == 0)
  69             || ((exponent == -1) && (st0_ptr->sigh > 0xc90fdaa2))) {
  70                 /* The argument is greater than (approx) pi/4 */
  71                 invert = 1;
  72                 accum.lsw = 0;
  73                 XSIG_LL(accum) = significand(st0_ptr);
  74
  75                 if (exponent == 0) {
  76                         /* The argument is >= 1.0 */
  77                         /* Put the binary point at the left. */
  78                         XSIG_LL(accum) <<= 1;
  79                 }
  80                 /* pi/2 in hex is: 1.921fb54442d18469 898CC51701B839A2 52049C1 */
  81                 XSIG_LL(accum) = 0x921fb54442d18469LL - XSIG_LL(accum);
  82                 /* This is a special case which arises due to rounding. */
  83                 if (XSIG_LL(accum) == 0xffffffffffffffffLL) {
  84                         FPU_settag0(TAG_Valid);
  85                         significand(st0_ptr) = 0x8a51e04daabda360LL;
  86                         setexponent16(st0_ptr,
  87                                       (0x41 + EXTENDED_Ebias) | SIGN_Negative);
  88                         return;
  89                 }
  90
  91                 argSignif.lsw = accum.lsw;
  92                 XSIG_LL(argSignif) = XSIG_LL(accum);
  93                 exponent = -1 + norm_Xsig(&argSignif);
  94         } else {
  95                 invert = 0;
  96                 argSignif.lsw = 0;
  97                 XSIG_LL(accum) = XSIG_LL(argSignif) = significand(st0_ptr);
  98
  99                 if (exponent < -1) {
 100                         /* shift the argument right by the required places */
 101                         if (FPU_shrx(&XSIG_LL(accum), -1 - exponent) >=
 102                             0x80000000U)
 103                                 XSIG_LL(accum)++;       /* round up */
 104                 }
 105         }
 106
 107         XSIG_LL(argSq) = XSIG_LL(accum);
 108         argSq.lsw = accum.lsw;
 109         mul_Xsig_Xsig(&argSq, &argSq);
 110         XSIG_LL(argSqSq) = XSIG_LL(argSq);
 111         argSqSq.lsw = argSq.lsw;
 112         mul_Xsig_Xsig(&argSqSq, &argSqSq);
 113
 114         /* Compute the negative terms for the numerator polynomial */
 115         accumulatoro.msw = accumulatoro.midw = accumulatoro.lsw = 0;
 116         polynomial_Xsig(&accumulatoro, &XSIG_LL(argSqSq), oddnegterm,
 117                         HiPOWERon - 1);
 118         mul_Xsig_Xsig(&accumulatoro, &argSq);
 119         negate_Xsig(&accumulatoro);
 120         /* Add the positive terms */
 121         polynomial_Xsig(&accumulatoro, &XSIG_LL(argSqSq), oddplterm,
 122                         HiPOWERop - 1);
 123
 124         /* Compute the positive terms for the denominator polynomial */
 125         accumulatore.msw = accumulatore.midw = accumulatore.lsw = 0;
 126         polynomial_Xsig(&accumulatore, &XSIG_LL(argSqSq), evenplterm,
 127                         HiPOWERep - 1);
 128         mul_Xsig_Xsig(&accumulatore, &argSq);
 129         negate_Xsig(&accumulatore);
 130         /* Add the negative terms */
 131         polynomial_Xsig(&accumulatore, &XSIG_LL(argSqSq), evennegterm,
 132                         HiPOWERen - 1);
 133         /* Multiply by arg^2 */
 134         mul64_Xsig(&accumulatore, &XSIG_LL(argSignif));
 135         mul64_Xsig(&accumulatore, &XSIG_LL(argSignif));
 136         /* de-normalize and divide by 2 */
 137         shr_Xsig(&accumulatore, -2 * (1 + exponent) + 1);
 138         negate_Xsig(&accumulatore);     /* This does 1 - accumulator */
 139
 140         /* Now find the ratio. */
 141         if (accumulatore.msw == 0) {
 142                 /* accumulatoro must contain 1.0 here, (actually, 0) but it
 143                    really doesn't matter what value we use because it will
 144                    have negligible effect in later calculations
 145                  */
 146                 XSIG_LL(accum) = 0x8000000000000000LL;
 147                 accum.lsw = 0;
 148         } else {
 149                 div_Xsig(&accumulatoro, &accumulatore, &accum);
 150         }
 151
 152         /* Multiply by 1/3 * arg^3 */
 153         mul64_Xsig(&accum, &XSIG_LL(argSignif));
 154         mul64_Xsig(&accum, &XSIG_LL(argSignif));
 155         mul64_Xsig(&accum, &XSIG_LL(argSignif));
 156         mul64_Xsig(&accum, &twothirds);
 157         shr_Xsig(&accum, -2 * (exponent + 1));
 158
 159         /* tan(arg) = arg + accum */
 160         add_two_Xsig(&accum, &argSignif, &exponent);
 161
 162         if (invert) {
 163                 /* We now have the value of tan(pi_2 - arg) where pi_2 is an
 164                    approximation for pi/2
 165                  */
 166                 /* The next step is to fix the answer to compensate for the
 167                    error due to the approximation used for pi/2
 168                  */
 169
 170                 /* This is (approx) delta, the error in our approx for pi/2
 171                    (see above). It has an exponent of -65
 172                  */
 173                 XSIG_LL(fix_up) = 0x898cc51701b839a2LL;
 174                 fix_up.lsw = 0;
 175
 176                 if (exponent == 0)
 177                         adj = 0xffffffff;       /* We want approx 1.0 here, but
 178                                                    this is close enough. */
 179                 else if (exponent > -30) {
 180                         adj = accum.msw >> -(exponent + 1);     /* tan */
 181                         adj = mul_32_32(adj, adj);      /* tan^2 */
 182                 } else
 183                         adj = 0;
 184                 adj = mul_32_32(0x898cc517, adj);       /* delta * tan^2 */
 185
 186                 fix_up.msw += adj;
 187                 if (!(fix_up.msw & 0x80000000)) {       /* did fix_up overflow ? */
 188                         /* Yes, we need to add an msb */
 189                         shr_Xsig(&fix_up, 1);
 190                         fix_up.msw |= 0x80000000;
 191                         shr_Xsig(&fix_up, 64 + exponent);
 192                 } else
 193                         shr_Xsig(&fix_up, 65 + exponent);
 194
 195                 add_two_Xsig(&accum, &fix_up, &exponent);
 196
 197                 /* accum now contains tan(pi/2 - arg).
 198                    Use tan(arg) = 1.0 / tan(pi/2 - arg)
 199                  */
 200                 accumulatoro.lsw = accumulatoro.midw = 0;
 201                 accumulatoro.msw = 0x80000000;
 202                 div_Xsig(&accumulatoro, &accum, &accum);
 203                 exponent = -exponent - 1;
 204         }
 205
 206         /* Transfer the result */
 207         round_Xsig(&accum);
 208         FPU_settag0(TAG_Valid);
 209         significand(st0_ptr) = XSIG_LL(accum);
 210         setexponent16(st0_ptr, exponent + EXTENDED_Ebias);      /* Result is positive. */
 211
 212 }