git.gag.com Git - debian/cc1111/blob - device/lib/pic/libm/sqrtf.c

   1 /*  sqrtf.c:  Computes square root 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: sqrtf.c 4776 2007-04-29 13:15:51Z borutr $
  26 */
  27
  28 #include <float.h>
  29 #include <math.h>
  30 #include <errno.h>
  31
  32 float sqrtf(const float x) _MATH_REENTRANT
  33 {
  34     float f, y;
  35     FS_STATIC int n;
  36
  37     if (x==0.0) return x;
  38     else if (x==1.0) return 1.0;
  39     else if (x<0.0)
  40     {
  41         errno=EDOM;
  42         return 0.0;
  43     }
  44     f=frexpf(x, &n);
  45     y=0.41731+0.59016*f; /*Educated guess*/
  46     /*For a 24 bit mantisa (float), two iterations are sufficient*/
  47     y+=f/y;
  48     y=ldexpf(y, -2) + f/y; /*Faster version of 0.25 * y + f/y*/
  49
  50     if (n&1)
  51     {
  52         y*=0.7071067812;
  53         ++n;
  54     }
  55     return ldexpf(y, n/2);
  56 }