diff --git a/kuka_driver_examples/eci_demo/src/MoveitBasicPlan.cpp b/kuka_driver_examples/eci_demo/src/MoveitBasicPlan.cpp index 19c1e624..f790facf 100644 --- a/kuka_driver_examples/eci_demo/src/MoveitBasicPlan.cpp +++ b/kuka_driver_examples/eci_demo/src/MoveitBasicPlan.cpp @@ -238,9 +238,9 @@ int main(int argc, char * argv[]) rclcpp::Publisher::SharedPtr planning_scene_diff_publisher = node->create_publisher("planning_scene", 1); - -///////////////////////////////////////////// - + planning_scene_interface.addCollisionObjects(createCollisionObjects(move_group_interface)); + planning_scene_interface.addCollisionObjects(createPalletObjects(move_group_interface)); + // End Collision Objects define auto planned_trajectory = planToPoint(move_group_interface); if (planned_trajectory != nullptr) {