X-Git-Url: http://git.piffa.net/web?p=rover;a=blobdiff_plain;f=prototypes%2Fultra%2Fcheck_func%2Fcheck_func.ino;fp=prototypes%2Fultra%2Fcheck_func%2Fcheck_func.ino;h=057f17e2f61d2db5ba6830aa3c8a970fd12b2934;hp=815e3527a19922d17a2df47db48b9366a690493a;hb=ab995024225af895d46730bc34d758978e24f9e5;hpb=aec24e1fc4aff719b970951f624abf56da7f5f36

diff --git a/prototypes/ultra/check_func/check_func.ino b/prototypes/ultra/check_func/check_func.ino
index 815e352..057f17e 100644
--- a/prototypes/ultra/check_func/check_func.ino
+++ b/prototypes/ultra/check_func/check_func.ino
@@ -52,6 +52,7 @@ boolean distanceCheck() {
     // so it takes ~29.1 milliseconds for a cm.
     distance = (duration / 58.2); // Atmegas are not found of divisions
     // Distance is half of (out + back)
+    distance = constrain(distance,4,35);
 #ifdef DEBUG
 Serial.print("Distanza oggetto: ");    
 Serial.println(distance);
@@ -74,6 +75,7 @@ int distanceMonitor() {
     //distance = (duration / 2) / 29.1; // Speed is ~300m/s,
     // so it takes ~29.1 milliseconds for a cm.
     distance = (duration / 58.2); // Atmegas are not found of divisions
+    distance = constrain(distance,4,35);
     // Distance is half of (out + back)
 
     return distance;