hack for trajectory execution in gazebo