method: if there is a large difference between the scale of x and y then the larger magnitude dominates, otherwise reduce x,y so the argument of sqrt (x*x+y*y) does not overflow or underflow and calculate the argument precisely using exact multiplication. If the argument has less error than 1/sqrt(2) ~ 0.7 ulp, then the result has less error than 1 ulp in nearest rounding mode. the original fdlibm method was the same, except it used bit hacks instead of dekker-veltkamp algorithm, which is problematic for long double where different representations are supported. (the new hypot and hypotl code should be smaller and faster on 32bit cpu archs with fast fpu), the new code behaves differently in non-nearest rounding, but the error should be still less than 2ulps. ld80 and ld128 are supported
68 lines
1.3 KiB
C
68 lines
1.3 KiB
C
#include <math.h>
|
|
#include <stdint.h>
|
|
#include <float.h>
|
|
|
|
#if FLT_EVAL_METHOD > 1U && LDBL_MANT_DIG == 64
|
|
#define SPLIT (0x1p32 + 1)
|
|
#else
|
|
#define SPLIT (0x1p27 + 1)
|
|
#endif
|
|
|
|
static void sq(double_t *hi, double_t *lo, double x)
|
|
{
|
|
double_t xh, xl, xc;
|
|
|
|
xc = x*SPLIT;
|
|
xh = x - xc + xc;
|
|
xl = x - xh;
|
|
*hi = x*x;
|
|
*lo = xh*xh - *hi + 2*xh*xl + xl*xl;
|
|
}
|
|
|
|
double hypot(double x, double y)
|
|
{
|
|
union {double f; uint64_t i;} ux = {x}, uy = {y}, ut;
|
|
int ex, ey;
|
|
double_t hx, lx, hy, ly, z;
|
|
|
|
/* arrange |x| >= |y| */
|
|
ux.i &= -1ULL>>1;
|
|
uy.i &= -1ULL>>1;
|
|
if (ux.i < uy.i) {
|
|
ut = ux;
|
|
ux = uy;
|
|
uy = ut;
|
|
}
|
|
|
|
/* special cases */
|
|
ex = ux.i>>52;
|
|
ey = uy.i>>52;
|
|
x = ux.f;
|
|
y = uy.f;
|
|
/* note: hypot(inf,nan) == inf */
|
|
if (ey == 0x7ff)
|
|
return y;
|
|
if (ex == 0x7ff || uy.i == 0)
|
|
return x;
|
|
/* note: hypot(x,y) ~= x + y*y/x/2 with inexact for small y/x */
|
|
/* 64 difference is enough for ld80 double_t */
|
|
if (ex - ey > 64)
|
|
return x + y;
|
|
|
|
/* precise sqrt argument in nearest rounding mode without overflow */
|
|
/* xh*xh must not overflow and xl*xl must not underflow in sq */
|
|
z = 1;
|
|
if (ex > 0x3ff+510) {
|
|
z = 0x1p700;
|
|
x *= 0x1p-700;
|
|
y *= 0x1p-700;
|
|
} else if (ey < 0x3ff-450) {
|
|
z = 0x1p-700;
|
|
x *= 0x1p700;
|
|
y *= 0x1p700;
|
|
}
|
|
sq(&hx, &lx, x);
|
|
sq(&hy, &ly, y);
|
|
return z*sqrt(ly+lx+hy+hx);
|
|
}
|