From 241a8eb4f2461b2fb1635a702a10013510d09f0a Mon Sep 17 00:00:00 2001
From: Stanislaw Halik <sthalik@misaki.pl>
Date: Sun, 1 Feb 2015 03:15:38 +0100
Subject: center when first pose received

Requested-by: many
---
 opentrack/tracker.cpp | 16 ++++++++++++++--
 1 file changed, 14 insertions(+), 2 deletions(-)

diff --git a/opentrack/tracker.cpp b/opentrack/tracker.cpp
index a6f228e7..338c9113 100644
--- a/opentrack/tracker.cpp
+++ b/opentrack/tracker.cpp
@@ -24,7 +24,7 @@
 Tracker::Tracker(main_settings& s, Mappings &m, SelectedLibraries &libs) :
     s(s),
     m(m),
-    centerp(false),
+    centerp(true),
     enabledp(true),
     zero_(false),
     should_quit(false),
@@ -106,7 +106,19 @@ void Tracker::logic()
     
     r = cam * r;
     
+    bool can_center = false;
+    
     if (centerp)
+    {
+        for (int i = 0; i < 6; i++)
+            if (fabs(newpose[i]) != 0)
+        {
+            can_center = true;
+            break;
+        }
+    }
+    
+    if (can_center)
     {
         centerp = false;
         for (int i = 0; i < 3; i++)
@@ -179,7 +191,7 @@ void Tracker::run() {
     {
         t.start();
         
-        double tmp[6];
+        double tmp[6] {0,0,0, 0,0,0};
         libs.pTracker->data(tmp);
         
         if (enabledp)
-- 
cgit v1.2.3