Fix coloring distance from plane bug

* fix coloring bug
* add only_projectable flag
* use PolygonArray message to build ConvexPolygon instance