Add 0.25 sleep to end of _move_to_pose

Address qcr/benchbot#66
Address qcr/benchbot#62

Author: david2611

src/robot_callbacks.py

@@ -3,7 +3,7 @@
 import ros_numpy
 import rospy
 from geometry_msgs.msg import Twist
-from time import time
+from time import time, sleep
 
 _DEFAULT_SPEED_FACTOR = 1
 
@@ -165,6 +165,7 @@ def _move_to_pose(goal, publisher, controller):
     if (time() - t < _MOVE_TIMEOUT):
         _move_to_angle(goal, publisher, controller)
     publisher.publish(Twist())
+    sleep(0.25)
 
 
 def create_pose_list(data, controller):