ortho_check function now prints out sum of diagonal elements if it detects orthogonality being lost this should help with diagnosing orthogonality problems