1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
|
/*
* CDDL HEADER START
*
* The contents of this file are subject to the terms of the
* Common Development and Distribution License (the "License").
* You may not use this file except in compliance with the License.
*
* You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
* or http://www.opensolaris.org/os/licensing.
* See the License for the specific language governing permissions
* and limitations under the License.
*
* When distributing Covered Code, include this CDDL HEADER in each
* file and include the License file at usr/src/OPENSOLARIS.LICENSE.
* If applicable, add the following below this CDDL HEADER, with the
* fields enclosed by brackets "[]" replaced with your own identifying
* information: Portions Copyright [yyyy] [name of copyright owner]
*
* CDDL HEADER END
*/
/*
* Copyright 2011 Nexenta Systems, Inc. All rights reserved.
*/
/*
* Copyright 2006 Sun Microsystems, Inc. All rights reserved.
* Use is subject to license terms.
*/
#pragma weak __csqrtf = csqrtf
#include "libm.h" /* sqrt/fabsf/sqrtf */
#include "complex_wrapper.h"
/* INDENT OFF */
static const float zero = 0.0F;
/* INDENT ON */
fcomplex
csqrtf(fcomplex z) {
fcomplex ans;
double dt, dx, dy;
float x, y, t, ax, ay, w;
int ix, iy, hx, hy;
x = F_RE(z);
y = F_IM(z);
hx = THE_WORD(x);
hy = THE_WORD(y);
ix = hx & 0x7fffffff;
iy = hy & 0x7fffffff;
ay = fabsf(y);
ax = fabsf(x);
if (ix >= 0x7f800000 || iy >= 0x7f800000) {
/* x or y is Inf or NaN */
if (iy == 0x7f800000)
F_IM(ans) = F_RE(ans) = ay;
else if (ix == 0x7f800000) {
if (hx > 0) {
F_RE(ans) = ax;
F_IM(ans) = ay * zero;
} else {
F_RE(ans) = ay * zero;
F_IM(ans) = ax;
}
} else
F_IM(ans) = F_RE(ans) = ax + ay;
} else if (iy == 0) {
if (hx >= 0) {
F_RE(ans) = sqrtf(ax);
F_IM(ans) = zero;
} else {
F_IM(ans) = sqrtf(ax);
F_RE(ans) = zero;
}
} else {
dx = (double) ax;
dy = (double) ay;
dt = sqrt(0.5 * (sqrt(dx * dx + dy * dy) + dx));
t = (float) dt;
w = (float) (dy / (dt + dt));
if (hx >= 0) {
F_RE(ans) = t;
F_IM(ans) = w;
} else {
F_IM(ans) = t;
F_RE(ans) = w;
}
}
if (hy < 0)
F_IM(ans) = -F_IM(ans);
return (ans);
}
|
