Added more driving to autonomous