125c28e83SPiotr Jasiukajtis /* 225c28e83SPiotr Jasiukajtis * CDDL HEADER START 325c28e83SPiotr Jasiukajtis * 425c28e83SPiotr Jasiukajtis * The contents of this file are subject to the terms of the 525c28e83SPiotr Jasiukajtis * Common Development and Distribution License (the "License"). 625c28e83SPiotr Jasiukajtis * You may not use this file except in compliance with the License. 725c28e83SPiotr Jasiukajtis * 825c28e83SPiotr Jasiukajtis * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE 925c28e83SPiotr Jasiukajtis * or http://www.opensolaris.org/os/licensing. 1025c28e83SPiotr Jasiukajtis * See the License for the specific language governing permissions 1125c28e83SPiotr Jasiukajtis * and limitations under the License. 1225c28e83SPiotr Jasiukajtis * 1325c28e83SPiotr Jasiukajtis * When distributing Covered Code, include this CDDL HEADER in each 1425c28e83SPiotr Jasiukajtis * file and include the License file at usr/src/OPENSOLARIS.LICENSE. 1525c28e83SPiotr Jasiukajtis * If applicable, add the following below this CDDL HEADER, with the 1625c28e83SPiotr Jasiukajtis * fields enclosed by brackets "[]" replaced with your own identifying 1725c28e83SPiotr Jasiukajtis * information: Portions Copyright [yyyy] [name of copyright owner] 1825c28e83SPiotr Jasiukajtis * 1925c28e83SPiotr Jasiukajtis * CDDL HEADER END 2025c28e83SPiotr Jasiukajtis */ 2125c28e83SPiotr Jasiukajtis 2225c28e83SPiotr Jasiukajtis /* 2325c28e83SPiotr Jasiukajtis * Copyright 2011 Nexenta Systems, Inc. All rights reserved. 2425c28e83SPiotr Jasiukajtis */ 2525c28e83SPiotr Jasiukajtis /* 2625c28e83SPiotr Jasiukajtis * Copyright 2006 Sun Microsystems, Inc. All rights reserved. 2725c28e83SPiotr Jasiukajtis * Use is subject to license terms. 2825c28e83SPiotr Jasiukajtis */ 2925c28e83SPiotr Jasiukajtis 30*ddc0e0b5SRichard Lowe #pragma weak __cacosl = cacosl 3125c28e83SPiotr Jasiukajtis 3225c28e83SPiotr Jasiukajtis #include "libm.h" /* acosl/atanl/fabsl/isinfl/log1pl/logl/sqrtl */ 3325c28e83SPiotr Jasiukajtis #include "complex_wrapper.h" 3425c28e83SPiotr Jasiukajtis #include "longdouble.h" 3525c28e83SPiotr Jasiukajtis 3625c28e83SPiotr Jasiukajtis /* INDENT OFF */ 3725c28e83SPiotr Jasiukajtis static const long double 3825c28e83SPiotr Jasiukajtis zero = 0.0L, 3925c28e83SPiotr Jasiukajtis one = 1.0L, 4025c28e83SPiotr Jasiukajtis Acrossover = 1.5L, 4125c28e83SPiotr Jasiukajtis Bcrossover = 0.6417L, 4225c28e83SPiotr Jasiukajtis half = 0.5L, 4325c28e83SPiotr Jasiukajtis ln2 = 6.931471805599453094172321214581765680755e-0001L, 4425c28e83SPiotr Jasiukajtis Foursqrtu = 7.3344154702193886624856495681939326638255e-2466L, /* 2**-8189 */ 4525c28e83SPiotr Jasiukajtis #if defined(__x86) 4625c28e83SPiotr Jasiukajtis E = 5.4210108624275221700372640043497085571289e-20L, /* 2**-64 */ 4725c28e83SPiotr Jasiukajtis pi = 3.141592653589793238295968524909085317631252110004425048828125L, 4825c28e83SPiotr Jasiukajtis pi_l = 1.666748583704175665659172893706807721468195923078e-19L, 4925c28e83SPiotr Jasiukajtis pi_2 = 1.5707963267948966191479842624545426588156260L, 5025c28e83SPiotr Jasiukajtis pi_2_l = 8.3337429185208783282958644685340386073409796e-20L, 5125c28e83SPiotr Jasiukajtis pi_4 = 0.78539816339744830957399213122727132940781302750110626220703125L, 5225c28e83SPiotr Jasiukajtis pi_4_l = 4.166871459260439164147932234267019303670489807695410e-20L, 5325c28e83SPiotr Jasiukajtis pi3_4 = 2.35619449019234492872197639368181398822343908250331878662109375L, 5425c28e83SPiotr Jasiukajtis pi3_4_l = 1.250061437778131749244379670280105791101146942308e-19L; 5525c28e83SPiotr Jasiukajtis #else 5625c28e83SPiotr Jasiukajtis E = 9.6296497219361792652798897129246365926905e-35L, /* 2**-113 */ 5725c28e83SPiotr Jasiukajtis pi = 3.1415926535897932384626433832795027974790680981372955730045043318L, 5825c28e83SPiotr Jasiukajtis pi_l = 8.6718101301237810247970440260433519687623233462565303417759356862e-35L, 5925c28e83SPiotr Jasiukajtis pi_2 = 1.5707963267948966192313216916397513987395340L, 6025c28e83SPiotr Jasiukajtis pi_2_l = 4.3359050650618905123985220130216759843811616e-35L, 6125c28e83SPiotr Jasiukajtis pi_4 = 0.785398163397448309615660845819875699369767024534323893251126L, 6225c28e83SPiotr Jasiukajtis pi_4_l = 2.167952532530945256199261006510837992190580836564132585443e-35L, 6325c28e83SPiotr Jasiukajtis pi3_4 = 2.35619449019234492884698253745962709810930107360297167975337824L, 6425c28e83SPiotr Jasiukajtis pi3_4_l = 6.503857597592835768597783019532513976571742509692397756331e-35L; 6525c28e83SPiotr Jasiukajtis #endif 6625c28e83SPiotr Jasiukajtis /* INDENT ON */ 6725c28e83SPiotr Jasiukajtis 6825c28e83SPiotr Jasiukajtis #if defined(__x86) 6925c28e83SPiotr Jasiukajtis static const int ip1 = 0x40400000; /* 2**65 */ 7025c28e83SPiotr Jasiukajtis #else 7125c28e83SPiotr Jasiukajtis static const int ip1 = 0x40710000; /* 2**114 */ 7225c28e83SPiotr Jasiukajtis #endif 7325c28e83SPiotr Jasiukajtis 7425c28e83SPiotr Jasiukajtis ldcomplex 7525c28e83SPiotr Jasiukajtis cacosl(ldcomplex z) { 7625c28e83SPiotr Jasiukajtis long double x, y, t, R, S, A, Am1, B, y2, xm1, xp1, Apx; 7725c28e83SPiotr Jasiukajtis int ix, iy, hx, hy; 7825c28e83SPiotr Jasiukajtis ldcomplex ans; 7925c28e83SPiotr Jasiukajtis 8025c28e83SPiotr Jasiukajtis x = LD_RE(z); 8125c28e83SPiotr Jasiukajtis y = LD_IM(z); 8225c28e83SPiotr Jasiukajtis hx = HI_XWORD(x); 8325c28e83SPiotr Jasiukajtis hy = HI_XWORD(y); 8425c28e83SPiotr Jasiukajtis ix = hx & 0x7fffffff; 8525c28e83SPiotr Jasiukajtis iy = hy & 0x7fffffff; 8625c28e83SPiotr Jasiukajtis 8725c28e83SPiotr Jasiukajtis /* x is 0 */ 8825c28e83SPiotr Jasiukajtis if (x == zero) { 8925c28e83SPiotr Jasiukajtis if (y == zero || (iy >= 0x7fff0000)) { 9025c28e83SPiotr Jasiukajtis LD_RE(ans) = pi_2 + pi_2_l; 9125c28e83SPiotr Jasiukajtis LD_IM(ans) = -y; 9225c28e83SPiotr Jasiukajtis return (ans); 9325c28e83SPiotr Jasiukajtis } 9425c28e83SPiotr Jasiukajtis } 9525c28e83SPiotr Jasiukajtis 9625c28e83SPiotr Jasiukajtis /* |y| is inf or NaN */ 9725c28e83SPiotr Jasiukajtis if (iy >= 0x7fff0000) { 9825c28e83SPiotr Jasiukajtis if (isinfl(y)) { /* cacos(x + i inf) = pi/2 - i inf */ 9925c28e83SPiotr Jasiukajtis LD_IM(ans) = -y; 10025c28e83SPiotr Jasiukajtis if (ix < 0x7fff0000) { 10125c28e83SPiotr Jasiukajtis LD_RE(ans) = pi_2 + pi_2_l; 10225c28e83SPiotr Jasiukajtis } else if (isinfl(x)) { 10325c28e83SPiotr Jasiukajtis if (hx >= 0) 10425c28e83SPiotr Jasiukajtis LD_RE(ans) = pi_4 + pi_4_l; 10525c28e83SPiotr Jasiukajtis else 10625c28e83SPiotr Jasiukajtis LD_RE(ans) = pi3_4 + pi3_4_l; 10725c28e83SPiotr Jasiukajtis } else { 10825c28e83SPiotr Jasiukajtis LD_RE(ans) = x; 10925c28e83SPiotr Jasiukajtis } 11025c28e83SPiotr Jasiukajtis } else { /* cacos(x + i NaN) = NaN + i NaN */ 11125c28e83SPiotr Jasiukajtis LD_RE(ans) = y + x; 11225c28e83SPiotr Jasiukajtis if (isinfl(x)) 11325c28e83SPiotr Jasiukajtis LD_IM(ans) = -fabsl(x); 11425c28e83SPiotr Jasiukajtis else 11525c28e83SPiotr Jasiukajtis LD_IM(ans) = y; 11625c28e83SPiotr Jasiukajtis } 11725c28e83SPiotr Jasiukajtis return (ans); 11825c28e83SPiotr Jasiukajtis } 11925c28e83SPiotr Jasiukajtis 12025c28e83SPiotr Jasiukajtis y = fabsl(y); 12125c28e83SPiotr Jasiukajtis 12225c28e83SPiotr Jasiukajtis if (ix >= 0x7fff0000) { /* x is inf or NaN */ 12325c28e83SPiotr Jasiukajtis if (isinfl(x)) { /* x is INF */ 12425c28e83SPiotr Jasiukajtis LD_IM(ans) = -fabsl(x); 12525c28e83SPiotr Jasiukajtis if (iy >= 0x7fff0000) { 12625c28e83SPiotr Jasiukajtis if (isinfl(y)) { 12725c28e83SPiotr Jasiukajtis /* INDENT OFF */ 12825c28e83SPiotr Jasiukajtis /* cacos(inf + i inf) = pi/4 - i inf */ 12925c28e83SPiotr Jasiukajtis /* cacos(-inf+ i inf) =3pi/4 - i inf */ 13025c28e83SPiotr Jasiukajtis /* INDENT ON */ 13125c28e83SPiotr Jasiukajtis if (hx >= 0) 13225c28e83SPiotr Jasiukajtis LD_RE(ans) = pi_4 + pi_4_l; 13325c28e83SPiotr Jasiukajtis else 13425c28e83SPiotr Jasiukajtis LD_RE(ans) = pi3_4 + pi3_4_l; 13525c28e83SPiotr Jasiukajtis } else 13625c28e83SPiotr Jasiukajtis /* INDENT OFF */ 13725c28e83SPiotr Jasiukajtis /* cacos(inf + i NaN) = NaN - i inf */ 13825c28e83SPiotr Jasiukajtis /* INDENT ON */ 13925c28e83SPiotr Jasiukajtis LD_RE(ans) = y + y; 14025c28e83SPiotr Jasiukajtis } else { 14125c28e83SPiotr Jasiukajtis /* INDENT OFF */ 14225c28e83SPiotr Jasiukajtis /* cacos(inf + iy ) = 0 - i inf */ 14325c28e83SPiotr Jasiukajtis /* cacos(-inf+ iy ) = pi - i inf */ 14425c28e83SPiotr Jasiukajtis /* INDENT ON */ 14525c28e83SPiotr Jasiukajtis if (hx >= 0) 14625c28e83SPiotr Jasiukajtis LD_RE(ans) = zero; 14725c28e83SPiotr Jasiukajtis else 14825c28e83SPiotr Jasiukajtis LD_RE(ans) = pi + pi_l; 14925c28e83SPiotr Jasiukajtis } 15025c28e83SPiotr Jasiukajtis } else { /* x is NaN */ 15125c28e83SPiotr Jasiukajtis /* INDENT OFF */ 15225c28e83SPiotr Jasiukajtis /* 15325c28e83SPiotr Jasiukajtis * cacos(NaN + i inf) = NaN - i inf 15425c28e83SPiotr Jasiukajtis * cacos(NaN + i y ) = NaN + i NaN 15525c28e83SPiotr Jasiukajtis * cacos(NaN + i NaN) = NaN + i NaN 15625c28e83SPiotr Jasiukajtis */ 15725c28e83SPiotr Jasiukajtis /* INDENT ON */ 15825c28e83SPiotr Jasiukajtis LD_RE(ans) = x + y; 15925c28e83SPiotr Jasiukajtis if (iy >= 0x7fff0000) { 16025c28e83SPiotr Jasiukajtis LD_IM(ans) = -y; 16125c28e83SPiotr Jasiukajtis } else { 16225c28e83SPiotr Jasiukajtis LD_IM(ans) = x; 16325c28e83SPiotr Jasiukajtis } 16425c28e83SPiotr Jasiukajtis } 16525c28e83SPiotr Jasiukajtis if (hy < 0) 16625c28e83SPiotr Jasiukajtis LD_IM(ans) = -LD_IM(ans); 16725c28e83SPiotr Jasiukajtis return (ans); 16825c28e83SPiotr Jasiukajtis } 16925c28e83SPiotr Jasiukajtis 17025c28e83SPiotr Jasiukajtis if (y == zero) { /* region 1: y=0 */ 17125c28e83SPiotr Jasiukajtis if (ix < 0x3fff0000) { /* |x| < 1 */ 17225c28e83SPiotr Jasiukajtis LD_RE(ans) = acosl(x); 17325c28e83SPiotr Jasiukajtis LD_IM(ans) = zero; 17425c28e83SPiotr Jasiukajtis } else { 17525c28e83SPiotr Jasiukajtis LD_RE(ans) = zero; 17625c28e83SPiotr Jasiukajtis x = fabsl(x); 17725c28e83SPiotr Jasiukajtis if (ix >= ip1) /* i386 ? 2**65 : 2**114 */ 17825c28e83SPiotr Jasiukajtis LD_IM(ans) = ln2 + logl(x); 17925c28e83SPiotr Jasiukajtis else if (ix >= 0x3fff8000) /* x > Acrossover */ 18025c28e83SPiotr Jasiukajtis LD_IM(ans) = logl(x + sqrtl((x - one) * (x + 18125c28e83SPiotr Jasiukajtis one))); 18225c28e83SPiotr Jasiukajtis else { 18325c28e83SPiotr Jasiukajtis xm1 = x - one; 18425c28e83SPiotr Jasiukajtis LD_IM(ans) = log1pl(xm1 + sqrtl(xm1 * (x + 18525c28e83SPiotr Jasiukajtis one))); 18625c28e83SPiotr Jasiukajtis } 18725c28e83SPiotr Jasiukajtis } 18825c28e83SPiotr Jasiukajtis } else if (y <= E * fabsl(fabsl(x) - one)) { 18925c28e83SPiotr Jasiukajtis /* region 2: y < tiny*||x|-1| */ 19025c28e83SPiotr Jasiukajtis if (ix < 0x3fff0000) { /* x < 1 */ 19125c28e83SPiotr Jasiukajtis LD_RE(ans) = acosl(x); 19225c28e83SPiotr Jasiukajtis x = fabsl(x); 19325c28e83SPiotr Jasiukajtis LD_IM(ans) = y / sqrtl((one + x) * (one - x)); 19425c28e83SPiotr Jasiukajtis } else if (ix >= ip1) { /* i386 ? 2**65 : 2**114 */ 19525c28e83SPiotr Jasiukajtis if (hx >= 0) 19625c28e83SPiotr Jasiukajtis LD_RE(ans) = y / x; 19725c28e83SPiotr Jasiukajtis else { 19825c28e83SPiotr Jasiukajtis if (ix >= ip1 + 0x00040000) 19925c28e83SPiotr Jasiukajtis LD_RE(ans) = pi + pi_l; 20025c28e83SPiotr Jasiukajtis else { 20125c28e83SPiotr Jasiukajtis t = pi_l + y / x; 20225c28e83SPiotr Jasiukajtis LD_RE(ans) = pi + t; 20325c28e83SPiotr Jasiukajtis } 20425c28e83SPiotr Jasiukajtis } 20525c28e83SPiotr Jasiukajtis LD_IM(ans) = ln2 + logl(fabsl(x)); 20625c28e83SPiotr Jasiukajtis } else { 20725c28e83SPiotr Jasiukajtis x = fabsl(x); 20825c28e83SPiotr Jasiukajtis t = sqrtl((x - one) * (x + one)); 20925c28e83SPiotr Jasiukajtis LD_RE(ans) = (hx >= 0)? y / t : pi - (y / t - pi_l); 21025c28e83SPiotr Jasiukajtis if (ix >= 0x3fff8000) /* x > Acrossover */ 21125c28e83SPiotr Jasiukajtis LD_IM(ans) = logl(x + t); 21225c28e83SPiotr Jasiukajtis else 21325c28e83SPiotr Jasiukajtis LD_IM(ans) = log1pl(t - (one - x)); 21425c28e83SPiotr Jasiukajtis } 21525c28e83SPiotr Jasiukajtis } else if (y < Foursqrtu) { /* region 3 */ 21625c28e83SPiotr Jasiukajtis t = sqrtl(y); 21725c28e83SPiotr Jasiukajtis LD_RE(ans) = (hx >= 0)? t : pi + pi_l; 21825c28e83SPiotr Jasiukajtis LD_IM(ans) = t; 21925c28e83SPiotr Jasiukajtis } else if (E * y - one >= fabsl(x)) { /* region 4 */ 22025c28e83SPiotr Jasiukajtis LD_RE(ans) = pi_2 + pi_2_l; 22125c28e83SPiotr Jasiukajtis LD_IM(ans) = ln2 + logl(y); 22225c28e83SPiotr Jasiukajtis } else if (ix >= 0x5ffb0000 || iy >= 0x5ffb0000) { 22325c28e83SPiotr Jasiukajtis /* region 5: x+1 and y are both (>= sqrt(max)/8) i.e. 2**8188 */ 22425c28e83SPiotr Jasiukajtis t = x / y; 22525c28e83SPiotr Jasiukajtis LD_RE(ans) = atan2l(y, x); 22625c28e83SPiotr Jasiukajtis LD_IM(ans) = ln2 + logl(y) + half * log1pl(t * t); 22725c28e83SPiotr Jasiukajtis } else if (fabsl(x) < Foursqrtu) { 22825c28e83SPiotr Jasiukajtis /* region 6: x is very small, < 4sqrt(min) */ 22925c28e83SPiotr Jasiukajtis LD_RE(ans) = pi_2 + pi_2_l; 23025c28e83SPiotr Jasiukajtis A = sqrtl(one + y * y); 23125c28e83SPiotr Jasiukajtis if (iy >= 0x3fff8000) /* if y > Acrossover */ 23225c28e83SPiotr Jasiukajtis LD_IM(ans) = logl(y + A); 23325c28e83SPiotr Jasiukajtis else 23425c28e83SPiotr Jasiukajtis LD_IM(ans) = half * log1pl((y + y) * (y + A)); 23525c28e83SPiotr Jasiukajtis } else { /* safe region */ 23625c28e83SPiotr Jasiukajtis t = fabsl(x); 23725c28e83SPiotr Jasiukajtis y2 = y * y; 23825c28e83SPiotr Jasiukajtis xp1 = t + one; 23925c28e83SPiotr Jasiukajtis xm1 = t - one; 24025c28e83SPiotr Jasiukajtis R = sqrtl(xp1 * xp1 + y2); 24125c28e83SPiotr Jasiukajtis S = sqrtl(xm1 * xm1 + y2); 24225c28e83SPiotr Jasiukajtis A = half * (R + S); 24325c28e83SPiotr Jasiukajtis B = t / A; 24425c28e83SPiotr Jasiukajtis 24525c28e83SPiotr Jasiukajtis if (B <= Bcrossover) 24625c28e83SPiotr Jasiukajtis LD_RE(ans) = (hx >= 0)? acosl(B) : acosl(-B); 24725c28e83SPiotr Jasiukajtis else { /* use atan and an accurate approx to a-x */ 24825c28e83SPiotr Jasiukajtis Apx = A + t; 24925c28e83SPiotr Jasiukajtis if (t <= one) 25025c28e83SPiotr Jasiukajtis LD_RE(ans) = atan2l(sqrtl(half * Apx * (y2 / 25125c28e83SPiotr Jasiukajtis (R + xp1) + (S - xm1))), x); 25225c28e83SPiotr Jasiukajtis else 25325c28e83SPiotr Jasiukajtis LD_RE(ans) = atan2l((y * sqrtl(half * (Apx / 25425c28e83SPiotr Jasiukajtis (R + xp1) + Apx / (S + xm1)))), x); 25525c28e83SPiotr Jasiukajtis } 25625c28e83SPiotr Jasiukajtis if (A <= Acrossover) { 25725c28e83SPiotr Jasiukajtis /* use log1p and an accurate approx to A-1 */ 25825c28e83SPiotr Jasiukajtis if (ix < 0x3fff0000) 25925c28e83SPiotr Jasiukajtis Am1 = half * (y2 / (R + xp1) + y2 / (S - xm1)); 26025c28e83SPiotr Jasiukajtis else 26125c28e83SPiotr Jasiukajtis Am1 = half * (y2 / (R + xp1) + (S + xm1)); 26225c28e83SPiotr Jasiukajtis LD_IM(ans) = log1pl(Am1 + sqrtl(Am1 * (A + one))); 26325c28e83SPiotr Jasiukajtis } else { 26425c28e83SPiotr Jasiukajtis LD_IM(ans) = logl(A + sqrtl(A * A - one)); 26525c28e83SPiotr Jasiukajtis } 26625c28e83SPiotr Jasiukajtis } 26725c28e83SPiotr Jasiukajtis 26825c28e83SPiotr Jasiukajtis if (hy >= 0) 26925c28e83SPiotr Jasiukajtis LD_IM(ans) = -LD_IM(ans); 27025c28e83SPiotr Jasiukajtis 27125c28e83SPiotr Jasiukajtis return (ans); 27225c28e83SPiotr Jasiukajtis } 273