We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
There was an error while loading. Please reload this page.
1 parent a0da41a commit 5a0059dCopy full SHA for 5a0059d
demo/src/pick_place_task.cpp
@@ -220,8 +220,9 @@ bool PickPlaceTask::init() {
220
***************************************************/
221
// Connect initial open-hand state with pre-grasp pose defined in the following
222
{
223
- auto stage = std::make_unique<stages::Connect>(
224
- "move to pick", stages::Connect::GroupPlannerVector{ { arm_group_name_, sampling_planner } });
+ stages::Connect::GroupPlannerVector planners = { { arm_group_name_, sampling_planner },
+ { hand_group_name_, sampling_planner } };
225
+ auto stage = std::make_unique<stages::Connect>("move to pick", planners);
226
stage->setTimeout(5.0);
227
stage->properties().configureInitFrom(Stage::PARENT);
228
t.add(std::move(stage));
0 commit comments