summaryrefslogtreecommitdiffhomepage
path: root/ftnoir_filter_accela
diff options
context:
space:
mode:
authorStanislaw Halik <sthalik@misaki.pl>2015-06-06 13:37:53 +0200
committerStanislaw Halik <sthalik@misaki.pl>2015-06-06 13:37:53 +0200
commit8fff801752845c052dd7e5f8be70a444fa1455ef (patch)
treee3ce361e1f90922507c87b4af8061db8f650df01 /ftnoir_filter_accela
parent007be0fe7360c700a8c2bc4621827f24f8fc2499 (diff)
accela: remove accidental debug code
Diffstat (limited to 'ftnoir_filter_accela')
-rw-r--r--ftnoir_filter_accela/ftnoir_filter_accela.cpp14
1 files changed, 0 insertions, 14 deletions
diff --git a/ftnoir_filter_accela/ftnoir_filter_accela.cpp b/ftnoir_filter_accela/ftnoir_filter_accela.cpp
index 9c44ce3b..0e6fa235 100644
--- a/ftnoir_filter_accela/ftnoir_filter_accela.cpp
+++ b/ftnoir_filter_accela/ftnoir_filter_accela.cpp
@@ -84,20 +84,6 @@ void FTNoIR_Filter::filter(const double* input, double *output)
const double vec_ = max(0., fabs(vec) - dz);
const double thres = i >= 3 ? rot_t : trans_t;
const double val = f(vec_ / thres, i >= 3 ? rot_gains : trans_gains) * thres;
- static Timer tr;
- static double m = 0, n = 0;
- if (i == 3)
- {
- m = max(vec_ / thres, m);
- n = max(n, val * dt);
- }
- if (tr.elapsed_ms() > 1000)
- {
- tr.start();
- qDebug() << "3" << m << n;
- m = 0;
- n = 0;
- }
const double result = last_output[i] + (vec < 0 ? -1 : 1) * dt * val;
const bool negp = vec < 0.;
const bool done = negp