use crate::domain::scalar::Scalar;
use leto::{ArrayView2, LetoError, Result};
#[inline]
pub fn trace<T: Scalar>(matrix: &ArrayView2<'_, T>) -> Result<T> {
let [rows, cols] = matrix.shape();
if rows != cols {
return Err(LetoError::ShapeMismatch {
lhs: vec![rows, cols],
rhs: vec![rows, rows],
});
}
if rows == 0 {
return Ok(T::ZERO);
}
matrix.layout().validate_storage_len(matrix.data().len())?;
let data = matrix.data();
let strides = matrix.strides();
let diag_stride = strides[0] + strides[1];
let mut offset = matrix.offset() as isize;
let mut acc = T::ZERO;
for _ in 0..rows {
unsafe {
acc = acc.add(*data.get_unchecked(offset as usize));
}
offset += diag_stride;
}
Ok(acc)
}