diff options
| author | GO63-samara <go1@list.ru> | 2020-04-28 22:13:55 +0400 | 
|---|---|---|
| committer | GO63-samara <go1@list.ru> | 2020-04-28 22:13:55 +0400 | 
| commit | 48e1c8a5a41449e4b9291954964188fad9dfd248 (patch) | |
| tree | d5b0e339cdc03fb6d6b28adce84ea3b37a34be0b | |
| parent | 7252c00161959b3b7ce9d78506ec6cf026f24d5e (diff) | |
fix sintax
replacing define with static constexpr double and replacing a tab with a space
| -rw-r--r-- | filter-accela/ftnoir_filter_accela.cpp | 9 | ||||
| -rw-r--r-- | filter-ewma2/ftnoir_filter_ewma2.cpp | 24 | 
2 files changed, 17 insertions, 16 deletions
diff --git a/filter-accela/ftnoir_filter_accela.cpp b/filter-accela/ftnoir_filter_accela.cpp index 2059d7f9..b70f08cf 100644 --- a/filter-accela/ftnoir_filter_accela.cpp +++ b/filter-accela/ftnoir_filter_accela.cpp @@ -64,8 +64,9 @@ static void do_deltas(const double* deltas, double* output, F&& fun)  void accela::filter(const double* input, double *output)  { -#define FULL_TURN 360.0 -#define HALF_TURN 180.0 +    static constexpr double full_turn = 360.0;	 +    static constexpr double half_turn = 180.0;	 +      if (unlikely(first_run))      {          first_run = false; @@ -100,7 +101,7 @@ void accela::filter(const double* input, double *output)      for (unsigned i = 3; i < 6; i++)      {          double d = input[i] - last_output[i]; -		if (fabs(d) > HALF_TURN) d -= copysign(FULL_TURN, d); +        if (fabs(d) > half_turn) d -= copysign(full_turn, d);          if (fabs(d) > rot_dz)              d -= copysign(rot_dz, d); @@ -137,7 +138,7 @@ void accela::filter(const double* input, double *output)      {          output[k] *= dt;          output[k] += last_output[k]; -		if (fabs(output[k]) > HALF_TURN) output[k] -= copysign(FULL_TURN, output[k]); +        if (fabs(output[k]) > half_turn) output[k] -= copysign(full_turn, output[k]);          last_output[k] = output[k];      } diff --git a/filter-ewma2/ftnoir_filter_ewma2.cpp b/filter-ewma2/ftnoir_filter_ewma2.cpp index 09e6f5d7..25902280 100644 --- a/filter-ewma2/ftnoir_filter_ewma2.cpp +++ b/filter-ewma2/ftnoir_filter_ewma2.cpp @@ -26,8 +26,8 @@ ewma::ewma() = default;  void ewma::filter(const double *input, double *output)  { -#define FULL_TURN 360.0 -#define HALF_TURN 180.0 +    static constexpr double full_turn = 360;	 +    static constexpr double half_turn = 180;	      // Start the timer and initialise filter state if it's not running.      if (first_run)      { @@ -59,13 +59,13 @@ void ewma::filter(const double *input, double *output)          using std::pow;          // Calculate the current and smoothed delta. -		double input_value = input[i]; -		double delta = input_value - last_output[i]; -		if (fabs(delta) > HALF_TURN) -		{ -			delta -= copysign(FULL_TURN, delta); -			input_value -= copysign(FULL_TURN, input_value); -		} +        double input_value = input[i]; +        double delta = input_value - last_output[i]; +        if (fabs(delta) > half_turn) +        { +            delta -= copysign(full_turn, delta); +            input_value -= copysign(full_turn, input_value); +        }          last_delta[i] = delta_alpha*delta + (1.0-delta_alpha)*last_delta[i];          // Calculate the current and smoothed noise variance.          double noise = last_delta[i]*last_delta[i]; @@ -78,9 +78,9 @@ void ewma::filter(const double *input, double *output)          // Calculate the dynamic alpha.          double alpha = dt/(dt + RC);          // Calculate the new output position. -		output[i] = alpha*input_value + (1.0-alpha)*last_output[i]; -		if (fabs(output[i]) > HALF_TURN) output[i] -= copysign(FULL_TURN, output[i]); -		last_output[i] = output[i]; +        output[i] = alpha*input_value + (1.0-alpha)*last_output[i]; +        if (fabs(output[i]) > half_turn) output[i] -= copysign(full_turn, output[i]); +        last_output[i] = output[i];      }  }  | 
