private void CycleWaypoint() { pathIndex++; if (pathIndex >= _patrolPath.GetPathSize()) { pathIndex = 0; } }