tracker/pt: add point filter deadzone

1 files changed, 4 insertions, 2 deletions

diff --git a/tracker-pt/point-filter.cpp b/tracker-pt/point-filter.cpp
index 7548d515..b03562ed 100644
--- a/tracker-pt/point-filter.cpp
+++ b/tracker-pt/point-filter.cpp
@@ -40,12 +40,14 @@ const PointOrder& point_filter::operator()(const PointOrder& input)
         return A * pow((f)10, (f)-log10_pos) * rest;
     );
 
-    f dist = 0;
+    f dist = 0, dz = (float)s.point_filter_deadzone / 800; // sqrt(640^2 + 480^2)
 
     for (unsigned i = 0; i < 3; i++)
     {
         vec2 tmp = input[i] - state_[i];
-        dist = std::max(dist, sqrt(tmp.dot(tmp)));
+        f x = sqrt(tmp.dot(tmp));
+        x = std::max((f)0, x - dz);
+        dist = std::max(dist, x);
     }
 
     if (dist < (f)1e-6)