diff options
author | Matt Beall <matt.beall@greypointcorp.com> | 2015-03-31 10:30:57 -0600 |
---|---|---|
committer | Matt Beall <matt.beall@greypointcorp.com> | 2015-03-31 10:30:57 -0600 |
commit | ce9f46d4e75678729e014b3f94f01875acac2322 (patch) | |
tree | d9638da028f88d670add4be0109ee8e5daf4298e /src/modules/mavlink/mavlink_receiver.cpp | |
parent | 3d8c85920b06bf37f4a0b1c17de9863a7533a36d (diff) | |
download | px4-firmware-ce9f46d4e75678729e014b3f94f01875acac2322.tar.gz px4-firmware-ce9f46d4e75678729e014b3f94f01875acac2322.tar.bz2 px4-firmware-ce9f46d4e75678729e014b3f94f01875acac2322.zip |
Added ping message handling to mavlink receiver
Diffstat (limited to 'src/modules/mavlink/mavlink_receiver.cpp')
-rw-r--r-- | src/modules/mavlink/mavlink_receiver.cpp | 15 |
1 files changed, 15 insertions, 0 deletions
diff --git a/src/modules/mavlink/mavlink_receiver.cpp b/src/modules/mavlink/mavlink_receiver.cpp index e3f274b8b..1f91654da 100644 --- a/src/modules/mavlink/mavlink_receiver.cpp +++ b/src/modules/mavlink/mavlink_receiver.cpp @@ -157,6 +157,10 @@ MavlinkReceiver::handle_message(mavlink_message_t *msg) handle_message_optical_flow_rad(msg); break; + case MAVLINK_MSG_ID_PING: + handle_message_ping(msg); + break; + case MAVLINK_MSG_ID_SET_MODE: handle_message_set_mode(msg); break; @@ -947,6 +951,17 @@ MavlinkReceiver::handle_message_heartbeat(mavlink_message_t *msg) } void +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); + } +} + +void MavlinkReceiver::handle_message_request_data_stream(mavlink_message_t *msg) { mavlink_request_data_stream_t req; |