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(); }
 };