ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange |
1 | initial version |
I would recommend to publish 3 Arrow Markers for each pose (see e.g. http://www.ros.org/wiki/rviz/Tutorials/Markers%3A%20Basic%20Shapes).
You could also publish a tf frame for each pose, but that will create a lot of computational overhead in the system.