From 6488d18aadc6b9a171eec4d713ad08ea4f9a80fe Mon Sep 17 00:00:00 2001
From: hengli <hengli@student.ethz.ch>
Date: Tue, 16 Nov 2010 14:32:45 +0100
Subject: [PATCH] Partially fixed follow camera issue.

---
 src/ui/map3D/Pixhawk3DWidget.cc | 5 +++++
 1 file changed, 5 insertions(+)

diff --git a/src/ui/map3D/Pixhawk3DWidget.cc b/src/ui/map3D/Pixhawk3DWidget.cc
index a9cd4007f..96a42d9e4 100644
--- a/src/ui/map3D/Pixhawk3DWidget.cc
+++ b/src/ui/map3D/Pixhawk3DWidget.cc
@@ -243,6 +243,11 @@ Pixhawk3DWidget::display(void)
         robotYaw = uas->getYaw();
     }
 
+    if (followCamera)
+    {
+        recenter(robotY, robotX, -robotZ);
+    }
+
     robotPosition->setPosition(osg::Vec3(robotY, robotX, -robotZ));
     robotAttitude->setAttitude(osg::Quat(-robotYaw, osg::Vec3f(0.0f, 0.0f, 1.0f),
                                          robotPitch, osg::Vec3f(1.0f, 0.0f, 0.0f),
-- 
2.22.0