From 1da934049c082bdc42f6c1621c002266f7440335 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Beat=20K=C3=BCng?= <beat-kueng@gmx.net>
Date: Thu, 26 Jan 2017 15:49:39 +0100
Subject: [PATCH] matrix_alg: use PX4_ISFINITE() instead if isnan() & isinf()

---
 src/lib/mathlib/math/matrix_alg.cpp | 3 ++-
 1 file changed, 2 insertions(+), 1 deletion(-)

diff --git a/src/lib/mathlib/math/matrix_alg.cpp b/src/lib/mathlib/math/matrix_alg.cpp
index d45d57add7..e471c6bad6 100644
--- a/src/lib/mathlib/math/matrix_alg.cpp
+++ b/src/lib/mathlib/math/matrix_alg.cpp
@@ -39,6 +39,7 @@
  */
 
 #include "matrix_alg.h"
+#include <px4_defines.h>
 
 /*
  *    Does matrix multiplication of two regular/square matrices
@@ -239,7 +240,7 @@ bool mat_inverse(float *A, float *inv, uint8_t n)
 	//check sanity of results
 	for (uint8_t i = 0; i < n; i++) {
 		for (uint8_t j = 0; j < n; j++) {
-			if (isnan(inv_pivoted[i * n + j]) || isinf(inv_pivoted[i * n + j])) {
+			if (!PX4_ISFINITE(inv_pivoted[i * n + j])) {
 				ret = false;
 			}
 		}