From a114450f5108e6ed614334666104f3ab08d55ea6 Mon Sep 17 00:00:00 2001
From: Kurt Kiefer <kekiefer@gmail.com>
Date: Sat, 30 Jun 2018 23:49:04 -0700
Subject: [PATCH] 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.
---
 src/modules/px4iofirmware/controls.c | 8 +++++++-
 1 file changed, 7 insertions(+), 1 deletion(-)

diff --git a/src/modules/px4iofirmware/controls.c b/src/modules/px4iofirmware/controls.c
index 87d56a04c3..7dd5cdd82a 100644
--- a/src/modules/px4iofirmware/controls.c
+++ b/src/modules/px4iofirmware/controls.c
@@ -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);