use no more than 5 neighbors when approximating surface normals
detector publishes planes. Contain bounding box, plane coefficients and whether it is the ground plane.