From d9c95f97d7896e2205a9635a67b14a0e96dd6e28 Mon Sep 17 00:00:00 2001
From: alteman <alteman@users.noreply.github.com>
Date: Sun, 5 Mar 2017 19:41:15 +0300
Subject: [PATCH] Add support for PX4 RSSI (#4559)

---
 radio/src/telemetry/mavlink.cpp | 13 ++++++++++++-
 1 file changed, 12 insertions(+), 1 deletion(-)

diff --git a/radio/src/telemetry/mavlink.cpp b/radio/src/telemetry/mavlink.cpp
index d1b82fe32..514cacc50 100644
--- a/radio/src/telemetry/mavlink.cpp
+++ b/radio/src/telemetry/mavlink.cpp
@@ -117,7 +117,15 @@ static inline void REC_MAVLINK_MSG_ID_SYS_STATUS(const mavlink_message_t* msg) {
 #endif
 }
 
-/*!	\brief Recive rc channels
+/*!	\brief Receive rc channels
+ *
+ */
+static inline void REC_MAVLINK_MSG_ID_RC_CHANNELS(const mavlink_message_t* msg) {
+	uint8_t temp_scale = 5 + g_model.mavlink.rc_rssi_scale;
+	telemetry_data.rc_rssi =  mavlink_msg_rc_channels_get_rssi(msg) * 20 / temp_scale;
+}
+
+/*!	\brief Receive raw rc channels
  *
  */
 static inline void REC_MAVLINK_MSG_ID_RC_CHANNELS_RAW(const mavlink_message_t* msg) {
@@ -369,6 +377,9 @@ static inline void handleMessage(mavlink_message_t* p_rxmsg) {
 	case MAVLINK_MSG_ID_SYS_STATUS:
 		REC_MAVLINK_MSG_ID_SYS_STATUS(p_rxmsg);
 		break;
+	case MAVLINK_MSG_ID_RC_CHANNELS:
+		REC_MAVLINK_MSG_ID_RC_CHANNELS(p_rxmsg);
+		break;
 	case MAVLINK_MSG_ID_RC_CHANNELS_RAW:
 		REC_MAVLINK_MSG_ID_RC_CHANNELS_RAW(p_rxmsg);
 		break;