Implement axis limits

Signed-off-by: Stanislaw Halik <sthalik@misaki.pl>

1 files changed, 6 insertions, 0 deletions

diff --git a/ftnoir_tracker_ht/ftnoir_tracker_ht.cpp b/ftnoir_tracker_ht/ftnoir_tracker_ht.cpp
index e31b6d3f..62606395 100644
--- a/ftnoir_tracker_ht/ftnoir_tracker_ht.cpp
+++ b/ftnoir_tracker_ht/ftnoir_tracker_ht.cpp
@@ -224,6 +224,12 @@ bool Tracker::GiveHeadPoseData(double *data)
         if (enableTZ)
             data[TZ] = shm->result.tz;
         ret = true;
+        if (fabs(data[Yaw]) > 60 || fabs(data[Pitch]) > 50 || fabs(data[Roll]) > 40)
+        {
+            shm->pause = true;
+        }
+    } else {
+        shm->pause = false;
     }
     lck_shm.unlock();