diff --git a/src/uas/PxQuadMAV.cc b/src/uas/PxQuadMAV.cc index 25b413522807de2857dcc8279fa97787f2522e1b..b2c8392b282f2c06990b77ecc8e99cc538e7f9f1 100644 --- a/src/uas/PxQuadMAV.cc +++ b/src/uas/PxQuadMAV.cc @@ -47,6 +47,16 @@ void PxQuadMAV::receiveMessage(LinkInterface* link, mavlink_message_t message) emit processChanged(this->uasId, payload.watchdog_id, payload.process_id, payload.state, (payload.muted == 1) ? true : false, payload.crashes, payload.pid); } break; + case MAVLINK_MSG_ID_DEBUG_VECT: + { + mavlink_debug_vect_t vect; + mavlink_msg_debug_vect_decode(msg, &vect); + QString str((const char*)vect.name); + emit valueChanged(uasId, str+".x", vect.x, MG::TIME::getGroundTimeNow()); + emit valueChanged(uasId, str+".y", vect.y, MG::TIME::getGroundTimeNow()); + emit valueChanged(uasId, str+".z", vect.z, MG::TIME::getGroundTimeNow()); + break; + } default: // Do nothing break;