| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459 |
- /* x87-backed math for the ring-3 libc.
- *
- * The target is i586 with -mno-sse, so double arithmetic is x87 anyway. The
- * transcendental routines use the x87 instructions with an explicit range
- * reduction for the trigonometric functions. Accuracy is a double-rounding
- * compromise, not a full fdlibm port. */
- #include <math.h>
- #include <float.h>
- #define PI 3.14159265358979323846
- #define LOG2E 1.44269504088896340736
- #define LN2 0.69314718055994530942
- static double round_mode(double x, unsigned int mode)
- {
- unsigned short cw, old;
- double r;
- if (__builtin_isnan(x) || __builtin_isinf(x) || x == 0.0)
- return x;
- __asm__ volatile ("fnstcw %0" : "=m"(cw));
- old = cw;
- cw = (unsigned short)((cw & ~0x0C00u) | (mode << 10));
- __asm__ volatile ("fldcw %0" : : "m"(cw));
- __asm__ volatile ("fldl %1; frndint; fstpl %0" : "=m"(r) : "m"(x));
- __asm__ volatile ("fldcw %0" : : "m"(old));
- return r;
- }
- double fabs(double x)
- {
- union {
- double d;
- unsigned long long u;
- } v;
- v.d = x;
- v.u &= 0x7fffffffffffffffULL;
- return v.d;
- }
- double floor(double x)
- {
- return round_mode(x, 1);
- }
- double ceil(double x)
- {
- return round_mode(x, 2);
- }
- double trunc(double x)
- {
- return round_mode(x, 3);
- }
- double round(double x)
- {
- if (__builtin_isnan(x) || __builtin_isinf(x))
- return x;
- /* Above 2^52 every double is already an integer. */
- if (fabs(x) >= 4503599627370496.0)
- return x;
- if (x >= 0.0)
- return floor(x + 0.5);
- return ceil(x - 0.5);
- }
- double sqrt(double x)
- {
- double r;
- __asm__ volatile ("fldl %1; fsqrt; fstpl %0" : "=m"(r) : "m"(x));
- return r;
- }
- double fmod(double x, double y)
- {
- double r;
- __asm__ volatile (
- "fldl %2\n\t"
- "fldl %1\n\t"
- "1:\n\t"
- "fprem\n\t"
- "fnstsw %%ax\n\t"
- "testw $0x400, %%ax\n\t"
- "jnz 1b\n\t"
- "fstp %%st(1)\n\t"
- "fstpl %0"
- : "=m"(r) : "m"(x), "m"(y) : "ax");
- return r;
- }
- double log(double x)
- {
- double r;
- __asm__ volatile ("fldln2; fldl %1; fyl2x; fstpl %0"
- : "=m"(r) : "m"(x));
- return r;
- }
- double log10(double x)
- {
- double r;
- __asm__ volatile ("fldlg2; fldl %1; fyl2x; fstpl %0"
- : "=m"(r) : "m"(x));
- return r;
- }
- double ldexp(double x, int exp)
- {
- double r;
- __asm__ volatile (
- "fildl %1\n\t"
- "fldl %2\n\t"
- "fscale\n\t"
- "fstp %%st(1)\n\t"
- "fstpl %0"
- : "=m"(r) : "m"(exp), "m"(x));
- return r;
- }
- double exp(double x)
- {
- double y, n, f, p;
- if (__builtin_isnan(x))
- return x;
- if (x > 709.782712893384)
- return INFINITY;
- if (x < -745.133219101941)
- return 0.0;
- y = x * LOG2E;
- n = floor(y);
- f = y - n;
- __asm__ volatile ("fldl %1; f2xm1; fld1; faddp; fstpl %0"
- : "=m"(p) : "m"(f));
- return ldexp(p, (int)n);
- }
- double pow(double x, double y)
- {
- int neg = 0;
- double r;
- if (y == 0.0)
- return 1.0;
- if (x == 1.0)
- return 1.0;
- if (__builtin_isnan(x) || __builtin_isnan(y))
- return NAN;
- if (x == 0.0) {
- if (y < 0.0)
- return INFINITY;
- return 0.0;
- }
- if (x < 0.0) {
- double yi = floor(y);
- if (yi != y)
- return NAN;
- x = -x;
- if (fmod(yi, 2.0) != 0.0)
- neg = 1;
- }
- /* Small integer powers are common in JavaScript and stay exact. */
- if (y == floor(y) && y >= -64.0 && y <= 64.0) {
- int n = (int)y;
- int e = n < 0 ? -n : n;
- r = 1.0;
- while (e) {
- if (e & 1)
- r *= x;
- x *= x;
- e >>= 1;
- }
- if (n < 0)
- r = 1.0 / r;
- } else {
- r = exp(y * log(x));
- }
- return neg ? -r : r;
- }
- double sin(double x)
- {
- double r;
- /* The x87 reduction uses a 66-bit pi internally; pre-reducing with a
- * double 2*pi would lose more phase for large arguments. */
- __asm__ volatile ("fldl %1; fsin; fstpl %0" : "=m"(r) : "m"(x));
- return r;
- }
- double cos(double x)
- {
- double r;
- __asm__ volatile ("fldl %1; fcos; fstpl %0" : "=m"(r) : "m"(x));
- return r;
- }
- double tan(double x)
- {
- double r;
- __asm__ volatile ("fldl %1; fptan; fstp %%st(0); fstpl %0"
- : "=m"(r) : "m"(x));
- return r;
- }
- double atan(double x)
- {
- double r;
- __asm__ volatile ("fldl %1; fld1; fpatan; fstpl %0"
- : "=m"(r) : "m"(x));
- return r;
- }
- double atan2(double y, double x)
- {
- double r;
- __asm__ volatile ("fldl %1; fldl %2; fpatan; fstpl %0"
- : "=m"(r) : "m"(y), "m"(x));
- return r;
- }
- double asin(double x)
- {
- if (x > 1.0 || x < -1.0)
- return NAN;
- return atan2(x, sqrt(1.0 - x * x));
- }
- double acos(double x)
- {
- if (x > 1.0 || x < -1.0)
- return NAN;
- return atan2(sqrt(1.0 - x * x), x);
- }
- double fmin(double x, double y)
- {
- if (__builtin_isnan(x))
- return y;
- if (__builtin_isnan(y))
- return x;
- return x < y ? x : y;
- }
- double fmax(double x, double y)
- {
- if (__builtin_isnan(x))
- return y;
- if (__builtin_isnan(y))
- return x;
- return x > y ? x : y;
- }
- double copysign(double x, double y)
- {
- union {
- double d;
- unsigned long long u;
- } a, b;
- a.d = x;
- b.d = y;
- a.u = (a.u & 0x7fffffffffffffffULL) |
- (b.u & 0x8000000000000000ULL);
- return a.d;
- }
- double frexp(double x, int *exp)
- {
- union {
- double d;
- unsigned long long u;
- } v;
- unsigned long long bits;
- unsigned int e;
- int extra = 0;
- if (__builtin_isnan(x) || __builtin_isinf(x) || x == 0.0) {
- if (exp)
- *exp = 0;
- return x;
- }
- if (fabs(x) < DBL_MIN) {
- x *= 18446744073709551616.0; /* 2^64 */
- extra = 64;
- }
- v.d = x;
- bits = v.u;
- e = (unsigned int)((bits >> 52) & 0x7ffu);
- if (exp)
- *exp = (int)e - 1022 - extra;
- bits = (bits & 0x800fffffffffffffULL) | (1022ULL << 52);
- v.u = bits;
- return v.d;
- }
- double modf(double x, double *iptr)
- {
- double ip = trunc(x);
- if (iptr)
- *iptr = ip;
- return x - ip;
- }
- /* ---- C99 additions used by QuickJS's Math object ---- */
- #define M_LN2_D 0.69314718055994530942
- double hypot(double x, double y)
- {
- double a = fabs(x), b = fabs(y), r;
- if (__builtin_isinf(a) || __builtin_isinf(b))
- return INFINITY;
- if (__builtin_isnan(a) || __builtin_isnan(b))
- return NAN;
- if (a < b) {
- r = a;
- a = b;
- b = r;
- }
- if (a == 0.0)
- return 0.0;
- r = b / a;
- return a * sqrt(1.0 + r * r);
- }
- double cbrt(double x)
- {
- double a = fabs(x), y;
- if (a == 0.0 || __builtin_isinf(a) || __builtin_isnan(a))
- return x;
- y = pow(a, 1.0 / 3.0);
- y = y - (y * y * y - a) / (3.0 * y * y); /* one Newton step */
- return x < 0 ? -y : y;
- }
- double log2(double x)
- {
- int e;
- double m;
- if (!(x > 0.0) || __builtin_isinf(x))
- return log(x) / M_LN2_D;
- m = frexp(x, &e); /* x = m * 2^e, m in [0.5, 1) */
- if (m == 0.5)
- return (double)(e - 1);
- return (double)e + log(m) / M_LN2_D;
- }
- double log1p(double x)
- {
- double u;
- if (fabs(x) < 1e-4)
- return x - x * x / 2.0 + x * x * x / 3.0;
- u = 1.0 + x;
- if (u == 1.0)
- return x;
- return log(u) - ((u - 1.0) - x) / u;
- }
- double expm1(double x)
- {
- double u, um1;
- if (fabs(x) < 1e-5)
- return x + x * x / 2.0 + x * x * x / 6.0;
- u = exp(x);
- if (u == 1.0)
- return x;
- um1 = u - 1.0;
- if (um1 == -1.0)
- return -1.0;
- if (__builtin_isinf(u))
- return u;
- return um1 * x / log(u);
- }
- double sinh(double x)
- {
- double t = expm1(fabs(x)), s;
- s = 0.5 * (t + t / (t + 1.0));
- return x < 0 ? -s : s;
- }
- double cosh(double x)
- {
- double e = exp(fabs(x));
- return 0.5 * (e + 1.0 / e);
- }
- double tanh(double x)
- {
- double a = fabs(x), t, r;
- if (a > 22.0)
- r = 1.0;
- else {
- t = expm1(2.0 * a);
- r = t / (t + 2.0);
- }
- return x < 0 ? -r : r;
- }
- double asinh(double x)
- {
- double a = fabs(x), r;
- r = log1p(a + a * a / (1.0 + sqrt(1.0 + a * a)));
- return x < 0 ? -r : r;
- }
- double acosh(double x)
- {
- if (x < 1.0)
- return NAN;
- return log(x + sqrt(x * x - 1.0));
- }
- double atanh(double x)
- {
- double a = fabs(x), r;
- if (a > 1.0)
- return NAN;
- r = 0.5 * log1p(2.0 * a / (1.0 - a));
- return x < 0 ? -r : r;
- }
- /* Round to nearest, ties to even (the default rounding mode). */
- long lrint(double x)
- {
- double r = round(x);
- if (fabs(x - trunc(x)) == 0.5 && fmod(r, 2.0) != 0.0)
- r -= x < 0 ? -1.0 : 1.0;
- return (long)r;
- }
|