use deep_causality_algebra::RealField;
pub(crate) fn inertia<R: RealField>(m: &[[R; 4]; 4]) -> (usize, usize, usize) {
let mut a = *m;
let mut active = [true; 4];
let (mut positive, mut negative) = (0, 0);
loop {
let rows = (0..4).filter(|&i| active[i]);
let (mut big, mut big_at) = (R::zero(), (0, 0));
let (mut diag, mut diag_at) = (R::zero(), 0);
for i in rows.clone() {
for j in (0..4).filter(|&j| active[j]) {
if a[i][j].abs() > big {
big = a[i][j].abs();
big_at = (i, j);
}
}
if a[i][i].abs() > diag {
diag = a[i][i].abs();
diag_at = i;
}
}
let remaining = rows.count();
if remaining == 0 || big == R::zero() {
return (positive, negative, remaining);
}
if diag + diag >= big {
let p = diag_at;
if a[p][p] > R::zero() {
positive += 1;
} else {
negative += 1;
}
active[p] = false;
for j in (0..4).filter(|&j| active[j]) {
for k in (0..4).filter(|&k| active[k]) {
a[j][k] -= a[j][p] * (a[p][k] / a[p][p]);
}
}
} else {
let (p, q) = big_at;
let b = a[p][q];
let (alpha, beta) = (a[p][p] / b, a[q][q] / b);
let d = alpha * beta - R::one();
positive += 1;
negative += 1;
active[p] = false;
active[q] = false;
for j in (0..4).filter(|&j| active[j]) {
for k in (0..4).filter(|&k| active[k]) {
let (r_p, r_q) = (a[p][k] / b, a[q][k] / b);
let u_p = (beta * r_p - r_q) / d;
let u_q = (alpha * r_q - r_p) / d;
a[j][k] -= a[j][p] * u_p + a[j][q] * u_q;
}
}
}
}
}