Commit 381b3ed7 authored by LM's avatar LM

Added debug vects

parent a8417079
......@@ -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:
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment