diff --git a/rmp220_middleware/rmp220_middleware.py b/rmp220_middleware/rmp220_middleware.py
index 8a02353..4857bc1 100644
--- a/rmp220_middleware/rmp220_middleware.py
+++ b/rmp220_middleware/rmp220_middleware.py
@@ -94,8 +94,8 @@ class StateMachineNode(Node):
 
         if abs(msg.linear.x) > 0.03 or abs(msg.angular.z) > 0.03:
             self.latest_cmd_vel = msg
-        # else:
-        #     self.latest_cmd_vel = Twist()
+        else:
+             self.latest_cmd_vel = Twist()
 
     def timer_callback(self):
         #self.cmd_vel_pub.publish(self.twist)