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

   1 /*  asincosf.c: Computes asin or acos 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: asincosf.c 3654 2005-01-24 10:38:53Z vrokas $
  26 */
  27
  28
  29 #include <math.h>
  30 #include <errno.h>
  31
  32 #define P1  0.933935835E+0
  33 #define P2 -0.504400557E+0
  34 #define Q0  0.560363004E+1
  35 #define Q1 -0.554846723E+1
  36 #define Q2  0.100000000E+1
  37
  38 #define P(g) (P2*g+P1)
  39 #define Q(g) ((Q2*g+Q1)*g+Q0)
  40
  41 #ifdef SDCC_mcs51
  42    #define myconst code
  43 #else
  44    #define myconst const
  45 #endif
  46
  47 float asincosf(const float x, const int isacos)
  48 {
  49     float y, g, r;
  50     int i;
  51
  52     static myconst float a[2]={ 0.0, QUART_PI };
  53     static myconst float b[2]={ HALF_PI, QUART_PI };
  54
  55     y=fabsf(x);
  56     i=isacos;
  57     if (y < EPS) r=y;
  58     else
  59     {
  60         if (y > 0.5)
  61         {
  62             i=1-i;
  63             if (y > 1.0)
  64             {
  65                 errno=EDOM;
  66                 return 0.0;
  67             }
  68             g=(0.5-y)+0.5;
  69             g=ldexpf(g,-1);
  70             y=sqrtf(g);
  71             y=-(y+y);
  72         }
  73         else
  74         {
  75             g=y*y;
  76         }
  77         r=y+y*((P(g)*g)/Q(g));
  78     }
  79     if (isacos)
  80     {
  81         if (x < 0.0)
  82             r=(b[i]+r)+b[i];
  83         else
  84             r=(a[i]-r)+a[i];
  85     }
  86     else
  87     {
  88         r=(a[i]+r)+a[i];
  89         if (x<0.0) r=-r;
  90     }
  91     return r;
  92 }