From a3bd9ead4cffcc2f42ccde7ab72da1de297df67a Mon Sep 17 00:00:00 2001 From: Jaeyoung-Lim Date: Fri, 11 Oct 2019 21:24:02 +0200 Subject: [PATCH] Add message handlers for onboard computer status --- src/modules/mavlink/mavlink_receiver.cpp | 12 ++++++++++++ src/modules/mavlink/mavlink_receiver.h | 1 + 2 files changed, 13 insertions(+) diff --git a/src/modules/mavlink/mavlink_receiver.cpp b/src/modules/mavlink/mavlink_receiver.cpp index 0b0ada8080..953ea4066e 100644 --- a/src/modules/mavlink/mavlink_receiver.cpp +++ b/src/modules/mavlink/mavlink_receiver.cpp @@ -245,6 +245,10 @@ MavlinkReceiver::handle_message(mavlink_message_t *msg) handle_message_debug_float_array(msg); break; + case MAVLINK_MSG_ID_ONBOARD_COMPUTER_STATUS: + handle_message_onboard_computer_status(msg); + break; + default: break; } @@ -2535,6 +2539,14 @@ MavlinkReceiver::handle_message_debug_float_array(mavlink_message_t *msg) _debug_array_pub.publish(debug_topic); } +void +MavlinkReceiver::handle_message_onboard_computer_status(mavlink_message_t *msg) +{ + mavlink_onboard_computer_status_t status_msg; + mavlink_msg_onboard_computer_status_decode(msg, &status_msg); + +} + /** * Receive data from UART/UDP */ diff --git a/src/modules/mavlink/mavlink_receiver.h b/src/modules/mavlink/mavlink_receiver.h index 95e94adf2e..1d39f5a63b 100644 --- a/src/modules/mavlink/mavlink_receiver.h +++ b/src/modules/mavlink/mavlink_receiver.h @@ -165,6 +165,7 @@ private: void handle_message_trajectory_representation_waypoints(mavlink_message_t *msg); void handle_message_utm_global_position(mavlink_message_t *msg); void handle_message_vision_position_estimate(mavlink_message_t *msg); + void handle_message_onboard_computer_status(mavlink_message_t *msg); void Run();