Luka Slapnik / sbus_decode1

final1

Dependents:   CyberbotV1

Diff: SBUS.cpp

Revision:
5:1836bd646986
Parent:
4:da8728f3d289
Child:
6:c4c97ac35bc4
--- a/SBUS.cpp	Sat Jun 29 02:33:56 2019 +0000
+++ b/SBUS.cpp	Sat Jun 29 02:37:30 2019 +0000
@@ -76,6 +76,7 @@
 void SBUS::convertReceivedData() {
     for(int i = 0; i < 4; i++) {
         float buf;
+        if((channel[i] < (stickNeutralValue + 5)) && (channel[i] > (stickNeutralValue - 5))) channel[i] = stickNeutralValue;
         if(channel[i] > stickNeutralValue) buf = ((channel[i] - stickNeutralValue) / (float)(stickMaximumValue - stickNeutralValue));
         else buf = -((channel[i] - stickNeutralValue) / (float)(stickMinimumValue - stickNeutralValue));
         switch(i) {