Skip to content

Commit

Permalink
rename second lift stage in mtc demo
Browse files Browse the repository at this point in the history
  • Loading branch information
PetoAdam committed Sep 12, 2024
1 parent 586e53e commit 3a69b00
Showing 1 changed file with 6 additions and 6 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -233,16 +233,16 @@ mtc::Task MTCDepalletizingTaskNode::createTask()
task.add(std::move(detach_stage));

// Define Lift2 Stage
auto lift2 = std::make_unique<mtc::stages::MoveRelative>(
auto lift2_stage = std::make_unique<mtc::stages::MoveRelative>(
"lift2_" + std::to_string(4 * k + 2 * j + i), cartesian_planner);
lift2->properties().set("marker_ns", "lift2_" + std::to_string(4 * k + 2 * j + i));
lift2->properties().set("link", eef_frame);
lift2->properties().configureInitFrom(mtc::Stage::PARENT, {"group"});
lift2_stage->properties().set("marker_ns", "lift2_" + std::to_string(4 * k + 2 * j + i));
lift2_stage->properties().set("link", eef_frame);
lift2_stage->properties().configureInitFrom(mtc::Stage::PARENT, {"group"});
geometry_msgs::msg::Vector3Stamped vec_lift2;
vec_lift2.header.frame_id = "world";
vec_lift2.vector.z = (2 - k) * PALLET_DISTANCE + 0.02;
lift2->setDirection(vec_lift2);
task.add(std::move(lift2));
lift2_stage->setDirection(vec_lift2);
task.add(std::move(lift2_stage));
}
}
}
Expand Down

0 comments on commit 3a69b00

Please sign in to comment.