1 files changed, 12 insertions, 1 deletions
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);