[Planning Pipeline Refactoring] #2 Enable chaining planners

[sjahr]

Related PRs:

• Update planner plugin configs moveit_resources#191
• WIP: Add planner chain tutorial moveit2_tutorials#820

Description

This PR enables chaining multiple planners. This way it is e.g. possible to create an initial trajectory or reference trajectory for optimizing planners.

TODO

• Add unittest for getTrajectoryConstraints
• Write issue to adapt MotionPlanRequest to changes
• Write issue to make chain respect max. planning time
• Write issue to update move_group interface
• Test if Benchmarking still work

Testing

• Use WIP: Add planner chain tutorial moveit2_tutorials#820 and Update planner plugin configs moveit_resources#191
• Update your *_planning.yaml files like this:

- planner_plugin: my_fancy/Planner1
+ planner_plugins:
+  my_fancy/Planner1 # for example ompl_interface/OMPLPlanner
+  my_fancy/Planner2 # for example stomp_moveit/StompPlanner

• run ros2 launch moveit2_tutorials pipeline_testbench.launch.py

Checklist

• Required by CI: Code is auto formatted using clang-format
• Extend the tutorials / documentation reference
• Document API changes relevant to the user in the MIGRATION.md notes
• Create tests, which fail without this PR reference
• Include a screenshot if changing a GUI
• While waiting for someone to review your request, please help review another open pull request to support the maintainers

[mergify]

This pull request is in conflict. Could you fix it @sjahr?

[mergify]

This pull request is in conflict. Could you fix it @sjahr?

[mergify]

This pull request is in conflict. Could you fix it @sjahr?

[sea-bass]

Overall looks like a reasonable cleanup! Seems there are still 3 commented-out functions that we need to decide what to do with, so let us know how we can help make that decision.

[codecov]

Codecov Report

Attention: 30 lines in your changes are missing coverage. Please review.

Comparison is base (1d2bf44) 50.49% compared to head (f59379c) 50.46%.

Files	Patch %	Lines
...anning/planning_pipeline/src/planning_pipeline.cpp	41.18%	30 Missing ⚠️

Additional details and impacted files

@@            Coverage Diff             @@
##             main    #2457      +/-   ##
==========================================
- Coverage   50.49%   50.46%   -0.02%     
==========================================
  Files         387      387              
  Lines       32157    32183      +26     
==========================================
+ Hits        16233    16238       +5     
- Misses      15924    15945      +21     

☔ View full report in Codecov by Sentry.
📢 Have feedback on the report? Share it here.

[sea-bass]

Changes all look good, just have a question about some comments that still say TODO.

Also, there are still CI failures, though I gave a quick look and it has to do with some Fast DDS stuff?

[sea-bass]

Does this need to get done, or is it updated?

[sjahr]

This needs to be updated. For now the first planner in the chain is used which is usually OMPL. Updating this involves more changes in the visualization with RVIZ and the moveit plugins which is why I'd like to keep this out of the PR

[sjahr]

@sea-bass