moveit_task_constructor icon indicating copy to clipboard operation
moveit_task_constructor copied to clipboard

allowCollisions() is not working in ros2 iron

Open qboticslabs opened this issue 4 months ago • 4 comments

I am testing the following snippet before attaching the object1 to eef

    {
      auto stage = std::make_unique<stages::ModifyPlanningScene>("allow collision (object,support)");
      stage->allowCollisions("object1", true);
      c->insert(std::move(stage));

    }  

But it is still raising this error. The task planning works fine, but execution is raising this issue.

 Found a contact between 'object1' (type 'Object') and 'object1' (type 'Robot attached'), which constitutes a collision. Contact information is not stored.
[move_group-4] [INFO] [1727730076.878482284] [moveit_collision_detection_fcl.collision_common]: Collision checking is considered complete (collision was found and 0 contacts are stored)
[move_group-4] [INFO] [1727730076.878487975] [moveit_ros.plan_execution]: Trajectory component '9/59' is invalid after scene update
[move_group-4] [INFO] [1727730076.878541415] [moveit_ros.plan_execution]: Stopping execution because the path to execute became invalid(probably the environment changed)
[move_group-4] [INFO] [1727730076.878565020] [moveit.simple_controller_manager.follow_joint_trajectory_controller_handle]: Cancelling execution for tmr_arm_controller

Any support is appreciated.

I am testing in ROS 2 Iron using iron branch

qboticslabs avatar Sep 30 '24 21:09 qboticslabs