public void getNextWaypoint()
{
for (int i = 0; i < destinations.Count; i++)
{
Destination d = destinations[i];
if (!haveVisited[i])
{
startTime = Time.time;
journeyLength = Vector3.Distance(start_position_, d.getPosition());
current_goal_ = d;
return;
}
}
//
//found everything
root_.notifyCarSaved();;
resetCar();
}