Implement of visability graph in motion planning: dilema with the vertecies I trying to calculate the visability graph of graph with polygons.