Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-22 07:44:03 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_RCProtocol: fixed scaling on FPort RSSI

Browse Source 
make it match OpenTX
This commit is contained in:
Andrew Tridgell 2020-01-09 07:08:11 +11:00
parent 2f60f783d4
commit 5588229f68
1 changed files with 6 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
libraries/AP_RCProtocol/AP_RCProtocol_FPort.cpp
View File

@ -22,6 +22,7 @@
#include <AP_Frsky_Telem/AP_Frsky_Telem.h> #include <AP_Frsky_Telem/AP_Frsky_Telem.h>
#include <AP_Vehicle/AP_Vehicle_Type.h> #include <AP_Vehicle/AP_Vehicle_Type.h>
#include <RC_Channel/RC_Channel.h> #include <RC_Channel/RC_Channel.h>
#include <AP_Math/AP_Math.h>
extern const AP_HAL::HAL& hal; extern const AP_HAL::HAL& hal;
@ -116,7 +117,11 @@ void AP_RCProtocol_FPort::decode_control(const FPort_Frame &frame)
} }
bool failsafe = ((frame.control.flags & (1 << FLAGS_FAILSAFE_BIT)) != 0); bool failsafe = ((frame.control.flags & (1 << FLAGS_FAILSAFE_BIT)) != 0);
add_input(MAX_CHANNELS, values, failsafe, frame.control.rssi);
// we scale rssi by 2x to make it match the value displayed in OpenTX
const uint8_t scaled_rssi = MIN(frame.control.rssi*2, 255);
add_input(MAX_CHANNELS, values, failsafe, scaled_rssi);
} }
/* /*