Index: fusl/src/math/fmodf.c |
diff --git a/fusl/src/math/fmodf.c b/fusl/src/math/fmodf.c |
new file mode 100644 |
index 0000000000000000000000000000000000000000..ff58f93365b47a7083678fc4693db293afbb6f46 |
--- /dev/null |
+++ b/fusl/src/math/fmodf.c |
@@ -0,0 +1,65 @@ |
+#include <math.h> |
+#include <stdint.h> |
+ |
+float fmodf(float x, float y) |
+{ |
+ union {float f; uint32_t i;} ux = {x}, uy = {y}; |
+ int ex = ux.i>>23 & 0xff; |
+ int ey = uy.i>>23 & 0xff; |
+ uint32_t sx = ux.i & 0x80000000; |
+ uint32_t i; |
+ uint32_t uxi = ux.i; |
+ |
+ if (uy.i<<1 == 0 || isnan(y) || ex == 0xff) |
+ return (x*y)/(x*y); |
+ if (uxi<<1 <= uy.i<<1) { |
+ if (uxi<<1 == uy.i<<1) |
+ return 0*x; |
+ return x; |
+ } |
+ |
+ /* normalize x and y */ |
+ if (!ex) { |
+ for (i = uxi<<9; i>>31 == 0; ex--, i <<= 1); |
+ uxi <<= -ex + 1; |
+ } else { |
+ uxi &= -1U >> 9; |
+ uxi |= 1U << 23; |
+ } |
+ if (!ey) { |
+ for (i = uy.i<<9; i>>31 == 0; ey--, i <<= 1); |
+ uy.i <<= -ey + 1; |
+ } else { |
+ uy.i &= -1U >> 9; |
+ uy.i |= 1U << 23; |
+ } |
+ |
+ /* x mod y */ |
+ for (; ex > ey; ex--) { |
+ i = uxi - uy.i; |
+ if (i >> 31 == 0) { |
+ if (i == 0) |
+ return 0*x; |
+ uxi = i; |
+ } |
+ uxi <<= 1; |
+ } |
+ i = uxi - uy.i; |
+ if (i >> 31 == 0) { |
+ if (i == 0) |
+ return 0*x; |
+ uxi = i; |
+ } |
+ for (; uxi>>23 == 0; uxi <<= 1, ex--); |
+ |
+ /* scale result up */ |
+ if (ex > 0) { |
+ uxi -= 1U << 23; |
+ uxi |= (uint32_t)ex << 23; |
+ } else { |
+ uxi >>= -ex + 1; |
+ } |
+ uxi |= sx; |
+ ux.i = uxi; |
+ return ux.f; |
+} |