xref: /freebsd/lib/msun/src/s_floor.c (revision 3a8617a83f16ffc9db4f96e1f0f21af94078e6b1)
13a8617a8SJordan K. Hubbard /* @(#)s_floor.c 5.1 93/09/24 */
23a8617a8SJordan K. Hubbard /*
33a8617a8SJordan K. Hubbard  * ====================================================
43a8617a8SJordan K. Hubbard  * Copyright (C) 1993 by Sun Microsystems, Inc. All rights reserved.
53a8617a8SJordan K. Hubbard  *
63a8617a8SJordan K. Hubbard  * Developed at SunPro, a Sun Microsystems, Inc. business.
73a8617a8SJordan K. Hubbard  * Permission to use, copy, modify, and distribute this
83a8617a8SJordan K. Hubbard  * software is freely granted, provided that this notice
93a8617a8SJordan K. Hubbard  * is preserved.
103a8617a8SJordan K. Hubbard  * ====================================================
113a8617a8SJordan K. Hubbard  */
123a8617a8SJordan K. Hubbard 
133a8617a8SJordan K. Hubbard #ifndef lint
143a8617a8SJordan K. Hubbard static char rcsid[] = "$Id: s_floor.c,v 1.6 1994/08/18 23:06:47 jtc Exp $";
153a8617a8SJordan K. Hubbard #endif
163a8617a8SJordan K. Hubbard 
173a8617a8SJordan K. Hubbard /*
183a8617a8SJordan K. Hubbard  * floor(x)
193a8617a8SJordan K. Hubbard  * Return x rounded toward -inf to integral value
203a8617a8SJordan K. Hubbard  * Method:
213a8617a8SJordan K. Hubbard  *	Bit twiddling.
223a8617a8SJordan K. Hubbard  * Exception:
233a8617a8SJordan K. Hubbard  *	Inexact flag raised if x not equal to floor(x).
243a8617a8SJordan K. Hubbard  */
253a8617a8SJordan K. Hubbard 
263a8617a8SJordan K. Hubbard #include "math.h"
273a8617a8SJordan K. Hubbard #include "math_private.h"
283a8617a8SJordan K. Hubbard 
293a8617a8SJordan K. Hubbard #ifdef __STDC__
303a8617a8SJordan K. Hubbard static const double huge = 1.0e300;
313a8617a8SJordan K. Hubbard #else
323a8617a8SJordan K. Hubbard static double huge = 1.0e300;
333a8617a8SJordan K. Hubbard #endif
343a8617a8SJordan K. Hubbard 
353a8617a8SJordan K. Hubbard #ifdef __STDC__
363a8617a8SJordan K. Hubbard 	double floor(double x)
373a8617a8SJordan K. Hubbard #else
383a8617a8SJordan K. Hubbard 	double floor(x)
393a8617a8SJordan K. Hubbard 	double x;
403a8617a8SJordan K. Hubbard #endif
413a8617a8SJordan K. Hubbard {
423a8617a8SJordan K. Hubbard 	int32_t i0,i1,j0;
433a8617a8SJordan K. Hubbard 	u_int32_t i,j;
443a8617a8SJordan K. Hubbard 	EXTRACT_WORDS(i0,i1,x);
453a8617a8SJordan K. Hubbard 	j0 = ((i0>>20)&0x7ff)-0x3ff;
463a8617a8SJordan K. Hubbard 	if(j0<20) {
473a8617a8SJordan K. Hubbard 	    if(j0<0) { 	/* raise inexact if x != 0 */
483a8617a8SJordan K. Hubbard 		if(huge+x>0.0) {/* return 0*sign(x) if |x|<1 */
493a8617a8SJordan K. Hubbard 		    if(i0>=0) {i0=i1=0;}
503a8617a8SJordan K. Hubbard 		    else if(((i0&0x7fffffff)|i1)!=0)
513a8617a8SJordan K. Hubbard 			{ i0=0xbff00000;i1=0;}
523a8617a8SJordan K. Hubbard 		}
533a8617a8SJordan K. Hubbard 	    } else {
543a8617a8SJordan K. Hubbard 		i = (0x000fffff)>>j0;
553a8617a8SJordan K. Hubbard 		if(((i0&i)|i1)==0) return x; /* x is integral */
563a8617a8SJordan K. Hubbard 		if(huge+x>0.0) {	/* raise inexact flag */
573a8617a8SJordan K. Hubbard 		    if(i0<0) i0 += (0x00100000)>>j0;
583a8617a8SJordan K. Hubbard 		    i0 &= (~i); i1=0;
593a8617a8SJordan K. Hubbard 		}
603a8617a8SJordan K. Hubbard 	    }
613a8617a8SJordan K. Hubbard 	} else if (j0>51) {
623a8617a8SJordan K. Hubbard 	    if(j0==0x400) return x+x;	/* inf or NaN */
633a8617a8SJordan K. Hubbard 	    else return x;		/* x is integral */
643a8617a8SJordan K. Hubbard 	} else {
653a8617a8SJordan K. Hubbard 	    i = ((u_int32_t)(0xffffffff))>>(j0-20);
663a8617a8SJordan K. Hubbard 	    if((i1&i)==0) return x;	/* x is integral */
673a8617a8SJordan K. Hubbard 	    if(huge+x>0.0) { 		/* raise inexact flag */
683a8617a8SJordan K. Hubbard 		if(i0<0) {
693a8617a8SJordan K. Hubbard 		    if(j0==20) i0+=1;
703a8617a8SJordan K. Hubbard 		    else {
713a8617a8SJordan K. Hubbard 			j = i1+(1<<(52-j0));
723a8617a8SJordan K. Hubbard 			if(j<i1) i0 +=1 ; 	/* got a carry */
733a8617a8SJordan K. Hubbard 			i1=j;
743a8617a8SJordan K. Hubbard 		    }
753a8617a8SJordan K. Hubbard 		}
763a8617a8SJordan K. Hubbard 		i1 &= (~i);
773a8617a8SJordan K. Hubbard 	    }
783a8617a8SJordan K. Hubbard 	}
793a8617a8SJordan K. Hubbard 	INSERT_WORDS(x,i0,i1);
803a8617a8SJordan K. Hubbard 	return x;
813a8617a8SJordan K. Hubbard }
82