moveit_task_constructor
moveit_task_constructor copied to clipboard
Action call in a stage
Hi, I want to run a custom stage called attach object which runs things externally to MTC/Move it.
So I want to run this action call when task is being executed and robot is in the correct position, but when I add this stage into MTC (the stage is inherited from PropogatingForward stage), in the task.plan() stage it is being executed and the rest of my stack fails since robot is not in the correct position.
How do I add the constraint of only running code in the custom stage during task.execute() ?