summaryrefslogtreecommitdiffhomepage
path: root/ftnoir_filter_accela/ftnoir_filter_accela.cpp
diff options
context:
space:
mode:
authorStanislaw Halik <sthalik@misaki.pl>2015-07-12 10:46:32 +0200
committerStanislaw Halik <sthalik@misaki.pl>2015-07-12 10:46:32 +0200
commit3ffc10b1208fd7afca500cb3caec25b05f9b446d (patch)
treeba73cae0adab24875e991d0c40269c042b7fda1d /ftnoir_filter_accela/ftnoir_filter_accela.cpp
parentf396490f2d15d699d8299b91406a9791b38c7237 (diff)
accela: introduce constants for scaling's magic numbers
Diffstat (limited to 'ftnoir_filter_accela/ftnoir_filter_accela.cpp')
-rw-r--r--ftnoir_filter_accela/ftnoir_filter_accela.cpp10
1 files changed, 5 insertions, 5 deletions
diff --git a/ftnoir_filter_accela/ftnoir_filter_accela.cpp b/ftnoir_filter_accela/ftnoir_filter_accela.cpp
index 4d5f4a28..5d89bc96 100644
--- a/ftnoir_filter_accela/ftnoir_filter_accela.cpp
+++ b/ftnoir_filter_accela/ftnoir_filter_accela.cpp
@@ -69,16 +69,16 @@ void FTNoIR_Filter::filter(const double* input, double *output)
return;
}
- const double rot_t = 10. * (1+s.rot_threshold) / 100.;
- const double trans_t = 5. * (1+s.trans_threshold) / 100.;
+ const double rot_t = (1+s.rot_threshold) * s.mult_rot;
+ const double trans_t = (1+s.trans_threshold) * s.mult_trans;
const double dt = t.elapsed() * 1e-9;
t.start();
- const double RC = 2 * s.ewma / 1000.; // seconds
+ const double RC = s.mult_ewma * s.ewma / 1000.; // seconds
const double alpha = dt/(dt+RC);
- const double rot_dz = s.rot_deadzone * 2. / 100.;
- const double trans_dz = s.trans_deadzone * 1. / 100.;
+ const double rot_dz = s.rot_deadzone * s.mult_rot_dz;
+ const double trans_dz = s.trans_deadzone * s.mult_trans_dz;
for (int i = 0; i < 6; i++)
{