From 20ace0b4a885387f1158aa20c7346234cd7e9da4 Mon Sep 17 00:00:00 2001 From: Stanislaw Halik Date: Wed, 15 Dec 2021 15:03:13 +0100 Subject: tracker/pt: try fixing point filter sawtooth-like motion --- tracker-pt/point-filter.cpp | 10 +++++----- 1 file changed, 5 insertions(+), 5 deletions(-) (limited to 'tracker-pt') diff --git a/tracker-pt/point-filter.cpp b/tracker-pt/point-filter.cpp index 49e82afb..93ad3203 100644 --- a/tracker-pt/point-filter.cpp +++ b/tracker-pt/point-filter.cpp @@ -15,6 +15,7 @@ const PointOrder& point_filter::operator()(const PointOrder& input) using std::fmod; using std::sqrt; using std::pow; + using std::clamp; if (!s.enable_point_filter) { @@ -39,16 +40,15 @@ const PointOrder& point_filter::operator()(const PointOrder& input) return A * pow((f)10, (f)-log10_pos) * rest; ); - f dist = 0; + f dist = 1e6; for (unsigned i = 0; i < 3; i++) { vec2 tmp = input[i] - state_[i]; - f x = sqrt(tmp.dot(tmp)); - dist = std::max(dist, x); + dist = std::min(dist, sqrt(tmp.dot(tmp))); } - if (dist < (f)1e-6) + if (dist < (f)1e-6 || dist > (f)1e4) return state_; f dt = (f)t->elapsed_seconds(); t->start(); @@ -58,7 +58,7 @@ const PointOrder& point_filter::operator()(const PointOrder& input) for (unsigned i = 0; i < 3; i++) { - f x = std::clamp(delta, (f)0, limit); + f x = clamp(delta, (f)0, limit); state_[i] += x*(input[i] - state_[i]); } -- cgit v1.2.3