Changed message staging

This commit is contained in:
Matt Beall
2015-03-31 10:52:26 -06:00
parent ce9f46d4e7
commit fa9f7075fa
+5 -3
View File
@@ -955,9 +955,11 @@ MavlinkReceiver::handle_message_ping(mavlink_message_t *msg)
{ {
mavlink_ping_t ping; mavlink_ping_t ping;
mavlink_msg_ping_decode( msg, &ping); mavlink_msg_ping_decode( msg, &ping);
if (mavlink_system.sysid == ping.target_system && if ((mavlink_system.sysid == ping.target_system) &&
mavlink_system.compid == ping.target_component) { (mavlink_system.compid == ping.target_component)) {
_mavlink->send_message(MAVLINK_MSG_ID_PING, &msg); mavlink_message_t msg_out;
mavlink_msg_ping_encode(_mavlink->get_system_id(), _mavlink->get_component_id(), &msg_out, &ping);
_mavlink->send_message(MAVLINK_MSG_ID_PING, &msg_out);
} }
} }