Coverage lab sim

[harrison-bcr]

Summary

Add comprehensive behavior tree examples demonstrating key MoveIt Pro behaviors for manipulation tasks. This PR introduces new example objectives in the lab simulation that showcase fundamental manipulation capabilities including grasp pose generation, IK solving, object handling, and MTC (MoveIt Task Constructor) integration.

Key Behaviors Demonstrated

This PR showcases the following MoveIt Pro behaviors in practical manipulation scenarios:

Grasp Generation & Planning

• GenerateCuboidGraspPoses: Generates grasp poses for cuboid objects based on object geometry
• SolveIKQueries: Validates multiple target poses via IK queries and filters collision-free solutions
• GetClosestObjectToPose: Identifies the nearest graspable object to a specified pose for selection

Object & Collision Management

• SetupMTCUpdateObjectCollisionRule: Configures collision rules between objects and robot links
• IsObjectAttachedTo: Verifies object attachment to specific robot links
• SetupMTCAttachObject: Attaches objects to the robot end-effector in planning scene
• SetupMTCDetachObject: Detaches objects from the robot end-effector
• RemoveCollisionObjectFromPlanningScene: Removes collision objects from the planning environment

Transform Utilities

• GetLatestTransform: Retrieves current transform between coordinate frames
• ConvertTransformStampedToPoseStamped: Converts transform messages to pose messages

MTC Motion Primitives

• SetupMTCCartesianSequence: Creates Cartesian motion sequences for precise end-effector control

New Behavior Trees added

Pick and Place Object - Complete pick and place workflow with:

• User-selected object via point cloud interaction
• Automated grasp pose generation
• IK validation and collision checking
• Object attachment/detachment with MTC
• Pose visualization and verification

Move Along Axis and Pick Object - Demonstrates:

• Axis-constrained motion (moving down to grasp)
• Collision rule management during manipulation
• Object attachment validation

Evaluate Pose Vector and Execute - Shows:

• Filtering valid grasp candidates
• Visualizing feasible grasp poses with offset

Update Object Pose - Object pose manipulation utilities

How to Run

• Run "Pick and Place Object" in lab_sim
• Click on any one of the cuboids placed on the table
• Verify complete pick/place cycle

[davetcoleman]

[written by AI]

Stale PR sweep. Opened 2026-01-08, last commit 2026-01-08. We are cleaning up open PRs older than three months.

State: targeted at v8.10, and all four objective XMLs it modifies (evaluate_pose_vector_and_execute.xml, move_along_axis_and_pick_object.xml, pick_and_place_object.xml, update_object_pose.xml) no longer exist in src/lab_sim/objectives/ on main. It is marked ready for review but has sat BLOCKED with zero reviews for eight months.

Recommendation: close. 661 lines added to four objectives that have since been removed or renamed, on a branch that only takes patches, with no reviewer. If the coverage scenarios are still wanted for lab_sim, they should be rebuilt against the current objective set.

@harrison-bcr @MikeWrock any objection?