mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-24 05:33:33 +08:00
Fix unit test, create matrix isfinite.
This commit is contained in:
@@ -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;
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user