extract is_steady into variable

Author: schluis

crates/control/src/orientation_filter.rs

@@ -66,9 +66,10 @@ impl OrientationFilter {
         let angular_velocity_sum = measured_angular_velocity.abs().inner.sum();
 
         let mut recalibrated_this_cycle = false;
+        let is_steady = angular_velocity_sum < *context.calibration_steady_threshold;
         match &mut self.calibration_state {
             State::WaitingForSteady => {
-                if angular_velocity_sum < *context.calibration_steady_threshold {
+                if is_steady {
                     self.calibration_state = State::CalibratingGravity {
                         filtered_gravity: LowPassFilter::with_smoothing_factor(
                             measured_acceleration,
@@ -82,7 +83,7 @@ impl OrientationFilter {
                 filtered_gravity,
                 number_of_cycles,
             } => 'update: {
-                if angular_velocity_sum >= *context.calibration_steady_threshold {
+                if !is_steady {
                     self.calibration_state = State::WaitingForSteady;
                     break 'update;
                 }

crates/control/src/sensor_data_receiver.rs

@@ -82,9 +82,10 @@ impl SensorDataReceiver {
         let measured_roll_pitch = sensor_data.inertial_measurement_unit.roll_pitch;
         let angular_velocity_sum = measured_angular_velocity.abs().inner.sum();
 
+        let is_steady = angular_velocity_sum < *context.calibration_steady_threshold;
         match &mut self.calibration_state {
             State::WaitingForSteady => {
-                if angular_velocity_sum < *context.calibration_steady_threshold {
+                if is_steady {
                     self.calibration_state = State::CalibratingGravity {
                         filtered_gravity: LowPassFilter::with_smoothing_factor(
                             measured_acceleration,
@@ -103,7 +104,7 @@ impl SensorDataReceiver {
                 filtered_roll_pitch,
                 remaining_cycles,
             } => {
-                if angular_velocity_sum < *context.calibration_steady_threshold {
+                if is_steady {
                     filtered_gravity.update(measured_acceleration);
                     filtered_roll_pitch.update(measured_roll_pitch);
                     *remaining_cycles -= 1;