diff --git a/examples/bt_allow_collisions.cpp b/examples/bt_allow_collisions.cpp index 7faad5c..b67e497 100644 --- a/examples/bt_allow_collisions.cpp +++ b/examples/bt_allow_collisions.cpp @@ -62,7 +62,7 @@ static const char* xml_text = R"( collision_object="{cylinder}" /> - + - + - + diff --git a/examples/bt_generate_place_pose.cpp b/examples/bt_generate_place_pose.cpp index 1e34aa4..78dfdf8 100644 --- a/examples/bt_generate_place_pose.cpp +++ b/examples/bt_generate_place_pose.cpp @@ -71,7 +71,7 @@ static const char* xml_text = R"( collision_object="{cylinder}" /> - + - + diff --git a/examples/bt_move_relative.cpp b/examples/bt_move_relative.cpp index ba836cc..e6b7031 100644 --- a/examples/bt_move_relative.cpp +++ b/examples/bt_move_relative.cpp @@ -23,7 +23,7 @@ static const char* xml_text = R"( - + diff --git a/examples/bt_move_to.cpp b/examples/bt_move_to.cpp index 7a185c9..46a5f6b 100644 --- a/examples/bt_move_to.cpp +++ b/examples/bt_move_to.cpp @@ -23,7 +23,7 @@ static const char* xml_text = R"( - + diff --git a/examples/bt_pick_place.cpp b/examples/bt_pick_place.cpp index 3b7517f..f2927f7 100644 --- a/examples/bt_pick_place.cpp +++ b/examples/bt_pick_place.cpp @@ -70,7 +70,7 @@ static const char* xml_text = R"( - + diff --git a/examples/bt_serial_container.cpp b/examples/bt_serial_container.cpp index b1969ee..c23d5df 100644 --- a/examples/bt_serial_container.cpp +++ b/examples/bt_serial_container.cpp @@ -24,7 +24,7 @@ static const char* xml_text = R"( - + diff --git a/src/initialize_mtc_task.cpp b/src/initialize_mtc_task.cpp index d046891..dbaef0f 100644 --- a/src/initialize_mtc_task.cpp +++ b/src/initialize_mtc_task.cpp @@ -12,7 +12,13 @@ InitializeMTCTask::InitializeMTCTask(const std::string& name, BT::NodeStatus InitializeMTCTask::tick() { + std::string task_name; + + if(!getInput("task_name", task_name)) + return NodeStatus::FAILURE; + auto task = std::make_shared(); + task->setName(task_name); task->loadRobotModel(); setOutput("task", task); @@ -25,6 +31,7 @@ BT::PortsList InitializeMTCTask::providedPorts() return { BT::OutputPort("task", "{mtc_task}", "MoveIt Task Constructor task."), + BT::InputPort("task_name", "task pipeline", "MoveIt Task Constructor task name.") }; }