Possible UDP bugfix

BeyondRobotix/mavesp8266#63
BorealisJames · Apr 28, 2023 · 13e6816 · 13e6816
1 parent e2816bd
commit 13e6816
Showing 1 changed file with 2 additions and 1 deletion.
diff --git a/src/mavesp8266_vehicle.cpp b/src/mavesp8266_vehicle.cpp
@@ -94,7 +94,8 @@ MavESP8266Vehicle::readMessage()
             //-- Move the pending ones up the queue
             int left = _queue_count - sent;
             for(int i = 0; i < left; i++) {
-                memcpy(&_message[sent+i], &_message[i], sizeof(mavlink_message_t));
+                //memcpy(&_message[sent+i], &_message[i], sizeof(mavlink_message_t));
+                memcpy(&_message[i], &_message[sent+i], sizeof(mavlink_message_t));
             }
             _queue_count = left;
         }