diff --git a/mushr_rhc_ros/launch/real/real_model_deploy_new.launch b/mushr_rhc_ros/launch/real/real_model_deploy_new.launch new file mode 100644 index 0000000..2c6499a --- /dev/null +++ b/mushr_rhc_ros/launch/real/real_model_deploy_new.launch @@ -0,0 +1,71 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + diff --git a/mushr_rhc_ros/src/rhcnode_network_pcl_new.py b/mushr_rhc_ros/src/rhcnode_network_pcl_new.py index a7d10e1..16351e9 100755 --- a/mushr_rhc_ros/src/rhcnode_network_pcl_new.py +++ b/mushr_rhc_ros/src/rhcnode_network_pcl_new.py @@ -246,9 +246,9 @@ def __init__(self, dtype, params, logger, name): # define timer callbacks: if self.use_map: - self.map_viz_loc = rospy.Timer(rospy.Duration(1.0 / rate_loc_display), self.loc_viz_cb) - if self.use_loc: self.map_viz_timer = rospy.Timer(rospy.Duration(1.0 / rate_map_display), self.map_viz_cb) + if self.use_loc: + self.map_viz_loc = rospy.Timer(rospy.Duration(1.0 / rate_loc_display), self.loc_viz_cb) @@ -466,7 +466,8 @@ def create_map_marker(self, pose_stamped): rospy.loginfo("color delay: "+str(finished_colors-finished_points)) # Set the pose of the marker - marker.pose = pose_stamped.pose + if pose_stamped is not None: + marker.pose = pose_stamped.pose return marker def create_position_marker(self, pose_stamped, color=[0,1,0,1]): @@ -488,7 +489,8 @@ def create_position_marker(self, pose_stamped, color=[0,1,0,1]): marker.color.a = color[3] # Set the pose of the marker - marker.pose = pose_stamped.pose + if pose_stamped is not None: + marker.pose = pose_stamped.pose return marker