Reset sim speed in emergency mode

Author: rovo89

src/lib/rostime_speed

@@ -0,0 +1 @@
+Subproject commit 3b16272bd6b9b3c09a731c0b172f33ce4d4e70d1

src/mower_simulation/src/SimRobot.cpp

@@ -133,7 +133,10 @@ void SimRobot::SimulationStep(const ros::TimerEvent& te) {
     return;
   }
   // Update Position if not in emergency mode
-  if (!emergency_latch_) {
+  if (emergency_latch_) {
+    last_noisy_vx_ = 0.0;
+    last_noisy_vr_ = 0.0;
+  } else {
     double time_diff_s = (now - last_update_).toSec();
     double noisy_vx = vx_ + linear_speed_noise(generator);
     double noisy_vr = vr_ + angular_speed_noise(generator);