AP_Rangefinder: fix (very) out-of-range lidar causing float inf

ArduPilot · Mar 13, 2024 · 12f3270 · 12f3270
1 parent 9feccd6
commit 12f3270
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/libraries/AP_RangeFinder/AP_RangeFinder_SITL.cpp b/libraries/AP_RangeFinder/AP_RangeFinder_SITL.cpp
@@ -35,7 +35,7 @@ void AP_RangeFinder_SITL::update(void)
     const float dist = AP::sitl()->get_rangefinder(_instance);
 
     // nan distance means nothing is connected
-    if (isnan(dist)) {
+    if (isnan(dist) || isinf(dist)) {
         state.status = RangeFinder::Status::NoData;
         return;
     }