summaryrefslogtreecommitdiffhomepage
path: root/filter-accela/ftnoir_filter_accela.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'filter-accela/ftnoir_filter_accela.cpp')
-rw-r--r--filter-accela/ftnoir_filter_accela.cpp3
1 files changed, 2 insertions, 1 deletions
diff --git a/filter-accela/ftnoir_filter_accela.cpp b/filter-accela/ftnoir_filter_accela.cpp
index 0f4d9dfe..8d14361d 100644
--- a/filter-accela/ftnoir_filter_accela.cpp
+++ b/filter-accela/ftnoir_filter_accela.cpp
@@ -15,6 +15,7 @@ using std::fabs;
using std::sqrt;
using std::pow;
using std::copysign;
+using std::fmin;
constexpr double settings_accela::rot_gains[16][2];
constexpr double settings_accela::pos_gains[16][2];
@@ -42,7 +43,7 @@ static void do_deltas(const double* deltas, double* output, double alpha, double
return sqrt(ret);
);
- const double dist = alpha*dist_ + (1-alpha)*smoothed;
+ const double dist = fmin(dist_, alpha*dist_ + (1-alpha)*smoothed);
smoothed = dist;
const double value = double(fun(dist));