Snippets per leggere i canali dei servo

[aerei] / libraries / common / common.cpp

diff --git a/libraries/common/common.cpp b/libraries/common/common.cpp
index de93b51949b60439f7cfe1630316f3eb167e1cc9..7f056275fd825bbeb550cba2a7953f41cce962a4 100644 (file)
--- a/libraries/common/common.cpp
+++ b/libraries/common/common.cpp
@@ -401,7 +401,7 @@ int calibraTrim(int pin, const byte ledPin) {
             break;
         };
         servoValue = pulseIn(pin, HIGH, 25000);
-        if (servoValue != 0 && servoValue > 1000 && servoValue <2000)  {
+        if (servoValue != 0 && servoValue > 950 && servoValue <2000)  {
             middle = middle + servoValue ;
             a++ ;
 #ifdef DEBUG
@@ -410,15 +410,15 @@ int calibraTrim(int pin, const byte ledPin) {
             Serial.println(middle / a);
 #endif 
             digitalWrite(ledPin, !digitalRead(ledPin));
-            delay(100);
+            delay(50);
         }
     }
 #ifdef DEBUG
     Serial.print(">> Fine Calibrazione, media: ");
-    Serial.println(middle / 10);
+    Serial.println(middle / 10 + 10);
     Serial.flush() ;
 #endif 
-    return(middle / 10) ;
+    return(middle / 10 + 10) ;
 // END calibrazione
 };