Bug fixes for a* algorithm. Changed code in Simplify path to not combine polygons