25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * CDDL HEADER START
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * The contents of this file are subject to the terms of the
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Common Development and Distribution License (the "License").
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * You may not use this file except in compliance with the License.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * or http://www.opensolaris.org/os/licensing.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * See the License for the specific language governing permissions
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * and limitations under the License.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * When distributing Covered Code, include this CDDL HEADER in each
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * If applicable, add the following below this CDDL HEADER, with the
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * fields enclosed by brackets "[]" replaced with your own identifying
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * information: Portions Copyright [yyyy] [name of copyright owner]
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * CDDL HEADER END
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Copyright 2011 Nexenta Systems, Inc. All rights reserved.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Copyright 2006 Sun Microsystems, Inc. All rights reserved.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Use is subject to license terms.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
ddc0e0b53c661f6e439e3b7072b3ef353eadb4afRichard Lowe#pragma weak __hypotl = hypotl
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * long double hypotl(long double x, long double y);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Method :
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * If z=x*x+y*y has error less than sqrt(2)/2 ulp than sqrt(z) has
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * error less than 1 ulp.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * So, compute sqrt(x*x+y*y) with some care as follows:
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Assume x>y>0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 1. save and set rounding to round-to-nearest
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 2. if x > 2y use
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * x1*x1+(y*y+(x2*(x+x2))) for x*x+y*y
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * where x1 = x with lower 64 bits cleared, x2 = x-x1; else
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 3. if x <= 2y use
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * t1*y1+((x-y)*(x-y)+(t1*y2+t2*y))
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * where t1 = 2x with lower 64 bits cleared, t2 = 2x-t1, y1= y with
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * lower 64 bits chopped, y2 = y-y1.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * NOTE: DO NOT remove parenthsis!
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Special cases:
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * hypot(x,y) is INF if x or y is +INF or -INF; else
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * hypot(x,y) is NAN if x or y is NAN.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Accuracy:
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * hypot(x,y) returns sqrt(x^2+y^2) with error less than 1 ulps (units
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * in the last place)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include "libm.h"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include "longdouble.h"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisextern enum fp_direction_type __swapRD(enum fp_direction_type);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisstatic const long double zero = 0.0L, one = 1.0L;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtislong double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtishypotl(long double x, long double y) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int n0, n1, n2, n3;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis long double t1, t2, y1, y2, w;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int *px = (int *) &x, *py = (int *) &y;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int *pt1 = (int *) &t1, *py1 = (int *) &y1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis enum fp_direction_type rd;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int j, k, nx, ny, nz;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if ((*(int *) &one) != 0) { /* determine word ordering */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis n0 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis n1 = 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis n2 = 2;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis n3 = 3;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis n0 = 3;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis n1 = 2;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis n2 = 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis n3 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis px[n0] &= 0x7fffffff; /* clear sign bit of x and y */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis py[n0] &= 0x7fffffff;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis k = 0x7fff0000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis nx = px[n0] & k; /* exponent of x and y */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ny = py[n0] & k;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (ny > nx) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis w = x;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x = y;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis y = w;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis nz = ny;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ny = nx;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis nx = nz;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } /* force x > y */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if ((nx - ny) >= 0x00730000)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (x + y); /* x/y >= 2**116 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (nx < 0x5ff30000 && ny > 0x205b0000) { /* medium x,y */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* save and set RD to Rounding to nearest */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis rd = __swapRD(fp_nearest);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis w = x - y;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (w > y) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pt1[n0] = px[n0];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pt1[n1] = px[n1];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pt1[n2] = pt1[n3] = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis t2 = x - t1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x = sqrtl(t1 * t1 - (y * (-y) - t2 * (x + t1)));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x = x + x;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis py1[n0] = py[n0];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis py1[n1] = py[n1];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis py1[n2] = py1[n3] = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis y2 = y - y1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pt1[n0] = px[n0];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pt1[n1] = px[n1];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pt1[n2] = pt1[n3] = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis t2 = x - t1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x = sqrtl(t1 * y1 - (w * (-w) - (t2 * y1 + y2 * x)));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (rd != fp_nearest)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis (void) __swapRD(rd); /* restore rounding mode */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (x);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (nx == k || ny == k) { /* x or y is INF or NaN */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (isinfl(x))
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis t2 = x;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis else if (isinfl(y))
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis t2 = y;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis else
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis t2 = x + y; /* invalid if x or y is sNaN */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (t2);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (ny == 0) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (y == zero || x == zero)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (x + y);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis t1 = scalbnl(one, 16381);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x *= t1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis y *= t1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (scalbnl(one, -16381) * hypotl(x, y));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis j = nx - 0x3fff0000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis px[n0] -= j;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis py[n0] -= j;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pt1[n0] = nx;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pt1[n1] = pt1[n2] = pt1[n3] = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (t1 * hypotl(x, y));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}