SITL: correct SIM_FETtecOneWire consume function

when this was factored out the parameter wasn't taken into account.
4 years ago · 44803b92c7
1 changed files with 2 additions and 2 deletions
--- a/libraries/SITL/SIM_FETtecOneWireESC.cpp
+++ b/libraries/SITL/SIM_FETtecOneWireESC.cpp
@ -374,8 +374,8 @@ void FETtecOneWireESC::consume_bytes(uint8_t count)
        buflen = 0;
        return;
    }
-    memmove(&u.buffer[0], &u.buffer[u.config_message_header.frame_len], buflen - u.config_message_header.frame_len);
+    memmove(&u.buffer[0], &u.buffer[count], buflen - count);
-    buflen -= u.config_message_header.frame_len;
+    buflen -= count;
 }
 void FETtecOneWireESC::update_input()