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);