From 89e810c1b24360061bff55591289e66f4891e3fd Mon Sep 17 00:00:00 2001
From: Raphael Coeffic <rco@iptel.org>
Date: Wed, 26 Oct 2016 03:19:19 +0200
Subject: [PATCH] repeat the SPORT/MSP header for each SPORT message

---
 src/main/telemetry/smartport.c | 4 ++++
 1 file changed, 4 insertions(+)

diff --git a/src/main/telemetry/smartport.c b/src/main/telemetry/smartport.c
index 5d1e800c8f..a808f9a93a 100644
--- a/src/main/telemetry/smartport.c
+++ b/src/main/telemetry/smartport.c
@@ -489,6 +489,10 @@ bool smartPortSendMspReply()
 
         checksum = sbufBytesRemaining(txBuf) ^ smartPortMspReply.cmd;        
     }
+    else {
+        // header
+        *(p++) = (SMARTPORT_MSP_VERSION << 5) | (seq++ & 0xF);
+    }
 
     while ((p < end) && (sbufBytesRemaining(txBuf) > 0)) {
         *p = sbufReadU8(txBuf);