AP_Math: Add is_all_nan

* Used when the whole vector being NaN is significant Signed-off-by: Ryan Friedman <ryanfriedman5410+github@gmail.com>
ArduPilot · Feb 5, 2024 · 76348e0 · 76348e0
1 parent c9d878e
commit 76348e0
Show file tree

Hide file tree

Showing 2 changed files with 9 additions and 0 deletions.
diff --git a/libraries/AP_Math/vector3.cpp b/libraries/AP_Math/vector3.cpp
@@ -366,6 +366,12 @@ bool Vector3<T>::is_nan(void) const
     return isnan(x) || isnan(y) || isnan(z);
 }
 
+template <typename T>
+bool Vector3<T>::is_all_nan(void) const
+{
+    return isnan(x) && isnan(y) && isnan(z);
+}
+
 template <typename T>
 bool Vector3<T>::is_inf(void) const
 {

diff --git a/libraries/AP_Math/vector3.h b/libraries/AP_Math/vector3.h
@@ -182,6 +182,9 @@ class Vector3
     // check if any elements are NAN
     bool is_nan(void) const WARN_IF_UNUSED;
 
+    // check if all elements are NAN
+    bool is_all_nan(void) const WARN_IF_UNUSED;
+
     // check if any elements are infinity
     bool is_inf(void) const WARN_IF_UNUSED;