RViz display plugins for visualizing octomap messages in ROS