Skip to content

Commit 5fc86a0

Browse files
committed
Revert "ModifyPlanningScene: check state for collisions"
This reverts commit 9c05305.
1 parent 0cc3987 commit 5fc86a0

File tree

1 file changed

+0
-11
lines changed

1 file changed

+0
-11
lines changed

core/src/stages/modify_planning_scene.cpp

Lines changed: 0 additions & 11 deletions
Original file line numberDiff line numberDiff line change
@@ -153,17 +153,6 @@ std::pair<InterfaceState, SubTrajectory> ModifyPlanningScene::apply(const Interf
153153

154154
if (callback_)
155155
callback_(scene, properties());
156-
157-
// check for collisions
158-
collision_detection::CollisionRequest req;
159-
collision_detection::CollisionResult res;
160-
req.contacts = true;
161-
req.max_contacts = 1;
162-
scene->checkCollision(req, res);
163-
if (res.collision) {
164-
const auto contact = res.contacts.begin()->second.front();
165-
traj.markAsFailure(contact.body_name_1 + " colliding with " + contact.body_name_2);
166-
}
167156
} catch (const std::exception& e) {
168157
traj.markAsFailure(e.what());
169158
}

0 commit comments

Comments
 (0)