Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-20 06:45:16 +03:00
Code Issues Wiki Activity

repeat the SPORT/MSP header for each SPORT message

Browse source
This commit is contained in:
Raphael Coeffic 2016-10-26 03:19:19 +02:00
parent 4c8e08b402
commit 89e810c1b2
1 changed files with 4 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

4
src/main/telemetry/smartport.c
View file

@ -489,6 +489,10 @@ bool smartPortSendMspReply()
checksum = sbufBytesRemaining(txBuf) ^ smartPortMspReply.cmd; checksum = sbufBytesRemaining(txBuf) ^ smartPortMspReply.cmd;
} }
else {
// header
*(p++) = (SMARTPORT_MSP_VERSION << 5) | (seq++ & 0xF);
}
while ((p < end) && (sbufBytesRemaining(txBuf) > 0)) { while ((p < end) && (sbufBytesRemaining(txBuf) > 0)) {
*p = sbufReadU8(txBuf); *p = sbufReadU8(txBuf);