From 20462b01f7396274dac06c2ea4f8b1704329e145 Mon Sep 17 00:00:00 2001
From: alexklimaj <alex@arkelectron.com>
Date: Tue, 25 Feb 2025 11:59:37 -0700
Subject: [PATCH] uavcannode rangefinder: add tolerance to reading too close
 check

---
 src/drivers/uavcannode/Publishers/RangeSensorMeasurement.hpp | 4 +++-
 1 file changed, 3 insertions(+), 1 deletion(-)

diff --git a/src/drivers/uavcannode/Publishers/RangeSensorMeasurement.hpp b/src/drivers/uavcannode/Publishers/RangeSensorMeasurement.hpp
index 2ad053d9a409..134caea21aff 100644
--- a/src/drivers/uavcannode/Publishers/RangeSensorMeasurement.hpp
+++ b/src/drivers/uavcannode/Publishers/RangeSensorMeasurement.hpp
@@ -100,10 +100,12 @@ class RangeSensorMeasurement :
 			}
 
 			// reading_type
+			const float tolerance = 1e-6;
+
 			if (dist.current_distance > dist.max_distance) {
 				range_sensor.reading_type = uavcan::equipment::range_sensor::Measurement::READING_TYPE_TOO_FAR;
 
-			} else if (dist.current_distance < dist.min_distance) {
+			} else if (dist.current_distance < dist.min_distance - tolerance) {
 				range_sensor.reading_type = uavcan::equipment::range_sensor::Measurement::READING_TYPE_TOO_CLOSE;
 
 			} else if (dist.signal_quality != 0) {