diff options
Diffstat (limited to 'ftnoir_filter_accela/ftnoir_filter_accela.cpp')
| -rw-r--r-- | ftnoir_filter_accela/ftnoir_filter_accela.cpp | 7 |
1 files changed, 5 insertions, 2 deletions
diff --git a/ftnoir_filter_accela/ftnoir_filter_accela.cpp b/ftnoir_filter_accela/ftnoir_filter_accela.cpp index 85975c87..42478963 100644 --- a/ftnoir_filter_accela/ftnoir_filter_accela.cpp +++ b/ftnoir_filter_accela/ftnoir_filter_accela.cpp @@ -35,6 +35,7 @@ void FTNoIR_Filter::filter(const double* input, double *output) last_output[i] = input[i]; } first_run = false; + timer.start(); return; } @@ -47,12 +48,14 @@ void FTNoIR_Filter::filter(const double* input, double *output) const double a_rot_minus = s_rot_minus/100. * a_rot_plus; const double a_trans = s.trans_smoothing/100.; - static constexpr double fast_alpha = Hz/(Hz + fast_alpha_seconds); + const double Hz = timer.elapsed() * 1e-9; + timer.start(); + double fast_alpha = Hz/(Hz + fast_alpha_seconds); for (int i = 0; i < 6; i++) { const double vec = input[i] - last_output[i]; - double datum = Hz * 64; + double datum = Hz * 16; if (i >= 3) { |