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
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include <sys/isa_defs.h>
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include "libm_inlines.h"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#ifdef _LITTLE_ENDIAN
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define HI(x) *(1+(int*)x)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define LO(x) *(unsigned*)x
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#else
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define HI(x) *(int*)x
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define LO(x) *(1+(unsigned*)x)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#endif
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#ifdef __RESTRICT
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define restrict _Restrict
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#else
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define restrict
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#endif
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/* float rhypotf(float x, float y)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Method :
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 1. Special cases:
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * for x or y = Inf => 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * for x or y = NaN => QNaN;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * for x and y = 0 => +Inf + divide-by-zero;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 2. Computes d = x * x + y * y;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 3. Computes reciprocal square root from:
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * d = m * 2**n
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Where:
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * m = [0.5, 2),
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * n = ((exponent + 1) & ~1).
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Then:
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * rsqrtf(d) = 1/sqrt( m * 2**n ) = (2 ** (-n/2)) * (1/sqrt(m))
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 4. Computes 1/sqrt(m) from:
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 1/sqrt(m) = (1/sqrt(m0)) * (1/sqrt(1 + (1/m0)*dm))
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Where:
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * m = m0 + dm,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * m0 = 0.5 * (1 + k/64) for m = [0.5, 0.5+127/256), k = [0, 63];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * m0 = 1.0 * (0 + k/64) for m = [0.5+127/256, 1.0+127/128), k = [64, 127];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Then:
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 1/sqrt(m0), 1/m0 are looked up in a table,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 1/sqrt(1 + (1/m0)*dm) is computed using approximation:
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 1/sqrt(1 + z) = ((a3 * z + a2) * z + a1) * z + a0
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * where z = [-1/64, 1/64].
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Accuracy:
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * The maximum relative error for the approximating
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * polynomial is 2**(-27.87).
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Maximum error observed: less than 0.535 ulp after 3.000.000.000
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * results.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#pragma align 32 (__vlibm_TBL_rhypotf)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisstatic const double __vlibm_TBL_rhypotf[] = {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis i = [0,63]
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis TBL[2*i+0] = 1.0 / (*(double*)&(0x3ff0000000000000LL + (i << 46)));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis TBL[2*i+1] = (double)(0.5/sqrtl(2) / sqrtl(*(double*)&(0x3ff0000000000000LL + (i << 46))));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis TBL[128+2*i+0] = 1.0 / (*(double*)&(0x3ff0000000000000LL + (i << 46)));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis TBL[128+2*i+1] = (double)(0.25 / sqrtl(*(double*)&(0x3ff0000000000000LL + (i << 46))));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis*/
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 1.0000000000000000000e+00, 3.5355339059327378637e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.8461538461538467004e-01, 3.5082320772281166965e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.6969696969696972388e-01, 3.4815531191139570399e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.5522388059701490715e-01, 3.4554737023254405992e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.4117647058823528106e-01, 3.4299717028501769400e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.2753623188405798228e-01, 3.4050261230349943009e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.1428571428571425717e-01, 3.3806170189140660742e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.0140845070422537244e-01, 3.3567254331867563133e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.8888888888888883955e-01, 3.3333333333333331483e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.7671232876712323900e-01, 3.3104235544094717802e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.6486486486486491287e-01, 3.2879797461071458287e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.5333333333333338810e-01, 3.2659863237109043599e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.4210526315789469010e-01, 3.2444284226152508843e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.3116883116883122362e-01, 3.2232918561015211356e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.2051282051282048435e-01, 3.2025630761017426229e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.1012658227848100001e-01, 3.1822291367029204023e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.0000000000000004441e-01, 3.1622776601683794118e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.9012345679012341293e-01, 3.1426968052735443360e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.8048780487804880757e-01, 3.1234752377721214378e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.7108433734939763049e-01, 3.1046021028253312224e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.6190476190476186247e-01, 3.0860669992418382490e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.5294117647058822484e-01, 3.0678599553894819740e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.4418604651162789665e-01, 3.0499714066520933198e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.3563218390804596680e-01, 3.0323921743156134756e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.2727272727272729291e-01, 3.0151134457776362918e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.1910112359550559802e-01, 2.9981267559834456904e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.1111111111111113825e-01, 2.9814239699997197031e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.0329670329670335160e-01, 2.9649972666444046610e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.9565217391304345895e-01, 2.9488391230979427160e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.8817204301075274309e-01, 2.9329423004270660513e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.8085106382978721751e-01, 2.9172998299578911663e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.7368421052631577428e-01, 2.9019050004400465115e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.6666666666666662966e-01, 2.8867513459481286553e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.5979381443298967813e-01, 2.8718326344709527165e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.5306122448979586625e-01, 2.8571428571428569843e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.4646464646464651960e-01, 2.8426762180748055275e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.4000000000000001332e-01, 2.8284271247461900689e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.3366336633663367106e-01, 2.8143901789211672737e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.2745098039215685404e-01, 2.8005601680560193723e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.2135922330097081989e-01, 2.7869320571664707442e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.1538461538461541878e-01, 2.7735009811261457369e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.0952380952380957879e-01, 2.7602622373694168934e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.0377358490566035432e-01, 2.7472112789737807015e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.9813084112149528249e-01, 2.7343437080986532361e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.9259259259259255970e-01, 2.7216552697590867815e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.8715596330275232617e-01, 2.7091418459143856712e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.8181818181818178992e-01, 2.6967994498529684888e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.7657657657657657158e-01, 2.6846242208560971987e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.7142857142857139685e-01, 2.6726124191242439654e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.6637168141592919568e-01, 2.6607604209509572168e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.6140350877192979340e-01, 2.6490647141300877054e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.5652173913043478937e-01, 2.6375218935831479250e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.5172413793103447510e-01, 2.6261286571944508772e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.4700854700854706358e-01, 2.6148818018424535570e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.4237288135593220151e-01, 2.6037782196164771520e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.3781512605042014474e-01, 2.5928148942086576278e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.3333333333333332593e-01, 2.5819888974716115326e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.2892561983471075848e-01, 2.5712973861329002645e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.2459016393442625681e-01, 2.5607375986579195004e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.2032520325203257539e-01, 2.5503068522533534068e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.1612903225806450180e-01, 2.5400025400038100942e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.1200000000000001066e-01, 2.5298221281347033074e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.0793650793650790831e-01, 2.5197631533948483540e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.0393700787401574104e-01, 2.5098232205526344041e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 1.0000000000000000000e+00, 2.5000000000000000000e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.8461538461538467004e-01, 2.4806946917841690703e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.6969696969696972388e-01, 2.4618298195866547551e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.5522388059701490715e-01, 2.4433888871261044695e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.4117647058823528106e-01, 2.4253562503633296910e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.2753623188405798228e-01, 2.4077170617153839660e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.1428571428571425717e-01, 2.3904572186687872426e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 9.0140845070422537244e-01, 2.3735633163877067897e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.8888888888888883955e-01, 2.3570226039551583908e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.7671232876712323900e-01, 2.3408229439226113655e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.6486486486486491287e-01, 2.3249527748763856860e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.5333333333333338810e-01, 2.3094010767585029797e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.4210526315789469010e-01, 2.2941573387056177213e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.3116883116883122362e-01, 2.2792115291927589338e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.2051282051282048435e-01, 2.2645540682891915352e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.1012658227848100001e-01, 2.2501758018520479077e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 8.0000000000000004441e-01, 2.2360679774997896385e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.9012345679012341293e-01, 2.2222222222222220989e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.8048780487804880757e-01, 2.2086305214969309541e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.7108433734939763049e-01, 2.1952851997938069295e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.6190476190476186247e-01, 2.1821789023599238999e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.5294117647058822484e-01, 2.1693045781865616384e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.4418604651162789665e-01, 2.1566554640687682354e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.3563218390804596680e-01, 2.1442250696755896233e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.2727272727272729291e-01, 2.1320071635561044232e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.1910112359550559802e-01, 2.1199957600127200541e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.1111111111111113825e-01, 2.1081851067789195153e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 7.0329670329670335160e-01, 2.0965696734438366011e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.9565217391304345895e-01, 2.0851441405707477061e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.8817204301075274309e-01, 2.0739033894608505104e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.8085106382978721751e-01, 2.0628424925175867233e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.7368421052631577428e-01, 2.0519567041703082322e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.6666666666666662966e-01, 2.0412414523193150862e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.5979381443298967813e-01, 2.0306923302672380549e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.5306122448979586625e-01, 2.0203050891044216364e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.4646464646464651960e-01, 2.0100756305184241945e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.4000000000000001332e-01, 2.0000000000000001110e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.3366336633663367106e-01, 1.9900743804199783060e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.2745098039215685404e-01, 1.9802950859533485772e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.2135922330097081989e-01, 1.9706585563285863860e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.1538461538461541878e-01, 1.9611613513818404453e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.0952380952380957879e-01, 1.9518001458970662965e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 6.0377358490566035432e-01, 1.9425717247145282696e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.9813084112149528249e-01, 1.9334729780913270658e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.9259259259259255970e-01, 1.9245008972987526219e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.8715596330275232617e-01, 1.9156525704423027490e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.8181818181818178992e-01, 1.9069251784911847580e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.7657657657657657158e-01, 1.8983159915049979682e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.7142857142857139685e-01, 1.8898223650461362655e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.6637168141592919568e-01, 1.8814417367671945613e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.6140350877192979340e-01, 1.8731716231633879777e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.5652173913043478937e-01, 1.8650096164806276300e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.5172413793103447510e-01, 1.8569533817705186074e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.4700854700854706358e-01, 1.8490006540840969729e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.4237288135593220151e-01, 1.8411492357966466327e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.3781512605042014474e-01, 1.8333969940564226464e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.3333333333333332593e-01, 1.8257418583505535814e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.2892561983471075848e-01, 1.8181818181818182323e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.2459016393442625681e-01, 1.8107149208503706128e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.2032520325203257539e-01, 1.8033392693348646030e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.1612903225806450180e-01, 1.7960530202677491007e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.1200000000000001066e-01, 1.7888543819998317663e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.0793650793650790831e-01, 1.7817416127494958844e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis 5.0393700787401574104e-01, 1.7747130188322274291e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis};
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisextern float fabsf(float);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisstatic const double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis A0 = 9.99999997962321453275e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis A1 =-4.99999998166077580600e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis A2 = 3.75066768969515586277e-01,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis A3 =-3.12560092408808548438e-01;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisstatic void
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis__vrhypotf_n(int n, float * restrict px, int stridex, float * restrict py,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int stridey, float * restrict pz, int stridez);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#pragma no_inline(__vrhypotf_n)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define RETURN(ret) \
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{ \
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *pz = (ret); \
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pz += stridez; \
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (n_n == 0) \
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis { \
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis spx = px; spy = py; spz = pz; \
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ay0 = *(int*)py; \
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis continue; \
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } \
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis n--; \
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis break; \
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisvoid
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis__vrhypotf(int n, float * restrict px, int stridex, float * restrict py,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int stridey, float * restrict pz, int stridez)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis float *spx, *spy, *spz;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int ax0, ay0, n_n;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis float res, x0, y0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis while (n > 1)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis n_n = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis spx = px;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis spy = py;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis spz = pz;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ax0 = *(int*)px;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ay0 = *(int*)py;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis for (; n > 1 ; n--)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ax0 &= 0x7fffffff;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ay0 &= 0x7fffffff;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis px += stridex;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (ax0 >= 0x7f800000 || ay0 >= 0x7f800000) /* X or Y = NaN or Inf */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x0 = *(px - stridex);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis y0 = *py;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res = fabsf(x0) + fabsf(y0);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (ax0 == 0x7f800000) res = 0.0f;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis else if (ay0 == 0x7f800000) res = 0.0f;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ax0 = *(int*)px;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis py += stridey;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis RETURN (res)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ax0 = *(int*)px;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis py += stridey;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (ay0 == 0) /* Y = 0 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int tx = *(int*)(px - stridex) & 0x7fffffff;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (tx == 0) /* X = 0 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis RETURN (1.0f / 0.0f)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pz += stridez;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis n_n++;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ay0 = *(int*)py;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (n_n > 0)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __vrhypotf_n(n_n, spx, stridex, spy, stridey, spz, stridez);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (n > 0)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ax0 = *(int*)px;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ay0 = *(int*)py;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x0 = *px;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis y0 = *py;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ax0 &= 0x7fffffff;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ay0 &= 0x7fffffff;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (ax0 >= 0x7f800000 || ay0 >= 0x7f800000) /* X or Y = NaN or Inf */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res = fabsf(x0) + fabsf(y0);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (ax0 == 0x7f800000) res = 0.0f;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis else if (ay0 == 0x7f800000) res = 0.0f;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *pz = res;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis else if (ax0 == 0 && ay0 == 0) /* X and Y = 0 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *pz = 1.0f / 0.0f;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis else
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis double xx0, res0, hyp0, h_hi0 = 0, dbase0 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int ibase0, si0, hyp0h;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis hyp0 = x0 * (double)x0 + y0 * (double)y0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ibase0 = HI(&hyp0);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&dbase0) = (0x60000000 - ((ibase0 & 0x7fe00000) >> 1));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis hyp0h = (ibase0 & 0x000fffff) | 0x3ff00000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&hyp0) = hyp0h;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&h_hi0) = hyp0h & 0x7fffc000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ibase0 >>= 10;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis si0 = ibase0 & 0x7f0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx0 = ((double*)((char*)__vlibm_TBL_rhypotf + si0))[0];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx0 = (hyp0 - h_hi0) * xx0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res0 = ((double*)((char*)__vlibm_TBL_rhypotf + si0))[1];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res0 *= (((A3 * xx0 + A2) * xx0 + A1) * xx0 + A0);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res0 *= dbase0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *pz = res0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisstatic void
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis__vrhypotf_n(int n, float * restrict px, int stridex, float * restrict py,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int stridey, float * restrict pz, int stridez)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis double xx0, res0, hyp0, h_hi0 = 0, dbase0 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis double xx1, res1, hyp1, h_hi1 = 0, dbase1 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis double xx2, res2, hyp2, h_hi2 = 0, dbase2 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis float x0, y0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis float x1, y1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis float x2, y2;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int ibase0, si0, hyp0h;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int ibase1, si1, hyp1h;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int ibase2, si2, hyp2h;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis for (; n > 2 ; n -= 3)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x0 = *px;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis px += stridex;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x1 = *px;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis px += stridex;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x2 = *px;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis px += stridex;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis y0 = *py;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis py += stridey;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis y1 = *py;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis py += stridey;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis y2 = *py;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis py += stridey;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis hyp0 = x0 * (double)x0 + y0 * (double)y0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis hyp1 = x1 * (double)x1 + y1 * (double)y1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis hyp2 = x2 * (double)x2 + y2 * (double)y2;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ibase0 = HI(&hyp0);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ibase1 = HI(&hyp1);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ibase2 = HI(&hyp2);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&dbase0) = (0x60000000 - ((ibase0 & 0x7fe00000) >> 1));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&dbase1) = (0x60000000 - ((ibase1 & 0x7fe00000) >> 1));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&dbase2) = (0x60000000 - ((ibase2 & 0x7fe00000) >> 1));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis hyp0h = (ibase0 & 0x000fffff) | 0x3ff00000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis hyp1h = (ibase1 & 0x000fffff) | 0x3ff00000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis hyp2h = (ibase2 & 0x000fffff) | 0x3ff00000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&hyp0) = hyp0h;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&hyp1) = hyp1h;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&hyp2) = hyp2h;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&h_hi0) = hyp0h & 0x7fffc000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&h_hi1) = hyp1h & 0x7fffc000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&h_hi2) = hyp2h & 0x7fffc000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ibase0 >>= 10;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ibase1 >>= 10;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ibase2 >>= 10;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis si0 = ibase0 & 0x7f0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis si1 = ibase1 & 0x7f0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis si2 = ibase2 & 0x7f0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx0 = ((double*)((char*)__vlibm_TBL_rhypotf + si0))[0];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx1 = ((double*)((char*)__vlibm_TBL_rhypotf + si1))[0];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx2 = ((double*)((char*)__vlibm_TBL_rhypotf + si2))[0];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx0 = (hyp0 - h_hi0) * xx0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx1 = (hyp1 - h_hi1) * xx1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx2 = (hyp2 - h_hi2) * xx2;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res0 = ((double*)((char*)__vlibm_TBL_rhypotf + si0))[1];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res1 = ((double*)((char*)__vlibm_TBL_rhypotf + si1))[1];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res2 = ((double*)((char*)__vlibm_TBL_rhypotf + si2))[1];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res0 *= (((A3 * xx0 + A2) * xx0 + A1) * xx0 + A0);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res1 *= (((A3 * xx1 + A2) * xx1 + A1) * xx1 + A0);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res2 *= (((A3 * xx2 + A2) * xx2 + A1) * xx2 + A0);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res0 *= dbase0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res1 *= dbase1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res2 *= dbase2;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *pz = res0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pz += stridez;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *pz = res1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pz += stridez;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *pz = res2;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pz += stridez;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis for (; n > 0 ; n--)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x0 = *px;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis px += stridex;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis y0 = *py;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis py += stridey;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis hyp0 = x0 * (double)x0 + y0 * (double)y0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ibase0 = HI(&hyp0);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&dbase0) = (0x60000000 - ((ibase0 & 0x7fe00000) >> 1));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis hyp0h = (ibase0 & 0x000fffff) | 0x3ff00000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&hyp0) = hyp0h;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis HI(&h_hi0) = hyp0h & 0x7fffc000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ibase0 >>= 10;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis si0 = ibase0 & 0x7f0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx0 = ((double*)((char*)__vlibm_TBL_rhypotf + si0))[0];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx0 = (hyp0 - h_hi0) * xx0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res0 = ((double*)((char*)__vlibm_TBL_rhypotf + si0))[1];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res0 *= (((A3 * xx0 + A2) * xx0 + A1) * xx0 + A0);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis res0 *= dbase0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *pz = res0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis pz += stridez;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}