Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-25 01:05:27 +03:00
Code Issues Wiki Activity

Receive RSSI value via MSP/SmartPort

Browse source
This commit is contained in:
Bas Delfos 2017-11-07 20:54:45 +01:00
parent 800e44906d
commit f87e768ce6
2 changed files with 13 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

11
src/main/fc/fc_msp.c
View file

@ -1974,6 +1974,17 @@ static mspResult_e mspProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
break; break;
#endif #endif
case MSP_TX_INFO:
{
uint8_t rssi_tx = sbufReadU8(src);
// Ignore rssi from MSP when RSSI channel or RSSIPWM feature is enabled
if (rxConfig()->rssi_channel == 0 && !featureConfigured(FEATURE_RSSI_ADC)) {
// Range of rssi_tx is [1;100]. rssi should be in [0;1023];
rssi = (uint16_t)((rssi_tx / 100.0f) * 1023.0f);
}
}
break;
default: default:
// we do not know how to handle the (valid) message, indicate error MSP $M! // we do not know how to handle the (valid) message, indicate error MSP $M!
return MSP_RESULT_ERROR; return MSP_RESULT_ERROR;

2
src/main/msp/msp_protocol.h
View file

@ -230,6 +230,8 @@
#define MSP_BEEPER_CONFIG 184 #define MSP_BEEPER_CONFIG 184
#define MSP_SET_BEEPER_CONFIG 185 #define MSP_SET_BEEPER_CONFIG 185
#define MSP_TX_INFO 186
// //
// Multwii original MSP commands // Multwii original MSP commands
// //