Clearing Collision Map of Planning Scene
Hi,
Is there a simple way to reset the collision map of the planning scene?
I am running tests where I do arm motion planning in an environment, then move an obstacle and do motion planning again. When I move the obstacle, the planning scene still thinks the obstacle was in its old position.
It looks like I am having a similar problem as this question where the collision map is being updated very slowly even after I move obstacles.
I was hoping that it might work to just clear the collision map and then add in the obstacle at the new position.
I am moving obstacles by setting the planning scene with the SetPlanningSceneDiff service and I am using electric.
Thank you