fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

Fix RSSI lower bound

Browse Source
This commit is contained in:
Lorenz Meier 2016-05-01 16:42:30 +02:00
parent 4ec4deabbd
commit 887dfd1ec4
1 changed files with 9 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
src/drivers/px4fmu/fmu.cpp
View File

@ -861,12 +861,18 @@ PX4FMU::fill_rc_in(uint16_t raw_rc_count,
/* set RSSI if analog RSSI input is present */
if (_analog_rc_rssi_stable) {
_rc_in.rssi = ((_analog_rc_rssi_volt - 0.2f) / 3.0f) * 100.0f;
float rssi = ((_analog_rc_rssi_volt - 0.2f) / 3.0f) * 100.0f;
if (_rc_in.rssi > 100) {
_rc_in.rssi = 100;
if (rssi > 100.0f) {
rssi = 100.0f;
}
if (rssi < 0.0f) {
rssi = 0.0f;
}
_rc_in.rssi = rssi;
} else {
_rc_in.rssi =
(!frame_drop) ? RC_INPUT_RSSI_MAX : (RC_INPUT_RSSI_MAX / 2);