Added framework for expanding polygon obstacles and removing concave points from the graph