From 3bf58b024c39317c82aefef22d214dd242e1dadf Mon Sep 17 00:00:00 2001
From: Thomas Timm Andersen <thomas.timm.dk@gmail.com>
Date: Wed, 9 Sep 2015 11:20:16 +0200
Subject: [PATCH] Added sleep before reporting action goal is succesfull

---
 src/ur_ros_wrapper.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/src/ur_ros_wrapper.cpp b/src/ur_ros_wrapper.cpp
index a6a8b5c..2eb8ed3 100644
--- a/src/ur_ros_wrapper.cpp
+++ b/src/ur_ros_wrapper.cpp
@@ -80,7 +80,7 @@ public:
 		}
 		robot_->addTraj(timestamps, positions, velocities);
 
-		//sleep?
+		ros::Duration(timestamps.back()).sleep();
 		result_.error_code = result_.SUCCESSFUL;
 		as_.setSucceeded(result_);