bacon_sci_1/roots/
polynomial.rs1use crate::polynomial::Polynomial;
2use nalgebra::ComplexField;
3use num_complex::Complex;
4use num_traits::{FromPrimitive, Zero};
5
6pub fn newton_polynomial<N: ComplexField>(
35 initial: N,
36 poly: &Polynomial<N>,
37 tol: <N as ComplexField>::RealField,
38 n_max: usize,
39) -> Result<N, String> {
40 let mut n = 0;
41
42 let mut guess = initial;
43
44 let mut norm = guess.abs();
45 if norm <= tol {
46 return Ok(guess);
47 }
48
49 while n < n_max {
50 let (f_val, f_deriv_val) = poly.evaluate_derivative(guess);
51 let new_guess = guess - (f_val / f_deriv_val);
52 let new_norm = new_guess.abs();
53 if ((norm - new_norm) / norm).abs() <= tol || new_norm <= tol {
54 return Ok(new_guess);
55 }
56
57 norm = new_norm;
58 guess = new_guess;
59 n += 1;
60 }
61
62 Err("Newton_polynomial: maximum iterations exceeded".to_owned())
63}
64
65pub fn muller_polynomial<N: ComplexField>(
93 initial: (N, N, N),
94 poly: &Polynomial<N>,
95 tol: <N as ComplexField>::RealField,
96 n_max: usize,
97) -> Result<Complex<<N as ComplexField>::RealField>, String> {
98 let poly = poly.make_complex();
99 let mut n = 0;
100 let mut poly_0 = Complex::<N::RealField>::new(initial.0.real(), initial.0.imaginary());
101 let mut poly_1 = Complex::<N::RealField>::new(initial.1.real(), initial.1.imaginary());
102 let mut poly_2 = Complex::<N::RealField>::new(initial.2.real(), initial.1.imaginary());
103 let mut h_1 = poly_1 - poly_0;
104 let mut h_2 = poly_2 - poly_1;
105 let poly_1_evaluated = poly.evaluate(poly_1);
106 let mut poly_2_evaluated = poly.evaluate(poly_2);
107 let mut delta_1 = (poly_1_evaluated - poly.evaluate(poly_0)) / h_1;
108 let mut delta_2 = (poly_2_evaluated - poly_1_evaluated) / h_2;
109 let mut delta = (delta_2 - delta_1) / (h_2 + h_1);
110
111 let negtwo = N::RealField::from_i32(-2).unwrap();
112 let four = N::RealField::from_i32(4).unwrap();
113
114 while n < n_max {
115 let b_coefficient = delta_2 + h_2 * delta;
116 let determinate = (b_coefficient.powi(2)
117 - Complex::<N::RealField>::new(four, N::RealField::zero()) * poly_2_evaluated * delta)
118 .sqrt();
119 let error = if (b_coefficient - determinate).abs() < (b_coefficient + determinate).abs() {
120 b_coefficient + determinate
121 } else {
122 b_coefficient - determinate
123 };
124 let step =
125 Complex::<N::RealField>::new(negtwo, N::RealField::zero()) * poly_2_evaluated / error;
126 let p = poly_2 + step;
127
128 if step.abs() <= tol {
129 return Ok(p);
130 }
131
132 poly_0 = poly_1;
133 poly_1 = poly_2;
134 poly_2 = p;
135 poly_2_evaluated = poly.evaluate(p);
136 h_1 = poly_1 - poly_0;
137 h_2 = poly_2 - poly_1;
138 let poly_1_evaluated = poly.evaluate(poly_1);
139 delta_1 = (poly_1_evaluated - poly.evaluate(poly_0)) / h_1;
140 delta_2 = (poly_2_evaluated - poly_1_evaluated) / h_2;
141 delta = (delta_2 - delta_1) / (h_1 + h_2);
142
143 n += 1;
144 }
145
146 Err("Muller: maximum iterations exceeded".to_owned())
147}