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:
Kurt Kiefer 2018-06-30 23:49:04 -07:00 committed by Lorenz Meier
parent fc16dce8f1
commit a114450f51

View File

@ -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_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);