diff --git a/moveit_core/planning_scene/src/planning_scene.cpp b/moveit_core/planning_scene/src/planning_scene.cpp index f9a0964c6d..2c3241c4ae 100644 --- a/moveit_core/planning_scene/src/planning_scene.cpp +++ b/moveit_core/planning_scene/src/planning_scene.cpp @@ -437,7 +437,8 @@ void PlanningScene::checkCollision(const collision_detection::CollisionRequest& req.pad_environment_collisions ? getCollisionEnv()->checkRobotCollision(req, res, robot_state, acm) : getCollisionEnvUnpadded()->checkRobotCollision(req, res, robot_state, acm); - // Return early if a collision was found or the maximum number of allowed contacts is exceeded + // Return early if a collision was found and the number of contacts found already exceed `req.max_contacts`, if + // `req.contacts` is enabled. if (res.collision && (!req.contacts || res.contacts.size() >= req.max_contacts)) { return;