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 * Copyright 2011 Nexenta Systems, Inc. All rights reserved. 2325c28e83SPiotr Jasiukajtis */ 2425c28e83SPiotr Jasiukajtis /* 2525c28e83SPiotr Jasiukajtis * Copyright 2005 Sun Microsystems, Inc. All rights reserved. 2625c28e83SPiotr Jasiukajtis * Use is subject to license terms. 2725c28e83SPiotr Jasiukajtis */ 2825c28e83SPiotr Jasiukajtis 29*ddc0e0b5SRichard Lowe #pragma weak __catanf = catanf 3025c28e83SPiotr Jasiukajtis 3125c28e83SPiotr Jasiukajtis #include "libm.h" 3225c28e83SPiotr Jasiukajtis #include "complex_wrapper.h" 3325c28e83SPiotr Jasiukajtis 3425c28e83SPiotr Jasiukajtis #if defined(__i386) && !defined(__amd64) 3525c28e83SPiotr Jasiukajtis extern int __swapRP(int); 3625c28e83SPiotr Jasiukajtis #endif 3725c28e83SPiotr Jasiukajtis 3825c28e83SPiotr Jasiukajtis static const float 3925c28e83SPiotr Jasiukajtis pi_2 = 1.570796326794896558e+00F, 4025c28e83SPiotr Jasiukajtis zero = 0.0F, 4125c28e83SPiotr Jasiukajtis half = 0.5F, 4225c28e83SPiotr Jasiukajtis two = 2.0F, 4325c28e83SPiotr Jasiukajtis one = 1.0F; 4425c28e83SPiotr Jasiukajtis 4525c28e83SPiotr Jasiukajtis fcomplex 4625c28e83SPiotr Jasiukajtis catanf(fcomplex z) { 4725c28e83SPiotr Jasiukajtis fcomplex ans; 4825c28e83SPiotr Jasiukajtis float x, y, ax, ay, t; 4925c28e83SPiotr Jasiukajtis double dx, dy, dt; 5025c28e83SPiotr Jasiukajtis int hx, hy, ix, iy; 5125c28e83SPiotr Jasiukajtis 5225c28e83SPiotr Jasiukajtis x = F_RE(z); 5325c28e83SPiotr Jasiukajtis y = F_IM(z); 5425c28e83SPiotr Jasiukajtis ax = fabsf(x); 5525c28e83SPiotr Jasiukajtis ay = fabsf(y); 5625c28e83SPiotr Jasiukajtis hx = THE_WORD(x); 5725c28e83SPiotr Jasiukajtis hy = THE_WORD(y); 5825c28e83SPiotr Jasiukajtis ix = hx & 0x7fffffff; 5925c28e83SPiotr Jasiukajtis iy = hy & 0x7fffffff; 6025c28e83SPiotr Jasiukajtis 6125c28e83SPiotr Jasiukajtis if (ix >= 0x7f800000) { /* x is inf or NaN */ 6225c28e83SPiotr Jasiukajtis if (ix == 0x7f800000) { 6325c28e83SPiotr Jasiukajtis F_RE(ans) = pi_2; 6425c28e83SPiotr Jasiukajtis F_IM(ans) = zero; 6525c28e83SPiotr Jasiukajtis } else { 6625c28e83SPiotr Jasiukajtis F_RE(ans) = x * x; 6725c28e83SPiotr Jasiukajtis if (iy == 0 || iy == 0x7f800000) 6825c28e83SPiotr Jasiukajtis F_IM(ans) = zero; 6925c28e83SPiotr Jasiukajtis else 7025c28e83SPiotr Jasiukajtis F_IM(ans) = (fabsf(y) - ay) / (fabsf(y) - ay); 7125c28e83SPiotr Jasiukajtis } 7225c28e83SPiotr Jasiukajtis } else if (iy >= 0x7f800000) { /* y is inf or NaN */ 7325c28e83SPiotr Jasiukajtis if (iy == 0x7f800000) { 7425c28e83SPiotr Jasiukajtis F_RE(ans) = pi_2; 7525c28e83SPiotr Jasiukajtis F_IM(ans) = zero; 7625c28e83SPiotr Jasiukajtis } else { 7725c28e83SPiotr Jasiukajtis F_RE(ans) = (fabsf(x) - ax) / (fabsf(x) - ax); 7825c28e83SPiotr Jasiukajtis F_IM(ans) = y * y; 7925c28e83SPiotr Jasiukajtis } 8025c28e83SPiotr Jasiukajtis } else if (ix == 0) { 8125c28e83SPiotr Jasiukajtis /* INDENT OFF */ 8225c28e83SPiotr Jasiukajtis /* 8325c28e83SPiotr Jasiukajtis * x = 0 8425c28e83SPiotr Jasiukajtis * 1 1 8525c28e83SPiotr Jasiukajtis * A = --- * atan2(2x, 1-x*x-y*y) = --- atan2(0,1-|y|) 8625c28e83SPiotr Jasiukajtis * 2 2 8725c28e83SPiotr Jasiukajtis * 8825c28e83SPiotr Jasiukajtis * 1 [ (y+1)*(y+1) ] 1 2 1 2y 8925c28e83SPiotr Jasiukajtis * B = - log [ ----------- ] = - log (1+ ---) or - log(1+ ----) 9025c28e83SPiotr Jasiukajtis * 4 [ (y-1)*(y-1) ] 2 y-1 2 1-y 9125c28e83SPiotr Jasiukajtis */ 9225c28e83SPiotr Jasiukajtis /* INDENT ON */ 9325c28e83SPiotr Jasiukajtis t = one - ay; 9425c28e83SPiotr Jasiukajtis if (iy == 0x3f800000) { 9525c28e83SPiotr Jasiukajtis /* y=1: catan(0,1)=(0,+inf) with 1/0 signal */ 9625c28e83SPiotr Jasiukajtis F_IM(ans) = ay / ax; 9725c28e83SPiotr Jasiukajtis F_RE(ans) = zero; 9825c28e83SPiotr Jasiukajtis } else if (iy > 0x3f800000) { /* y>1 */ 9925c28e83SPiotr Jasiukajtis F_IM(ans) = half * log1pf(two / (-t)); 10025c28e83SPiotr Jasiukajtis F_RE(ans) = pi_2; 10125c28e83SPiotr Jasiukajtis } else { /* y<1 */ 10225c28e83SPiotr Jasiukajtis F_IM(ans) = half * log1pf((ay + ay) / t); 10325c28e83SPiotr Jasiukajtis F_RE(ans) = zero; 10425c28e83SPiotr Jasiukajtis } 10525c28e83SPiotr Jasiukajtis } else { 10625c28e83SPiotr Jasiukajtis /* INDENT OFF */ 10725c28e83SPiotr Jasiukajtis /* 10825c28e83SPiotr Jasiukajtis * use double precision x,y 10925c28e83SPiotr Jasiukajtis * 1 11025c28e83SPiotr Jasiukajtis * A = --- * atan2(2x, 1-x*x-y*y) 11125c28e83SPiotr Jasiukajtis * 2 11225c28e83SPiotr Jasiukajtis * 11325c28e83SPiotr Jasiukajtis * 1 [ x*x+(y+1)*(y+1) ] 1 4y 11425c28e83SPiotr Jasiukajtis * B = - log [ --------------- ] = - log (1+ -----------------) 11525c28e83SPiotr Jasiukajtis * 4 [ x*x+(y-1)*(y-1) ] 4 x*x + (y-1)*(y-1) 11625c28e83SPiotr Jasiukajtis */ 11725c28e83SPiotr Jasiukajtis /* INDENT ON */ 11825c28e83SPiotr Jasiukajtis #if defined(__i386) && !defined(__amd64) 11925c28e83SPiotr Jasiukajtis int rp = __swapRP(fp_extended); 12025c28e83SPiotr Jasiukajtis #endif 12125c28e83SPiotr Jasiukajtis dx = (double)ax; 12225c28e83SPiotr Jasiukajtis dy = (double)ay; 12325c28e83SPiotr Jasiukajtis F_RE(ans) = (float)(0.5 * atan2(dx + dx, 12425c28e83SPiotr Jasiukajtis 1.0 - dx * dx - dy * dy)); 12525c28e83SPiotr Jasiukajtis dt = dy - 1.0; 12625c28e83SPiotr Jasiukajtis F_IM(ans) = (float)(0.25 * log1p(4.0 * dy / 12725c28e83SPiotr Jasiukajtis (dx * dx + dt * dt))); 12825c28e83SPiotr Jasiukajtis #if defined(__i386) && !defined(__amd64) 12925c28e83SPiotr Jasiukajtis if (rp != fp_extended) 13025c28e83SPiotr Jasiukajtis (void) __swapRP(rp); 13125c28e83SPiotr Jasiukajtis #endif 13225c28e83SPiotr Jasiukajtis } 13325c28e83SPiotr Jasiukajtis if (hx < 0) 13425c28e83SPiotr Jasiukajtis F_RE(ans) = -F_RE(ans); 13525c28e83SPiotr Jasiukajtis if (hy < 0) 13625c28e83SPiotr Jasiukajtis F_IM(ans) = -F_IM(ans); 13725c28e83SPiotr Jasiukajtis return (ans); 13825c28e83SPiotr Jasiukajtis } 139