mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-01 19:07:45 +08:00
Changed message staging
This commit is contained in:
@@ -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);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user