A ROS python package for simple geometry plotting with RViz