AP_InertialSensor: cope with zero delta angle time from Replay

9 years ago · 4401cbec72
1 changed files with 1 additions and 1 deletions
--- a/libraries/AP_InertialSensor/AP_InertialSensor.cpp
+++ b/libraries/AP_InertialSensor/AP_InertialSensor.cpp
@ -1172,7 +1172,7 @@ float AP_InertialSensor::get_delta_velocity_dt(uint8_t i) const
				@@ -1172,7 +1172,7 @@ float AP_InertialSensor::get_delta_velocity_dt(uint8_t i) const
 */
 float AP_InertialSensor::get_delta_angle_dt(uint8_t i) const
 {
-    if (_delta_angle_valid[i]) {
+    if (_delta_angle_valid[i] && _delta_angle_dt[i] > 0) {
        return _delta_angle_dt[i];
    }
    return get_delta_time();