private void CycleWaypoint() { _currentWaypointIndex = patrolPath.getNextIndex(_currentWaypointIndex); }