From efd8757fda6f01baed4e49c60ff4ea4ff21d72b6 Mon Sep 17 00:00:00 2001
From: Julian Oes <julian@oes.ch>
Date: Thu, 10 Jun 2021 11:55:48 +0200
Subject: [PATCH] manual_control: handle NAN

---
 src/modules/manual_control/ManualControl.hpp | 5 +++++
 1 file changed, 5 insertions(+)

diff --git a/src/modules/manual_control/ManualControl.hpp b/src/modules/manual_control/ManualControl.hpp
index 9e1aa56f7b..79b0a5c6d4 100644
--- a/src/modules/manual_control/ManualControl.hpp
+++ b/src/modules/manual_control/ManualControl.hpp
@@ -59,6 +59,11 @@ class MovingDiff
 public:
 	void update(float value, float dt_s)
 	{
+		if (!PX4_ISFINITE(value)) {
+			// Ignore NAN
+			return;
+		}
+
 		math::constrain(dt_s, 0.f, _time_period_s);
 
 		// Leave _diff at 0.0f if we don't have a _last_value yet.