Added autonomous drive-till function