From 381b3ed70031b59f75a8215a9aa0c746b90b4640 Mon Sep 17 00:00:00 2001 From: LM Date: Mon, 10 Oct 2011 11:24:43 +0200 Subject: [PATCH] Added debug vects --- src/uas/UAS.cc | 10 ++++++++++ 1 file changed, 10 insertions(+) diff --git a/src/uas/UAS.cc b/src/uas/UAS.cc index 44c0f6f13..8babe6e63 100644 --- a/src/uas/UAS.cc +++ b/src/uas/UAS.cc @@ -891,6 +891,16 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message) case MAVLINK_MSG_ID_SERVO_OUTPUT_RAW: case MAVLINK_MSG_ID_OPTICAL_FLOW: case MAVLINK_MSG_ID_DEBUG_VECT: + { + mavlink_debug_vect_t debug; + mavlink_msg_debug_vect_decode(&message, &debug); + QString name(debug.name); + quint64 time = getUnixTime(debug.time_usec); + emit valueChanged(uasId, name+".x", "raw", debug.x, time); + emit valueChanged(uasId, name+".y", "raw", debug.y, time); + emit valueChanged(uasId, name+".z", "raw", debug.z, time); + } + break; case MAVLINK_MSG_ID_DEBUG: break; default: -- 2.22.0