Skip to content

Commit a9f327f

Browse files
committed
Update fc_msp.c
- Add RSSI - Allow extended versions of future MSP2_COMMON_SET_MSP_RC_LINK_STATS and MSP2_COMMON_SET_MSP_RC_INFO still work with older (from now) INAV versions. Except for the new data.
1 parent 80c47fa commit a9f327f

File tree

1 file changed

+3
-3
lines changed

1 file changed

+3
-3
lines changed

src/main/fc/fc_msp.c

Lines changed: 3 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -2916,11 +2916,11 @@ static mspResult_e mspFcProcessInCommand(uint16_t cmdMSP, sbuf_t *src)
29162916

29172917
#ifdef USE_RX_MSP
29182918
case MSP2_COMMON_SET_MSP_RC_LINK_STATS:
2919-
if (dataSize == 7) {
2919+
if (dataSize >= 7) {
29202920
uint8_t sublinkID = sbufReadU8(src); // Sublink ID
29212921
sbufReadU8(src); // Valid link (Failsafe backup)
29222922
if (sublinkID == 1) {
2923-
sbufReadU8(src); // RSSI %
2923+
setRSSIFromMSP(sbufReadU8(src)); // RSSI %
29242924
rxLinkStatistics.uplinkRSSI = -sbufReadU16(src);
29252925
rxLinkStatistics.downlinkLQ = sbufReadU8(src);
29262926
rxLinkStatistics.uplinkLQ = sbufReadU8(src);
@@ -2931,7 +2931,7 @@ static mspResult_e mspFcProcessInCommand(uint16_t cmdMSP, sbuf_t *src)
29312931
break;
29322932

29332933
case MSP2_COMMON_SET_MSP_RC_INFO:
2934-
if (dataSize == 15) {
2934+
if (dataSize >= 15) {
29352935
uint8_t sublinkID = sbufReadU8(src);
29362936

29372937
if (sublinkID == 1) {

0 commit comments

Comments
 (0)