From 324f47f0740dda04cc37674d817b1bfcd1a7ec48 Mon Sep 17 00:00:00 2001
From: Stanislaw Halik <sthalik@misaki.pl>
Date: Tue, 26 Nov 2013 19:43:01 +0100
Subject: use tracker-declared Hz

---
 facetracknoir/tracker.cpp | 13 ++++++++++++-
 1 file changed, 12 insertions(+), 1 deletion(-)

diff --git a/facetracknoir/tracker.cpp b/facetracknoir/tracker.cpp
index b4e73e08..6c48b17a 100644
--- a/facetracknoir/tracker.cpp
+++ b/facetracknoir/tracker.cpp
@@ -16,6 +16,7 @@
 #include "facetracknoir.h"
 #include <opencv2/core/core.hpp>
 #include <cmath>
+#include <algorithm>
 
 #if defined(_WIN32)
 #   include <windows.h>
@@ -59,6 +60,16 @@ void Tracker::run() {
     double newpose[6] = {0};
     double last_post_filter[6] ;
 
+    int sleep_ms = 15;
+
+    if (Libraries->pTracker)
+        sleep_ms = std::min(sleep_ms, 1000 / Libraries->pTracker->preferredHz());
+
+    if (Libraries->pSecondTracker)
+        sleep_ms = std::min(sleep_ms, 1000 / Libraries->pSecondTracker->preferredHz());
+
+    qDebug() << "tracker Hz:" << 1000 / sleep_ms;
+
 #if defined(_WIN32)
     (void) timeBeginPeriod(1);
 #endif
@@ -156,7 +167,7 @@ void Tracker::run() {
             }
         }
 
-        msleep(15);
+        msleep(sleep_ms);
     }
 #if defined(_WIN32)
     (void) timeEndPeriod(1);
-- 
cgit v1.2.3