123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129 |
- #include <math.h>
- #include "math_private.h"
- static const long double one = 1.0, Zero[] = {0.0, -0.0,};
- long double
- fmodl(long double x, long double y)
- {
- int64_t n,hx,hy,hz,ix,iy,sx,i;
- u_int64_t lx,ly,lz;
- GET_LDOUBLE_WORDS64(hx,lx,x);
- GET_LDOUBLE_WORDS64(hy,ly,y);
- sx = hx&0x8000000000000000ULL;
- hx ^=sx;
- hy &= 0x7fffffffffffffffLL;
-
- if((hy|ly)==0||(hx>=0x7fff000000000000LL)||
- ((hy|((ly|-ly)>>63))>0x7fff000000000000LL))
- return (x*y)/(x*y);
- if(hx<=hy) {
- if((hx<hy)||(lx<ly)) return x;
- if(lx==ly)
- return Zero[(u_int64_t)sx>>63];
- }
-
- if(hx<0x0001000000000000LL) {
- if(hx==0) {
- for (ix = -16431, i=lx; i>0; i<<=1) ix -=1;
- } else {
- for (ix = -16382, i=hx<<15; i>0; i<<=1) ix -=1;
- }
- } else ix = (hx>>48)-0x3fff;
-
- if(hy<0x0001000000000000LL) {
- if(hy==0) {
- for (iy = -16431, i=ly; i>0; i<<=1) iy -=1;
- } else {
- for (iy = -16382, i=hy<<15; i>0; i<<=1) iy -=1;
- }
- } else iy = (hy>>48)-0x3fff;
-
- if(ix >= -16382)
- hx = 0x0001000000000000LL|(0x0000ffffffffffffLL&hx);
- else {
- n = -16382-ix;
- if(n<=63) {
- hx = (hx<<n)|(lx>>(64-n));
- lx <<= n;
- } else {
- hx = lx<<(n-64);
- lx = 0;
- }
- }
- if(iy >= -16382)
- hy = 0x0001000000000000LL|(0x0000ffffffffffffLL&hy);
- else {
- n = -16382-iy;
- if(n<=63) {
- hy = (hy<<n)|(ly>>(64-n));
- ly <<= n;
- } else {
- hy = ly<<(n-64);
- ly = 0;
- }
- }
-
- n = ix - iy;
- while(n--) {
- hz=hx-hy;lz=lx-ly; if(lx<ly) hz -= 1;
- if(hz<0){hx = hx+hx+(lx>>63); lx = lx+lx;}
- else {
- if((hz|lz)==0)
- return Zero[(u_int64_t)sx>>63];
- hx = hz+hz+(lz>>63); lx = lz+lz;
- }
- }
- hz=hx-hy;lz=lx-ly; if(lx<ly) hz -= 1;
- if(hz>=0) {hx=hz;lx=lz;}
-
- if((hx|lx)==0)
- return Zero[(u_int64_t)sx>>63];
- while(hx<0x0001000000000000LL) {
- hx = hx+hx+(lx>>63); lx = lx+lx;
- iy -= 1;
- }
- if(iy>= -16382) {
- hx = ((hx-0x0001000000000000LL)|((iy+16383)<<48));
- SET_LDOUBLE_WORDS64(x,hx|sx,lx);
- } else {
- n = -16382 - iy;
- if(n<=48) {
- lx = (lx>>n)|((u_int64_t)hx<<(64-n));
- hx >>= n;
- } else if (n<=63) {
- lx = (hx<<(64-n))|(lx>>n); hx = sx;
- } else {
- lx = hx>>(n-64); hx = sx;
- }
- SET_LDOUBLE_WORDS64(x,hx|sx,lx);
- x *= one;
- }
- return x;
- }
|