reverted useing moveit msg. fixed by using the right kinematics_msgs
add sleep, otherwise it got stuck quite often in the loop
correct loop indices and use time from trajectory for timeout
Merge pull request #2 from b-it-bots/fuerte

reverted useing moveit msg. fixed by using the right kinematics_msgs