xref: /inferno-os/libmath/fdlibm/s_rint.c (revision 37da2899f40661e3e9631e497da8dc59b971cbd0)
1*37da2899SCharles.Forsyth /* derived from /netlib/fdlibm */
2*37da2899SCharles.Forsyth 
3*37da2899SCharles.Forsyth /* @(#)s_rint.c 1.3 95/01/18 */
4*37da2899SCharles.Forsyth /*
5*37da2899SCharles.Forsyth  * ====================================================
6*37da2899SCharles.Forsyth  * Copyright (C) 1993 by Sun Microsystems, Inc. All rights reserved.
7*37da2899SCharles.Forsyth  *
8*37da2899SCharles.Forsyth  * Developed at SunSoft, a Sun Microsystems, Inc. business.
9*37da2899SCharles.Forsyth  * Permission to use, copy, modify, and distribute this
10*37da2899SCharles.Forsyth  * software is freely granted, provided that this notice
11*37da2899SCharles.Forsyth  * is preserved.
12*37da2899SCharles.Forsyth  * ====================================================
13*37da2899SCharles.Forsyth  */
14*37da2899SCharles.Forsyth 
15*37da2899SCharles.Forsyth /* dummy routine to get around over-eager arm compiler optimization.
16*37da2899SCharles.Forsyth   * Calling this causes a store and reload of floating point numbers
17*37da2899SCharles.Forsyth   */
18*37da2899SCharles.Forsyth 
19*37da2899SCharles.Forsyth void
dummy(void)20*37da2899SCharles.Forsyth dummy(void)
21*37da2899SCharles.Forsyth {
22*37da2899SCharles.Forsyth }
23*37da2899SCharles.Forsyth 
24*37da2899SCharles.Forsyth 
25*37da2899SCharles.Forsyth /*
26*37da2899SCharles.Forsyth  * rint(x)
27*37da2899SCharles.Forsyth  * Return x rounded to integral value according to the prevailing
28*37da2899SCharles.Forsyth  * rounding mode.
29*37da2899SCharles.Forsyth  * Method:
30*37da2899SCharles.Forsyth  *	Using floating addition.
31*37da2899SCharles.Forsyth  * Exception:
32*37da2899SCharles.Forsyth  *	Inexact flag raised if x not equal to rint(x).
33*37da2899SCharles.Forsyth  */
34*37da2899SCharles.Forsyth 
35*37da2899SCharles.Forsyth #include "fdlibm.h"
36*37da2899SCharles.Forsyth 
37*37da2899SCharles.Forsyth static const double
38*37da2899SCharles.Forsyth TWO52[2]={
39*37da2899SCharles.Forsyth   4.50359962737049600000e+15, /* 0x43300000, 0x00000000 */
40*37da2899SCharles.Forsyth  -4.50359962737049600000e+15, /* 0xC3300000, 0x00000000 */
41*37da2899SCharles.Forsyth };
42*37da2899SCharles.Forsyth 
rint(double x)43*37da2899SCharles.Forsyth 	double rint(double x)
44*37da2899SCharles.Forsyth {
45*37da2899SCharles.Forsyth 	int i0,j0,sx;
46*37da2899SCharles.Forsyth 	unsigned i,i1;
47*37da2899SCharles.Forsyth 	double w,t;
48*37da2899SCharles.Forsyth 	i0 =  __HI(x);
49*37da2899SCharles.Forsyth 	sx = (i0>>31)&1;
50*37da2899SCharles.Forsyth 	i1 =  __LO(x);
51*37da2899SCharles.Forsyth 	j0 = ((i0>>20)&0x7ff)-0x3ff;
52*37da2899SCharles.Forsyth 	if(j0<20) {
53*37da2899SCharles.Forsyth 	    if(j0<0) {
54*37da2899SCharles.Forsyth 		if(((i0&0x7fffffff)|i1)==0) return x;
55*37da2899SCharles.Forsyth 		i1 |= (i0&0x0fffff);
56*37da2899SCharles.Forsyth 		i0 &= 0xfffe0000;
57*37da2899SCharles.Forsyth 		i0 |= ((i1|-i1)>>12)&0x80000;
58*37da2899SCharles.Forsyth 		__HI(x)=i0;
59*37da2899SCharles.Forsyth 	        w = TWO52[sx]+x;
60*37da2899SCharles.Forsyth                  dummy();			/* fix optimiser */
61*37da2899SCharles.Forsyth 	        t =  w-TWO52[sx];
62*37da2899SCharles.Forsyth 	        i0 = __HI(t);
63*37da2899SCharles.Forsyth 	        __HI(t) = (i0&0x7fffffff)|(sx<<31);
64*37da2899SCharles.Forsyth 	        return t;
65*37da2899SCharles.Forsyth 	    } else {
66*37da2899SCharles.Forsyth 		i = (0x000fffff)>>j0;
67*37da2899SCharles.Forsyth 		if(((i0&i)|i1)==0) return x; /* x is integral */
68*37da2899SCharles.Forsyth 		i>>=1;
69*37da2899SCharles.Forsyth 		if(((i0&i)|i1)!=0) {
70*37da2899SCharles.Forsyth 		    if(j0==19) i1 = 0x40000000; else
71*37da2899SCharles.Forsyth 		    i0 = (i0&(~i))|((0x20000)>>j0);
72*37da2899SCharles.Forsyth 		}
73*37da2899SCharles.Forsyth 	    }
74*37da2899SCharles.Forsyth 	} else if (j0>51) {
75*37da2899SCharles.Forsyth 	    if(j0==0x400) return x+x;	/* inf or NaN */
76*37da2899SCharles.Forsyth 	    else return x;		/* x is integral */
77*37da2899SCharles.Forsyth 	} else {
78*37da2899SCharles.Forsyth 	    i = ((unsigned)(0xffffffff))>>(j0-20);
79*37da2899SCharles.Forsyth 	    if((i1&i)==0) return x;	/* x is integral */
80*37da2899SCharles.Forsyth 	    i>>=1;
81*37da2899SCharles.Forsyth 	    if((i1&i)!=0) i1 = (i1&(~i))|((0x40000000)>>(j0-20));
82*37da2899SCharles.Forsyth 	}
83*37da2899SCharles.Forsyth 	__HI(x) = i0;
84*37da2899SCharles.Forsyth 	__LO(x) = i1;
85*37da2899SCharles.Forsyth 	w = TWO52[sx]+x;
86*37da2899SCharles.Forsyth 	dummy();			/* fix optimiser */
87*37da2899SCharles.Forsyth 	return w-TWO52[sx];
88*37da2899SCharles.Forsyth }
89