Ask Your Question

Revision history [back]

click to hide/show revision 1
initial version

I don't think there is any direct link between the environment_server and rviz nodes.

When you say that you are adding collision objects to the environment, I assume that you are publishing them on a /collision_object topic; This will add them to the world. If you are adding them by calling set_planning_scene_diff, then they are not permanently added to the world.

So, assuming you are adding them permanently to the world via the /collision_object topic, I think you will need something custom to show them in rviz. I suggest that whatever node you use to publish on /collision_object should also publish a Marker or MarkerArray using the same resource (For example, if you are adding a mesh object for collision, use the same mesh file published to a marker).

I am working on something similar right now, I will try to remember to remember to post some example code when I finish.