Changed message staging

This commit is contained in:
Matt Beall 2015-03-31 10:52:26 -06:00
parent ce9f46d4e7
commit fa9f7075fa

View File

@ -955,9 +955,11 @@ MavlinkReceiver::handle_message_ping(mavlink_message_t *msg)
{
mavlink_ping_t ping;
mavlink_msg_ping_decode( msg, &ping);
if (mavlink_system.sysid == ping.target_system &&
mavlink_system.compid == ping.target_component) {
_mavlink->send_message(MAVLINK_MSG_ID_PING, &msg);
if ((mavlink_system.sysid == ping.target_system) &&
(mavlink_system.compid == ping.target_component)) {
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);
}
}