RViz display plugins for visualizing octomap messages in ROS - View it on GitHub