diff options
author | Lorenz Meier <lm@inf.ethz.ch> | 2014-05-05 13:48:05 +0200 |
---|---|---|
committer | Lorenz Meier <lm@inf.ethz.ch> | 2014-05-05 13:48:05 +0200 |
commit | 6351fd1e2cf9e2f7448558b3516ce84a988ff3da (patch) | |
tree | d4fb7437159f888c008f786dc8eb88a0a6e67364 /src/modules/mavlink | |
parent | 2e1dae2a7f0e0798ddd5df3c1705553e69e248eb (diff) | |
download | px4-firmware-6351fd1e2cf9e2f7448558b3516ce84a988ff3da.tar.gz px4-firmware-6351fd1e2cf9e2f7448558b3516ce84a988ff3da.tar.bz2 px4-firmware-6351fd1e2cf9e2f7448558b3516ce84a988ff3da.zip |
Added debug printfs
Diffstat (limited to 'src/modules/mavlink')
-rw-r--r-- | src/modules/mavlink/mavlink_ftp.h | 13 |
1 files changed, 11 insertions, 2 deletions
diff --git a/src/modules/mavlink/mavlink_ftp.h b/src/modules/mavlink/mavlink_ftp.h index 9615f7200..eab2a567a 100644 --- a/src/modules/mavlink/mavlink_ftp.h +++ b/src/modules/mavlink/mavlink_ftp.h @@ -52,6 +52,7 @@ #include <queue.h> #include <nuttx/wqueue.h> +#include <systemlib/err.h> #include "mavlink_messages.h" @@ -146,8 +147,16 @@ private: mavlink_channel_t channel; void decode(mavlink_channel_t fromChannel, mavlink_message_t *fromMessage) { - channel = fromChannel; - mavlink_msg_encapsulated_data_decode(fromMessage, &_message); + switch (fromMessage->msgid) { + + case MAVLINK_MSG_ID_ENCAPSULATED_DATA: + channel = fromChannel; + mavlink_msg_encapsulated_data_decode(fromMessage, &_message); + warnx("got enc data"); + break; + default: + warnx("unknown msg"); + } } RequestHeader *header() { return reinterpret_cast<RequestHeader *>(&_message.data[0]); } |