Added the wait and then drive forward autonomous command.