Revision history [back]

First, where do you iterator over collision_objects? In your code? That has no meaning until the objects are on the environment server.

One way to visualize what is actually stored is to use a PlanningScene display in rviz and call /environment_server/set_planning_scene_diff with an empty diff. This should reset the planning scene to the world and thus the PlanningScene display should give you the world.