stomp: use initial traj if possible