AC_Autorotation: Fix and rename average z accel function

MattKear · Jan 4, 2024 · 5a24f04 · 5a24f04
1 parent cd92d01
commit 5a24f04
Show file tree

Hide file tree

Showing 2 changed files with 11 additions and 9 deletions.
diff --git a/libraries/AC_Autorotation/AC_Autorotation.cpp b/libraries/AC_Autorotation/AC_Autorotation.cpp
@@ -723,15 +723,17 @@ void AC_Autorotation::update_est_radar_alt(void)
 }
 
 
-void AC_Autorotation::calc_avg_acc_z(void)
+void AC_Autorotation::update_avg_acc_z(void)
 {
-    if (_index < 10) {
-        _acc_z_sum -= _curr_acc_z[_index];
-        _curr_acc_z[_index] = _ahrs.get_accel_ef().z;
-        _acc_z_sum += _curr_acc_z[_index];
-        _index = _index + 1;
-    } else {
+    // Wrap index
+    if (_index >= 10) {
         _index = 0;
     }
-    _avg_acc_z = _acc_z_sum / 10.0f;
+
+    _acc_z_sum -= _curr_acc_z[_index];
+    _curr_acc_z[_index] = _ahrs.get_accel_ef().z;
+    _acc_z_sum += _curr_acc_z[_index];
+    _index = _index + 1;
+
+    _avg_acc_z = _acc_z_sum / 10.0;
 }
diff --git a/libraries/AC_Autorotation/AC_Autorotation.h b/libraries/AC_Autorotation/AC_Autorotation.h
@@ -108,7 +108,7 @@ class AC_Autorotation
 
     void update_hover_autorotation_controller();
 
-    void calc_avg_acc_z(void);
+    void update_avg_acc_z(void);
 
     float get_flare_alt(void) const { return _flare_alt_calc; }