From 6351fd1e2cf9e2f7448558b3516ce84a988ff3da Mon Sep 17 00:00:00 2001
From: Lorenz Meier <lm@inf.ethz.ch>
Date: Mon, 5 May 2014 13:48:05 +0200
Subject: [PATCH] Added debug printfs

---
 src/modules/mavlink/mavlink_ftp.h | 13 +++++++++++--
 1 file changed, 11 insertions(+), 2 deletions(-)

diff --git a/src/modules/mavlink/mavlink_ftp.h b/src/modules/mavlink/mavlink_ftp.h
index 9615f7200f..eab2a567ab 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]); }