adding trigger call to animations when batch_publishing_enabled_ is e…

…nabled
moveit · Sep 13, 2018 · 12b6423 · 12b6423
1 parent d5cdd6a
commit 12b6423
Showing 1 changed file with 3 additions and 3 deletions.
diff --git a/src/moveit_visual_tools.cpp b/src/moveit_visual_tools.cpp
@@ -438,8 +438,7 @@ bool MoveItVisualTools::publishAnimatedGrasps(const std::vector<moveit_msgs::Gra
       break;
 
     publishAnimatedGrasp(possible_grasps[i], ee_jmg, animate_speed);
-
-    ros::Duration(0.1).sleep();
+    ros::Duration(animate_speed).sleep();
   }
 
   return true;
@@ -517,7 +516,8 @@ bool MoveItVisualTools::publishAnimatedGrasp(const moveit_msgs::Grasp& grasp,
 
     // publishArrow(pre_grasp_pose, moveit_visual_tools::BLUE);
     publishEEMarkers(pre_grasp_pose, ee_jmg);
-
+    if (batch_publishing_enabled_)
+      trigger();
     ros::Duration(animate_speed).sleep();
 
     // Pause more at initial pose for debugging purposes