Fixed lastest MSP version parsing error #64

DroneBridge · Mar 14, 2024 · ee1eabd · ee1eabd
1 parent 5486b14
commit ee1eabd
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/main/msp_ltm_serial.c b/main/msp_ltm_serial.c
@@ -139,7 +139,7 @@ bool parse_msp_ltm_byte(msp_ltm_port_t *msp_ltm_port, uint8_t new_byte) {
             break;
 
         case MSP_HEADER_M:
-            if (new_byte == '>') {
+            if (new_byte == '>' || new_byte == '!') {
                 msp_ltm_port->offset = 0;
                 msp_ltm_port->checksum1 = 0;
                 msp_ltm_port->checksum2 = 0;
@@ -150,7 +150,7 @@ bool parse_msp_ltm_byte(msp_ltm_port_t *msp_ltm_port, uint8_t new_byte) {
             break;
 
         case MSP_HEADER_X:
-            if (new_byte == '>') {
+            if (new_byte == '>' || new_byte == '!') {
                 msp_ltm_port->offset = 0;
                 msp_ltm_port->checksum2 = 0;
                 msp_ltm_port->mspVersion = MSP_V2_NATIVE;