Revision history [back]

Yes, you can do it with the planning scene too. If the octomap server is also publishing your octomap as a CollisionMap then you just have remap the collision map topic that the environment server listens to.

Wherever you launch the environment server from, add in a remap line like so:

  <node pkg="planning_environment" type="environment_server" output="screen" name="environment_server" machine="c2">
     <remap from="collision_map_occ" to="my_octomap_collision_map_topic" />
  </node>

I would imagine that you can do something similar with your octomap_collision_objects here but it seems like you tried that already and it didn't work. I can guarantee that this works with the CollisionMap though.