public void AssignPath(Flightpath flightpath, bool startFollowing)
 {
     _flightpath = flightpath;
     if (startFollowing)
     {
         _navState        = NavigationState.followingFlightPath;
         _currentWaypoint = _flightpath.GetFirstWaypoint();
     }
 }
 public void StartPath(Vector3 position)
 {
     _flightpath      = new Flightpath(position);
     _navState        = NavigationState.followingFlightPath;
     _currentWaypoint = _flightpath.GetFirstWaypoint();
 }