keep using raw headpose in ui

Issue: #52

2 files changed, 3 insertions, 2 deletions

diff --git a/facetracknoir/tracker.cpp b/facetracknoir/tracker.cpp
index 29855b31..db2a7af3 100644
--- a/facetracknoir/tracker.cpp
+++ b/facetracknoir/tracker.cpp
@@ -121,6 +121,7 @@ void Tracker::run() {
             for (int i = 0; i < 6; i++)

             {

                 auto& axis = mainApp->axis(i);

+                raw_6dof.axes[i] = newpose[i];

                 int k = axis.opts.src;

                 if (k < 0 || k >= 6)

                     continue;

@@ -184,7 +185,7 @@ void Tracker::getHeadPose( double *data ) {
     QMutexLocker foo(&mtx);

     for (int i = 0; i < 6; i++)

     {

-        data[i] = mainApp->axis(i).headPos;

+        data[i] = raw_6dof.axes[i];

     }

 }

 

diff --git a/facetracknoir/tracker.h b/facetracknoir/tracker.h
index 49e7f302..152551d4 100644
--- a/facetracknoir/tracker.h
+++ b/facetracknoir/tracker.h
@@ -73,7 +73,7 @@ public:
     volatile bool do_center;
     volatile bool enabled;
     
-    T6DOF output_camera;
+    T6DOF output_camera, raw_6dof;
 
     void start() { QThread::start(); }
 };