Added a initial pose sending with moveit so we go to the first pose securely and so we dont lose the first points of the trajectory