From 64be134f7b16d663bc024cc3a7cc265e35bc7be2 Mon Sep 17 00:00:00 2001
From: Randy Mackay <rmackay9@yahoo.com>
Date: Fri, 30 Mar 2018 15:59:33 +0900
Subject: [PATCH] GCS_MAVLink: add VISP logging

---
 libraries/GCS_MAVLink/GCS_Common.cpp | 11 +++++++++++
 1 file changed, 11 insertions(+)

diff --git a/libraries/GCS_MAVLink/GCS_Common.cpp b/libraries/GCS_MAVLink/GCS_Common.cpp
index 43f10359e1..3f08db60a8 100644
--- a/libraries/GCS_MAVLink/GCS_Common.cpp
+++ b/libraries/GCS_MAVLink/GCS_Common.cpp
@@ -1925,6 +1925,17 @@ void GCS_MAVLINK::_handle_common_vision_position_estimate_data(const uint64_t us
                                angErr,
                                timestamp_ms,
                                reset_timestamp_ms);
+
+    // log data
+    DataFlash_Class::instance()->Log_Write("VISP", "TimeUS,PX,PY,PZ,Roll,Pitch,Yaw",
+                                           "smmmrrr", "F000000", "Qffffff",
+                                           (uint64_t)timestamp_ms * 1000,
+                                           (double)x,
+                                           (double)y,
+                                           (double)z,
+                                           (double)roll,
+                                           (double)pitch,
+                                           (double)yaw);
 }
 
 void GCS_MAVLINK::handle_att_pos_mocap(mavlink_message_t *msg)