From 32ee08bb7d6732bbd96022dc54e25ecfcb83e27d Mon Sep 17 00:00:00 2001 From: Rogerio Bonatti Date: Sat, 26 Feb 2022 14:57:52 -0800 Subject: [PATCH] new time --- mushr_rhc_ros/src/rhcnode_network_iros.py | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/mushr_rhc_ros/src/rhcnode_network_iros.py b/mushr_rhc_ros/src/rhcnode_network_iros.py index c333267..7fa7610 100755 --- a/mushr_rhc_ros/src/rhcnode_network_iros.py +++ b/mushr_rhc_ros/src/rhcnode_network_iros.py @@ -306,7 +306,7 @@ def check_reset(self, rate_hz): self.time_so_far += delta_time_poses # look at speed and termination condition v = delta_dist / delta_time_poses - print('v = {}'.format(v)) + # print('v = {}'.format(v)) if v < 0.05 and rospy.Time.now().to_sec() - self.time_started.to_sec() > 1.0: # this means that the car was supposed to follow a traj, but velocity is too low bc it's stuck # first we reset the car pose