Browse Source

readded vision speed estimate display in realtime graph view, pixhawk specific

QGC4.4
pixhawk 14 years ago
parent
commit
0046adb64d
  1. 10
      src/uas/UAS.cc

10
src/uas/UAS.cc

@ -421,6 +421,16 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message) @@ -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<double>(speed.x), time);
emit valueChanged(uasId, "vis.speed y", "m/s", static_cast<double>(speed.y), time);
emit valueChanged(uasId, "vis.speed z", "m/s", static_cast<double>(speed.z), time);
}
break;
#endif // PIXHAWK
case MAVLINK_MSG_ID_RAW_IMU:
{

Loading…
Cancel
Save