Fix unit test, create matrix isfinite.

This commit is contained in:
James Goppert
2017-02-03 16:25:55 -05:00
parent 7e3eff7b2d
commit 230e84702a
2 changed files with 12 additions and 7 deletions
+3 -3
View File
@@ -239,9 +239,9 @@ bool inv(const SquareMatrix<Type, M> & A, SquareMatrix<Type, M> & inv)
}
//check sanity of results
for (uint8_t i = 0; i < M; i++) {
for (uint8_t j = 0; j < M; j++) {
if (!PX4_ISFINITE(P(i,j))) {
for (size_t i = 0; i < M; i++) {
for (size_t j = 0; j < M; j++) {
if (!isfinite(P(i,j))) {
return false;
}
}