increase duration scaling
disable gripper opening on start-up
wait for gripper to move
use last position, not first
more time to find IK
working end-effector/gripper config
turned ur5
added touchlinks