From 0046adb64d85195e98eafca079ef02f078b12786 Mon Sep 17 00:00:00 2001 From: pixhawk Date: Mon, 15 Aug 2011 09:44:43 +0200 Subject: [PATCH] readded vision speed estimate display in realtime graph view, pixhawk specific --- src/uas/UAS.cc | 10 ++++++++++ 1 file changed, 10 insertions(+) diff --git a/src/uas/UAS.cc b/src/uas/UAS.cc index 4340baa89..1b86477ec 100644 --- a/src/uas/UAS.cc +++ b/src/uas/UAS.cc @@ -421,6 +421,16 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message) emit gpsLocalizationChanged(this, status.gps_fix); } break; + case MAVLINK_MSG_ID_VISION_SPEED_ESTIMATE: + { + mavlink_vision_speed_estimate_t speed; + mavlink_msg_vision_speed_estimate_decode(&message, &speed); + quint64 time = getUnixTime(speed.usec); + emit valueChanged(uasId, "vis.speed x", "m/s", static_cast(speed.x), time); + emit valueChanged(uasId, "vis.speed y", "m/s", static_cast(speed.y), time); + emit valueChanged(uasId, "vis.speed z", "m/s", static_cast(speed.z), time); + } + break; #endif // PIXHAWK case MAVLINK_MSG_ID_RAW_IMU: { -- 2.22.0