git.gag.com Git - debian/cc1111/blob - device/lib/pic16/libm/atanf.c

   1 /*  atanf.c: Computes arctan of a 32-bit float as outlined in [1]
   2
   3     Copyright (C) 2001, 2002  Jesus Calvino-Fraga, jesusc@ieee.org
   4
   5     This library is free software; you can redistribute it and/or
   6     modify it under the terms of the GNU Lesser General Public
   7     License as published by the Free Software Foundation; either
   8     version 2.1 of the License, or (at your option) any later version.
   9
  10     This library is distributed in the hope that it will be useful,
  11     but WITHOUT ANY WARRANTY; without even the implied warranty of
  12     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  13     Lesser General Public License for more details.
  14
  15     You should have received a copy of the GNU Lesser General Public
  16     License along with this library; if not, write to the Free Software
  17     Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA */
  18
  19 /* [1] William James Cody and W.  M.  Waite.  _Software manual for the
  20    elementary functions_, Englewood Cliffs, N.J.:Prentice-Hall, 1980. */
  21
  22 /* Version 1.0 - Initial release */
  23
  24 /*
  25 ** $Id: atanf.c 3654 2005-01-24 10:38:53Z vrokas $
  26 */
  27
  28 #include <math.h>
  29 #include <errno.h>
  30
  31 #define P0 -0.4708325141E+0
  32 #define P1 -0.5090958253E-1
  33 #define Q0  0.1412500740E+1
  34 #define Q1  0.1000000000E+1
  35
  36 #define P(g,f) ((P1*g+P0)*g*f)
  37 #define Q(g) (Q1*g+Q0)
  38
  39 #define K1  0.2679491924 /* 2-sqrt(3) */
  40 #define K2  0.7320508076 /* sqrt(3)-1 */
  41 #define K3  1.7320508076 /* sqrt(3)   */
  42
  43 #ifdef SDCC_mcs51
  44    #define myconst code
  45 #else
  46    #define myconst const
  47 #endif
  48
  49 float atanf(const float x) _MATH_REENTRANT
  50 {
  51     float f, r, g;
  52     int n=0;
  53         static myconst float a[]={  0.0, 0.5235987756, 1.5707963268, 1.0471975512 };
  54
  55     f=fabsf(x);
  56     if(f>1.0)
  57     {
  58         f=1.0/f;
  59         n=2;
  60     }
  61     if(f>K1)
  62     {
  63         f=((K2*f-1.0)+f)/(K3+f);
  64         // What it is actually wanted is this more accurate formula,
  65         // but SDCC optimizes it and then it does not work:
  66         // f=(((K2*f-0.5)-0.5)+f)/(K3+f);
  67         n++;
  68     }
  69     if(fabsf(f)<EPS) r=f;
  70     else
  71     {
  72         g=f*f;
  73         r=f+P(g,f)/Q(g);
  74     }
  75     if(n>1) r=-r;
  76     r+=a[n];
  77     if(x<0.0) r=-r;
  78     return r;
  79 }
  80