diff options
Diffstat (limited to 'filter-accela')
| -rw-r--r-- | filter-accela/ftnoir_filter_accela.cpp | 4 |
1 files changed, 2 insertions, 2 deletions
diff --git a/filter-accela/ftnoir_filter_accela.cpp b/filter-accela/ftnoir_filter_accela.cpp index c22d1c3d..edb2912f 100644 --- a/filter-accela/ftnoir_filter_accela.cpp +++ b/filter-accela/ftnoir_filter_accela.cpp @@ -113,7 +113,7 @@ void accela::filter(const double* input, double *output) if (fabs(d) > rot_dz) d -= copysign(rot_dz, d); else - d = 0; + d /= 2; deltas[i] = d / rot_thres; } @@ -146,7 +146,7 @@ void accela::filter(const double* input, double *output) if (fabs(d) > pos_dz) d -= copysign(pos_dz, d); else - d = 0; + d /= 2; deltas[i] = d / pos_thres; } |