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();
 }