auto task = std::make_shared<moveit::task_constructor::Task>();
task->loadRobotModel();
//Convert raw pointer to share pointer
auto container = std::shared_ptr<moveit::task_constructor::ContainerBase>(task->stages());
We should refactor the move_mtc_xxx nodes into a templated one where the user can move stages to container and task. Use only one cpp file. Well one header file because it will be templated!
The task/container is deleted twice
We should refactor the
move_mtc_xxx
nodes into a templated one where the user can move stages to container and task. Use only one cpp file. Well one header file because it will be templated!