fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-07 03:01:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

Added debug printfs

Browse Source
This commit is contained in:
Lorenz Meier
2014-05-05 13:48:05 +02:00
parent 2e1dae2a7f
commit 6351fd1e2c
1 changed files with 11 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mavlink/mavlink_ftp.h
+11 -2
View File
@@ -52,6 +52,7 @@
#include <queue.h> #include <queue.h>
#include <nuttx/wqueue.h> #include <nuttx/wqueue.h>
#include <systemlib/err.h>
#include "mavlink_messages.h" #include "mavlink_messages.h"
@@ -146,8 +147,16 @@ private:
mavlink_channel_t channel; mavlink_channel_t channel;
void decode(mavlink_channel_t fromChannel, mavlink_message_t *fromMessage) { void decode(mavlink_channel_t fromChannel, mavlink_message_t *fromMessage) {
channel = fromChannel; switch (fromMessage->msgid) {
mavlink_msg_encapsulated_data_decode(fromMessage, &_message);
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]); } RequestHeader *header() { return reinterpret_cast<RequestHeader *>(&_message.data[0]); }