moveit_task_constructor
moveit_task_constructor copied to clipboard
Markers of a SolutionSequence are not displayed by rviz
I've customized Connect and MoveTo stages so they display collisions when they fail. I've done this by adding markers to the solution inside compute function.
MoveTo stages work perfectly, but Connect stages don't display anything, despite of containing some markers.
Is there anything preventing Connect stages to display the markers? A difference I noticed is that in MoveTo stage I am adding the markers to a SubTrajectory, while in Connect I am adding them to a SolutionBasePtr