adding a node for multiple planes detection, corresponding messages, and an utility node for rviz publish