Adding tsdf_polygon to create tsdf from generic polygonal shapes