removed PolygonStamped_array msgs and code clean up