From 319723a1ec3d7bd49b3b4e357eedbb9190b2acb3 Mon Sep 17 00:00:00 2001
From: Oleg Kalachev <okalachev@gmail.com>
Date: Fri, 22 Mar 2019 02:06:30 +0300
Subject: [PATCH] mavlink_receiver: ignore BATTERY_STATUS of other system
---
src/modules/mavlink/mavlink_receiver.cpp | 5 +++++
1 file changed, 5 insertions(+)
diff --git a/src/modules/mavlink/mavlink_receiver.cpp b/src/modules/mavlink/mavlink_receiver.cpp
index 4dc67274f8..8d541408e3 100644
--- a/src/modules/mavlink/mavlink_receiver.cpp
+++ b/src/modules/mavlink/mavlink_receiver.cpp
@@ -1509,6 +1509,11 @@ MavlinkReceiver::handle_message_ping(mavlink_message_t *msg)
void
MavlinkReceiver::handle_message_battery_status(mavlink_message_t *msg)
{
+ if (msg->sysid != mavlink_system.sysid) {
+ // ignore battery status of other system
+ return;
+ }
+
// external battery measurements
mavlink_battery_status_t battery_mavlink;
mavlink_msg_battery_status_decode(msg, &battery_mavlink);
--
GitLab