use crate::{matrix::Matrix, matrix::Vector};
use std::error::Error;
impl Matrix {
pub fn posv_cgm(
vec_mul: &dyn Fn(Vec<f64>) -> Result<Vec<f64>, Box<dyn Error>>,
b: Vec<f64>,
iterations: usize,
) -> Result<Vec<f64>, Box<dyn Error>> {
let mut x = Matrix::new(b.len(), 1);
let mut r = b.col_mat();
let mut p = r.clone();
for _ in 0..iterations {
let r_t = r.t();
let a_p = vec_mul(p.clone().vec())?.col_mat();
let alpha = (&r_t * &p)[0][0] / (p.t() * &a_p)[0][0];
let old_r = r.clone();
x = x + p.clone() * alpha;
r = r - a_p.clone() * alpha;
let beta = (r.t() * &r)[0][0] / (&r_t * &old_r)[0][0];
p = r.clone() + p * beta;
}
Ok(x.vec())
}
}