tesseract_planning icon indicating copy to clipboard operation
tesseract_planning copied to clipboard

Nested composite instruction meta-information not respected in Trajopt planner

Open marip8 opened this issue 3 years ago • 0 comments

The Trajopt planner does not appear to support different profiles and manipulator infos for nested composites because the input instructions are flattened, the composite ManipulatorInfo object is only created from the highest level composite, and the only composite profile created is extracted using the profile name in the highest level composite.

https://github.com/tesseract-robotics/tesseract_planning/blob/f966455d0a75eb942aa45d69cabd8155706c4364/tesseract_motion_planners/trajopt/src/trajopt_motion_planner.cpp#L235

https://github.com/tesseract-robotics/tesseract_planning/blob/f966455d0a75eb942aa45d69cabd8155706c4364/tesseract_motion_planners/trajopt/src/trajopt_motion_planner.cpp#L172

https://github.com/tesseract-robotics/tesseract_planning/blob/f966455d0a75eb942aa45d69cabd8155706c4364/tesseract_motion_planners/trajopt/src/trajopt_motion_planner.cpp#L634-L636

I'm not sure if this used to be supported in the past, but we have had conversations recently about this being a valuable and important capability for Trajopt. If this is not a bug or feature regression, we should consider handling this more appropriately in the upcoming refactor of the motion planners. Maybe we only support a single layer of composite nesting within request.instructions to allow for the specification of different profiles or different motion groups/TCPs for groups of waypoints in the same plan

marip8 avatar Aug 02 '22 15:08 marip8