11dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project 21dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project/* @(#)e_fmod.c 1.3 95/01/18 */ 31dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project/* 41dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project * ==================================================== 51dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project * Copyright (C) 1993 by Sun Microsystems, Inc. All rights reserved. 61dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project * 71dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project * Developed at SunSoft, a Sun Microsystems, Inc. business. 81dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project * Permission to use, copy, modify, and distribute this 91dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project * software is freely granted, provided that this notice 101dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project * is preserved. 111dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project * ==================================================== 121dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project */ 131dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project 14a0ee07829a9ba7e99ef68e8c12551301cc797f0fElliott Hughes#include <sys/cdefs.h> 15a0ee07829a9ba7e99ef68e8c12551301cc797f0fElliott Hughes__FBSDID("$FreeBSD$"); 161dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project 171dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project/* 181dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project * __ieee754_fmod(x,y) 191dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project * Return x mod y in exact arithmetic 201dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project * Method: shift and subtract 211dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project */ 221dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project 231dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project#include "math.h" 241dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project#include "math_private.h" 251dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project 261dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Projectstatic const double one = 1.0, Zero[] = {0.0, -0.0,}; 271dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project 281dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Projectdouble 291dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project__ieee754_fmod(double x, double y) 301dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project{ 311dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project int32_t n,hx,hy,hz,ix,iy,sx,i; 321dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project u_int32_t lx,ly,lz; 331dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project 341dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project EXTRACT_WORDS(hx,lx,x); 351dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project EXTRACT_WORDS(hy,ly,y); 361dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project sx = hx&0x80000000; /* sign of x */ 371dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hx ^=sx; /* |x| */ 381dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hy &= 0x7fffffff; /* |y| */ 391dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project 401dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project /* purge off exception values */ 411dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if((hy|ly)==0||(hx>=0x7ff00000)|| /* y=0,or x not finite */ 421dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project ((hy|((ly|-ly)>>31))>0x7ff00000)) /* or y is NaN */ 431dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project return (x*y)/(x*y); 441dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(hx<=hy) { 451dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if((hx<hy)||(lx<ly)) return x; /* |x|<|y| return x */ 461dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(lx==ly) 471dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project return Zero[(u_int32_t)sx>>31]; /* |x|=|y| return x*0*/ 481dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } 491dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project 501dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project /* determine ix = ilogb(x) */ 511dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(hx<0x00100000) { /* subnormal x */ 521dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(hx==0) { 531dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project for (ix = -1043, i=lx; i>0; i<<=1) ix -=1; 541dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } else { 551dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project for (ix = -1022,i=(hx<<11); i>0; i<<=1) ix -=1; 561dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } 571dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } else ix = (hx>>20)-1023; 581dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project 591dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project /* determine iy = ilogb(y) */ 601dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(hy<0x00100000) { /* subnormal y */ 611dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(hy==0) { 621dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project for (iy = -1043, i=ly; i>0; i<<=1) iy -=1; 631dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } else { 641dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project for (iy = -1022,i=(hy<<11); i>0; i<<=1) iy -=1; 651dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } 661dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } else iy = (hy>>20)-1023; 671dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project 681dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project /* set up {hx,lx}, {hy,ly} and align y to x */ 691dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(ix >= -1022) 701dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hx = 0x00100000|(0x000fffff&hx); 711dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project else { /* subnormal x, shift x to normal */ 721dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project n = -1022-ix; 731dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(n<=31) { 741dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hx = (hx<<n)|(lx>>(32-n)); 751dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project lx <<= n; 761dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } else { 771dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hx = lx<<(n-32); 781dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project lx = 0; 791dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } 801dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } 811dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(iy >= -1022) 821dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hy = 0x00100000|(0x000fffff&hy); 831dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project else { /* subnormal y, shift y to normal */ 841dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project n = -1022-iy; 851dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(n<=31) { 861dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hy = (hy<<n)|(ly>>(32-n)); 871dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project ly <<= n; 881dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } else { 891dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hy = ly<<(n-32); 901dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project ly = 0; 911dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } 921dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } 931dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project 941dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project /* fix point fmod */ 951dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project n = ix - iy; 961dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project while(n--) { 971dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hz=hx-hy;lz=lx-ly; if(lx<ly) hz -= 1; 981dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(hz<0){hx = hx+hx+(lx>>31); lx = lx+lx;} 991dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project else { 1001dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if((hz|lz)==0) /* return sign(x)*0 */ 1011dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project return Zero[(u_int32_t)sx>>31]; 1021dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hx = hz+hz+(lz>>31); lx = lz+lz; 1031dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } 1041dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } 1051dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hz=hx-hy;lz=lx-ly; if(lx<ly) hz -= 1; 1061dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(hz>=0) {hx=hz;lx=lz;} 1071dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project 1081dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project /* convert back to floating value and restore the sign */ 1091dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if((hx|lx)==0) /* return sign(x)*0 */ 1101dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project return Zero[(u_int32_t)sx>>31]; 1111dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project while(hx<0x00100000) { /* normalize x */ 1121dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hx = hx+hx+(lx>>31); lx = lx+lx; 1131dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project iy -= 1; 1141dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } 1151dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(iy>= -1022) { /* normalize output */ 1161dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hx = ((hx-0x00100000)|((iy+1023)<<20)); 1171dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project INSERT_WORDS(x,hx|sx,lx); 1181dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } else { /* subnormal output */ 1191dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project n = -1022 - iy; 1201dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project if(n<=20) { 1211dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project lx = (lx>>n)|((u_int32_t)hx<<(32-n)); 1221dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project hx >>= n; 1231dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } else if (n<=31) { 1241dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project lx = (hx<<(32-n))|(lx>>n); hx = sx; 1251dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } else { 1261dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project lx = hx>>(n-32); hx = sx; 1271dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } 1281dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project INSERT_WORDS(x,hx|sx,lx); 1291dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project x *= one; /* create necessary signal */ 1301dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project } 1311dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project return x; /* exact output */ 1321dc9e472e19acfe6dc7f41e429236e7eef7ceda1The Android Open Source Project} 133