Function assert_orthogonal 

pub fn assert_orthogonal<F>(
    matrix: &ArrayView2<'_, F>,
    name: &str,
    tolerance: F,
) -> CoreResult<()>
where
    F: Float + Display + AddAssign + Debug,

Assert that a 2-D matrix is orthogonal within tolerance.

Checks that A^T * A is close to the identity matrix.