xsf/scipy_special/
wright.rs1use crate::numpy::nextafter;
5use crate::xsf::c64::{C64, ViaC64, c64};
6use crate::xsf::cephes::dd_real::two_sum;
7use num_complex::Complex64;
8
9const TWOITERTOL: f64 = f64::EPSILON;
10const I: C64 = C64::I;
11
12fn add_round_up(a: f64, b: f64) -> f64 {
14 if a.is_nan() || b.is_nan() {
15 return f64::NAN;
16 }
17
18 let (s, err) = two_sum(a, b);
19 if err > 0.0 {
20 nextafter(s, f64::INFINITY)
22 } else {
23 s
25 }
26}
27
28fn add_round_down(a: f64, b: f64) -> f64 {
30 if a.is_nan() || b.is_nan() {
31 return f64::NAN;
32 }
33
34 let (s, err) = two_sum(a, b);
35 if err < 0.0 {
36 nextafter(s, f64::NEG_INFINITY)
37 } else {
38 s
39 }
40}
41
42fn wrightomega_ext(z: C64) -> C64 {
43 let pi = core::f64::consts::PI;
44 let mut s = 1.0;
45
46 let (x, y) = (z.re, z.im);
48
49 let mut ympi = y - pi;
51 let mut yppi = y + pi;
52 let near = 0.1e-1;
53
54 if x.is_nan() || y.is_nan() {
56 return C64::NAN;
58 } else if x.is_infinite() && x.is_sign_negative() && (-pi < y) && (y <= pi) {
59 return if y.abs() <= pi / 2.0 {
61 if y >= 0.0 { C64::ZERO } else { c64(0.0, -0.0) }
62 } else {
63 if y >= 0.0 {
64 c64(-0.0, 0.0)
65 } else {
66 c64(-0.0, -0.0)
67 }
68 };
69 } else if x.is_infinite() || y.is_infinite() {
70 return c64(x, y);
72 }
73
74 if x == -1.0 && y.abs() == pi {
76 return c64(-1.0, 0.0);
77 }
78
79 let mut w: C64;
81 #[allow(clippy::manual_range_contains)]
82 if -2.0 < x && x <= 1.0 && 1.0 < y && y < 2.0 * pi {
83 let pz = (2.0 * (z + 1.0 - I * pi)).conj().sqrt().conj();
86 w = -1.0
87 + (I + (1.0 / 3.0
88 + (-1.0 / 36.0 * I + (1.0 / 270.0 + 1.0 / 4320.0 * I * pz) * pz) * pz)
89 * pz)
90 * pz;
91 } else if -2.0 < x && x <= 1.0 && -2.0 * pi < y && y < -1.0 {
92 let pz = (2.0 * (z + 1.0 + I * pi)).conj().sqrt().conj();
95 w = -1.0
96 + (-I
97 + (1.0 / 3.0 + (1.0 / 36.0 * I + (1.0 / 270.0 - 1.0 / 4320.0 * I * pz) * pz) * pz)
98 * pz)
99 * pz;
100 } else if x <= -2.0 && -pi < y && y <= pi {
101 let pz = z.exp();
104 w = (1.0 + (-1.0 + (3.0 / 2.0 + (-8.0 / 3.0 + 125.0 / 24.0 * pz) * pz) * pz) * pz) * pz;
105 if w == C64::ZERO {
106 return w;
108 }
109 } else if (-2.0 < x && x <= 1.0 && -1.0 <= y && y <= 1.0)
110 || ((-2.0 < x) && (x - 0.1e1) * (x - 0.1e1) + y * y <= pi * pi)
111 {
112 let pz = z - 1.0;
115 w = 1.0 / 2.0
116 + 1.0 / 2.0 * z
117 + (1.0 / 16.0 + (-1.0 / 192.0 + (-1.0 / 3072.0 + 13.0 / 61440.0 * pz) * pz) * pz)
118 * pz
119 * pz;
120 } else {
121 let (t, pz) = if x <= -0.105e1 && pi < y && y - pi <= -0.75e0 * (x + 0.1e1) {
122 let t = z - I * pi;
125 (t, (-t).ln())
126 } else if x <= -0.105e1 && 0.75e0 * (x + 0.1e1) < y + pi && y + pi <= 0.0e0 {
127 let t = z + I * pi;
130 (t, (-t).ln())
131 } else {
132 (z, z.ln())
135 };
136 w = t - pz;
137 if z.norm() > 1e50 {
138 return w;
142 }
143 let mut fac = pz / t;
144 w += fac;
145 fac /= t;
146 w += fac * (0.5 * pz - 1.0);
147 fac /= t;
148 w += fac * (pz * pz / 3.0 - 3.0 * pz / 2.0 + 1.0);
149 }
150
151 let z = if x <= -0.1e1 + near && (ympi.abs() <= near || yppi.abs() <= near) {
153 s = -1.0;
154 if ympi.abs() <= near {
155 ympi = add_round_up(y, -pi);
157
158 if ympi <= 0.0 {
159 ympi = add_round_down(y, -pi);
160 }
161
162 x + I * ympi
163 } else {
164 yppi = add_round_up(y, pi);
166
167 if yppi <= 0.0 {
168 yppi = add_round_down(y, pi);
169 }
170
171 x + I * yppi
172 }
173 } else {
174 z
175 };
176
177 w = s * w;
179 let r = z - s * w - w.ln();
180 let wp1 = s * w + 1.0;
181 let e = r / wp1 * (2.0 * wp1 * (wp1 + 2.0 / 3.0 * r) - r)
182 / (2.0 * wp1 * (wp1 + 2.0 / 3.0 * r) - 2.0 * r);
183 w *= 1.0 + e;
184
185 if ((2.0 * w * w - 8.0 * w - 1.0) * r.norm().powf(4.0)).norm()
187 >= TWOITERTOL * 72.0 * wp1.norm().powf(6.0)
188 {
189 let r = z - s * w - w.ln();
190 let wp1 = s * w + 1.0;
191 let e = r / wp1 * (2.0 * wp1 * (wp1 + 2.0 / 3.0 * r) - r)
192 / (2.0 * wp1 * (wp1 + 2.0 / 3.0 * r) - 2.0 * r);
193 w *= 1.0 + e;
194 }
195
196 s * w
198}
199
200fn wrightomega_real(x: f64) -> f64 {
201 if x.is_nan() {
202 return x;
203 }
204
205 if x.is_infinite() {
213 return if x.is_sign_positive() { x } else { 0.0 };
216 }
217
218 if x < -50.0 {
226 let w = x.exp();
228 if w == 0.0 {
229 }
231 return w;
232 }
233 if x > 1e20 {
237 return x;
239 }
240
241 let w = if x < -2.0 {
251 x.exp()
253 } else if x < 1.0 {
254 (2.0 * (x - 1.0) / 3.0).exp()
256 } else {
257 let w = x.ln();
259 x - w + w / x
260 };
261
262 let r = x - w - w.ln();
265 let wp1 = w + 1.0;
267 let e = r / wp1 * (2.0 * wp1 * (wp1 + 2.0 / 3.0 * r) - r)
269 / (2.0 * wp1 * (wp1 + 2.0 / 3.0 * r) - 2.0 * r);
270 let w = w * (1.0 + e);
272
273 if ((2.0 * w * w - 8.0 * w - 1.0) * r.abs().powf(4.0)).abs()
282 >= TWOITERTOL * 72.0 * wp1.abs().powf(6.0)
283 {
284 let r = x - w - w.ln();
285 let wp1 = w + 1.0;
286 let e = r / wp1 * (2.0 * wp1 * (wp1 + 2.0 / 3.0 * r) - r)
287 / (2.0 * wp1 * (wp1 + 2.0 / 3.0 * r) - 2.0 * r);
288 w * (1.0 + e)
289 } else {
290 w
291 }
292}
293
294pub trait WrightOmegaArg: crate::sealed::Sealed {
295 fn wrightomega(self) -> Self;
296}
297
298impl WrightOmegaArg for f64 {
299 #[inline]
300 fn wrightomega(self) -> Self {
301 wrightomega_real(self)
302 }
303}
304
305impl WrightOmegaArg for Complex64 {
306 #[inline]
307 fn wrightomega(self) -> Self {
308 self.via(wrightomega_ext)
309 }
310}
311
312#[must_use]
331#[inline]
332pub fn wrightomega<T: WrightOmegaArg>(z: T) -> T {
333 z.wrightomega()
334}