Line data    Source code

       1             : /* @(#)s_floor.c 5.1 93/09/24 */
       2             : /*
       3             :  * ====================================================
       4             :  * Copyright (C) 1993 by Sun Microsystems, Inc. All rights reserved.
       5             :  *
       6             :  * Developed at SunPro, a Sun Microsystems, Inc. business.
       7             :  * Permission to use, copy, modify, and distribute this
       8             :  * software is freely granted, provided that this notice
       9             :  * is preserved.
      10             :  * ====================================================
      11             :  */
      12             : 
      13             : //#include <sys/cdefs.h>
      14             : //__FBSDID("$FreeBSD$");
      15             : 
      16             : /*
      17             :  * floor(x)
      18             :  * Return x rounded toward -inf to integral value
      19             :  * Method:
      20             :  *      Bit twiddling.
      21             :  * Exception:
      22             :  *      Inexact flag raised if x not equal to floor(x).
      23             :  */
      24             : 
      25             : #include <float.h>
      26             : 
      27             : #include "math_private.h"
      28             : 
      29             : static const double huge = 1.0e300;
      30             : 
      31             : double
      32          38 : floor(double x)
      33             : {
      34             :         int32_t i0,i1,j0;
      35             :         u_int32_t i,j;
      36          38 :         EXTRACT_WORDS(i0,i1,x);
      37          38 :         j0 = ((i0>>20)&0x7ff)-0x3ff;
      38          38 :         if(j0<20) {
      39          33 :             if(j0<0) {       /* raise inexact if x != 0 */
      40           1 :                 if(huge+x>0.0) {/* return 0*sign(x) if |x|<1 */
      41           1 :                     if(i0>=0) {i0=i1=0;}
      42           0 :                     else if(((i0&0x7fffffff)|i1)!=0)
      43           0 :                         { i0=0xbff00000;i1=0;}
      44             :                 }
      45             :             } else {
      46          32 :                 i = (0x000fffff)>>j0;
      47          32 :                 if(((i0&i)|i1)==0) return x; /* x is integral */
      48          32 :                 if(huge+x>0.0) {     /* raise inexact flag */
      49          32 :                     if(i0<0) i0 += (0x00100000)>>j0;
      50          32 :                     i0 &= (~i); i1=0;
      51             :                 }
      52             :             }
      53           5 :         } else if (j0>51) {
      54           0 :             if(j0==0x400) return x+x;   /* inf or NaN */
      55           0 :             else return x;              /* x is integral */
      56             :         } else {
      57           5 :             i = ((u_int32_t)(0xffffffff))>>(j0-20);
      58           5 :             if((i1&i)==0) return x; /* x is integral */
      59           5 :             if(huge+x>0.0) {                 /* raise inexact flag */
      60           5 :                 if(i0<0) {
      61           0 :                     if(j0==20) i0+=1;
      62             :                     else {
      63           0 :                         j = i1+(1<<(52-j0));
      64           0 :                         if(j<i1) i0 +=1 ;    /* got a carry */
      65           0 :                         i1=j;
      66             :                     }
      67             :                 }
      68           5 :                 i1 &= (~i);
      69             :             }
      70             :         }
      71          38 :         INSERT_WORDS(x,i0,i1);
      72          38 :         return x;
      73             : }