ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange |
1 | initial version |
rviz has a feature called Markers that you can use for this. You will use the "Add" button at the bottom of the rviz left panel to create a DisplayTypes/Marker display, then you publish special messages to topic /visualization_marker. You will have to specify a 3d pose and other details for each marker.
http://wiki.ros.org/rviz/DisplayTypes/Marker
http://wiki.ros.org/rviz/Tutorials