PathPlanning IMPROVED + added PatrolGRAPH