Add MANUAL_CONTROL output

src/comm/MockLink.cc

@@ -390,6 +390,10 @@ void MockLink::_handleIncomingMavlinkBytes(const uint8_t* bytes, int cBytes)
                 _handleCommandLong(msg);
                 break;
 
+            case MAVLINK_MSG_ID_MANUAL_CONTROL:
+                _handleManualControl(msg);
+                break;
+
             default:
                 break;
         }
@@ -413,6 +417,14 @@ void MockLink::_handleSetMode(const mavlink_message_t& msg)
     _mavCustomMode = request.custom_mode;
 }
 
+void MockLink::_handleManualControl(const mavlink_message_t& msg)
+{
+    mavlink_manual_control_t manualControl;
+    mavlink_msg_manual_control_decode(&msg, &manualControl);
+
+    qDebug() << "MANUAL_CONTROL" << manualControl.x << manualControl.y << manualControl.z << manualControl.r;
+}
+
 void MockLink::_setParamFloatUnionIntoMap(int componentId, const QString& paramName, float paramFloat)
 {
     mavlink_param_union_t   valueUnion;

src/comm/MockLink.h

@@ -187,6 +187,7 @@ private:
     void _handleParamRequestRead(const mavlink_message_t& msg);
     void _handleFTP(const mavlink_message_t& msg);
     void _handleCommandLong(const mavlink_message_t& msg);
+    void _handleManualControl(const mavlink_message_t& msg);
     float _floatUnionForParam(int componentId, const QString& paramName);
     void _setParamFloatUnionIntoMap(int componentId, const QString& paramName, float paramFloat);
     void _sendHomePosition(void);