How to move two movegroup simultaneously with moveit ?
I have two move group in my robot that I want to move simultaneously. With code given below the second move group start moving after first one stop moving.
Is there a way in moveit to move two(or more than two) move group simultaneously ?
def get_plan(group,values):
joint_goal = group.get_current_joint_values()
for i,v in enumerate(values):
joint_goal[i] = v;
return group.plan(joint_goal)
plan_1 = get_plan(group_1,[0.6, -0.1])
plan_2 = get_plan(group_2,[0.5, 0.0])
group_1.execute(plan_1,wait=True)
group_2.execute(plan_2,wait=True)
I have also tried with wait=False
in execute
method, but sometime this makes joints in the first move group not move and only moves the joints in the second move group.
Note: I am using kinetic on ubuntu 16.