From f8c50f442f83b3fc2ff793f895e2be0b070d0e4d Mon Sep 17 00:00:00 2001
From: Vasily Evseenko <svpcom@gmail.com>
Date: Sun, 10 Mar 2019 18:16:01 +0300
Subject: [PATCH] Fix RSSI in on FMUv4 (pixracer)
---
boards/px4/fmu-v4/src/init.c | 1 -
src/drivers/rc_input/RCInput.cpp | 4 ++++
2 files changed, 4 insertions(+), 1 deletion(-)
diff --git a/boards/px4/fmu-v4/src/init.c b/boards/px4/fmu-v4/src/init.c
index 13d8545276..928e54def8 100644
--- a/boards/px4/fmu-v4/src/init.c
+++ b/boards/px4/fmu-v4/src/init.c
@@ -206,7 +206,6 @@ stm32_boardinitialize(void)
// Safety - led on in led driver.
stm32_configgpio(GPIO_BTN_SAFETY);
- stm32_configgpio(GPIO_RSSI_IN);
stm32_configgpio(GPIO_PPM_IN);
int spi_init_mask = SPI_BUS_INIT_MASK;
diff --git a/src/drivers/rc_input/RCInput.cpp b/src/drivers/rc_input/RCInput.cpp
index 7afea2fd77..816b566c51 100644
--- a/src/drivers/rc_input/RCInput.cpp
+++ b/src/drivers/rc_input/RCInput.cpp
@@ -795,6 +795,10 @@ int RCInput::print_status()
PX4_INFO("CRSF Telemetry: %s", _crsf_telemetry ? "yes" : "no");
PX4_INFO("SBUS frame drops: %u", sbus_dropped_frames());
+#if ADC_RC_RSSI_CHANNEL
+ PX4_INFO("vrssi: %dmV", (int)(_analog_rc_rssi_volt * 1000.0f));
+#endif
+
perf_print_counter(_cycle_perf);
perf_print_counter(_publish_interval_perf);
--
GitLab