diff --git a/src/modules/commander/failure_detector/FailureDetector.cpp b/src/modules/commander/failure_detector/FailureDetector.cpp index 5be44f9aff..c0e7d55937 100644 --- a/src/modules/commander/failure_detector/FailureDetector.cpp +++ b/src/modules/commander/failure_detector/FailureDetector.cpp @@ -324,7 +324,7 @@ void FailureDetector::updateImbalancedPropStatus() if ((imu_status.accel_device_id != 0) && (imu_status.accel_device_id == _selected_accel_device_id)) { - const float dt = math::constrain((float)(imu_status.timestamp - _imu_status_timestamp_prev), 0.01f, 1.f); + const float dt = math::constrain(float(imu_status.timestamp - _imu_status_timestamp_prev) / 1_s, 0.01f, 1.f); _imu_status_timestamp_prev = imu_status.timestamp; _imbalanced_prop_lpf.setParameters(dt, _imbalanced_prop_lpf_time_constant);