Skip to content

Commit 5a0059d

Browse files
committed
Fix pick+place: connect should plan both, arm and hand motion
1 parent a0da41a commit 5a0059d

File tree

1 file changed

+3
-2
lines changed

1 file changed

+3
-2
lines changed

demo/src/pick_place_task.cpp

Lines changed: 3 additions & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -220,8 +220,9 @@ bool PickPlaceTask::init() {
220220
***************************************************/
221221
// Connect initial open-hand state with pre-grasp pose defined in the following
222222
{
223-
auto stage = std::make_unique<stages::Connect>(
224-
"move to pick", stages::Connect::GroupPlannerVector{ { arm_group_name_, sampling_planner } });
223+
stages::Connect::GroupPlannerVector planners = { { arm_group_name_, sampling_planner },
224+
{ hand_group_name_, sampling_planner } };
225+
auto stage = std::make_unique<stages::Connect>("move to pick", planners);
225226
stage->setTimeout(5.0);
226227
stage->properties().configureInitFrom(Stage::PARENT);
227228
t.add(std::move(stage));

0 commit comments

Comments
 (0)