diff --git a/libraries/GCS_MAVLink/MAVLink_routing.cpp b/libraries/GCS_MAVLink/MAVLink_routing.cpp index 5b2eaad929..059aa5f305 100644 --- a/libraries/GCS_MAVLink/MAVLink_routing.cpp +++ b/libraries/GCS_MAVLink/MAVLink_routing.cpp @@ -420,6 +420,14 @@ void MAVLink_routing::get_targets(const mavlink_message_t* msg, int16_t &sysid, sysid = mavlink_msg_v2_extension_get_target_system(msg); compid = mavlink_msg_v2_extension_get_target_component(msg); break; + case MAVLINK_MSG_ID_GIMBAL_REPORT: + sysid = mavlink_msg_gimbal_report_get_target_system(msg); + compid = mavlink_msg_gimbal_report_get_target_component(msg); + break; + case MAVLINK_MSG_ID_GIMBAL_CONTROL: + sysid = mavlink_msg_gimbal_control_get_target_system(msg); + compid = mavlink_msg_gimbal_control_get_target_component(msg); + break; } }