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