I’ve been using MoveIt! to add an extra constraint during the collision checking process. To do this, I add a rectangular prism to the environment based on the position of the End Effector of my manipulator. I planned on adding the geometry by the method:
I would call this method from:
void PlanningScene::checkCollision(const collision_detection::CollisionRequest& req,
const robot_state::RobotState& kstate) const
However, checkCollision is const and processCollisionObjectMsg() is not, and thus is uncallable. I am using OMPL (and the default fcl collision detection) to plan my paths. What is a good way for me add a simple rectangular prism into the collision environment ? Note, each rectangular prism should only apply to its respective sample; one sample’s rectangular prism should not affect another sample’s collision checking.