Yuta Togashi / SBUS_STM32

Dependents:   purppo-kudou mbed_kudou_roller

Revision:
1:28f9c5332835
Parent:
0:5c60871db7d7
--- a/sbus.cpp	Fri Apr 16 00:36:21 2021 +0000
+++ b/sbus.cpp	Tue Jul 12 12:10:23 2022 +0000
@@ -32,15 +32,17 @@
     char buf;
     buf = com.getc();
     
-    if(receiveTimer.read_ms() > 6)  {
+    if(receiveTimer.read() > 0.006f)  {
         if(buf == 0x0F) {
             data_count = 0;
             enableReceive = true;
+            receiveTimer.reset();
         } else{
-            enableReceive = false;
-        }         
+            enableReceive = false; 
+        }      
     }
-    receiveTimer.reset();
+    
+    if(enableReceive)    receiveTimer.reset();
     
     if(enableReceive) {
         if(data_count < 25) {