From 632cd5bf7778cb9062633f8d27ecd6aadcaa5d28 Mon Sep 17 00:00:00 2001
From: Stanislaw Halik <sthalik@misaki.pl>
Date: Sat, 6 May 2017 13:18:24 +0200
Subject: filter/accela: punt if running ahead of the input value

---
 filter-accela/ftnoir_filter_accela.cpp | 7 +++++++
 1 file changed, 7 insertions(+)

(limited to 'filter-accela')

diff --git a/filter-accela/ftnoir_filter_accela.cpp b/filter-accela/ftnoir_filter_accela.cpp
index 3f78c7a6..b8a0ac77 100644
--- a/filter-accela/ftnoir_filter_accela.cpp
+++ b/filter-accela/ftnoir_filter_accela.cpp
@@ -32,6 +32,7 @@ static inline constexpr T signum(T x)
 }
 
 template<int N = 3, typename F>
+OTR_NEVER_INLINE
 static void do_deltas(const double* deltas, double* output, double alpha, double& smoothed, F&& fun)
 {
     double norm[N];
@@ -152,6 +153,12 @@ void accela::filter(const double* input, double *output)
     {
         output[k] *= dt;
         output[k] += last_output[k];
+
+        if (signum(last_output[k] - output[k]) < 0)
+            output[k] = std::fmax(input[k], output[k]);
+        else
+            output[k] = std::fmin(input[k], output[k]);
+
         last_output[k] = output[k];
     }
 }
-- 
cgit v1.2.3