added check for large dt when using event.last_real

src/estimators/altitude/alt_generic.cpp

@@ -329,7 +329,7 @@ void AltGeneric::timerUpdate(const ros::TimerEvent &event) {
   }
 
   double dt = (event.current_real - event.last_real).toSec();
-  if (dt <= 0.0) {
+  if (dt <= 0.0 || dt > 1.0) {
     return;
   }
 

src/estimators/heading/hdg_generic.cpp

@@ -302,7 +302,7 @@ void HdgGeneric::timerUpdate(const ros::TimerEvent &event) {
   }
 
   double dt = (event.current_real - event.last_real).toSec();
-  if (dt <= 0.0) {
+  if (dt <= 0.0 || dt > 1.0) {
     return;
   }
 

src/estimators/lateral/lat_generic.cpp

@@ -340,7 +340,7 @@ void LatGeneric::timerUpdate(const ros::TimerEvent &event) {
 
   // obtain dt for state prediction
   double dt = (event.current_real - event.last_real).toSec();
-  if (dt <= 0.0) {  // sometimes the timer ticks twice simultaneously in simulation - we ignore the second tick
+  if (dt <= 0.0 || dt > 1.0) {  // sometimes the timer ticks twice simultaneously in simulation - we ignore the second tick, in case of stopping and starting the timer, the last_real is 0
     return;
   }