mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-29 06:33:33 +08:00
spektrum_rssi: clear PX4IO_P_SETUP_FEATURES_ADC_RSSI when valid
When we're getting valid rssi input from the telemetry receiver, clear the flag PX4IO_P_SETUP_FEATURES_ADC_RSSI in r_setup_features.
This commit is contained in:
committed by
Lorenz Meier
parent
fc16dce8f1
commit
a114450f51
@@ -94,7 +94,13 @@ bool dsm_port_input(uint16_t *rssi, bool *dsm_updated, bool *st24_updated, bool
|
|||||||
r_raw_rc_flags &= ~(PX4IO_P_RAW_RC_FLAGS_FRAME_DROP);
|
r_raw_rc_flags &= ~(PX4IO_P_RAW_RC_FLAGS_FRAME_DROP);
|
||||||
r_raw_rc_flags &= ~(PX4IO_P_RAW_RC_FLAGS_FAILSAFE);
|
r_raw_rc_flags &= ~(PX4IO_P_RAW_RC_FLAGS_FAILSAFE);
|
||||||
|
|
||||||
*rssi = spektrum_rssi;
|
if (spektrum_rssi >= 0 && spektrum_rssi <= 100) {
|
||||||
|
|
||||||
|
/* ensure ADC RSSI is disabled */
|
||||||
|
r_setup_features &= ~(PX4IO_P_SETUP_FEATURES_ADC_RSSI);
|
||||||
|
|
||||||
|
*rssi = spektrum_rssi;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
perf_end(c_gather_dsm);
|
perf_end(c_gather_dsm);
|
||||||
|
|||||||
Reference in New Issue
Block a user