I have a two move_groups which do not form a kinematic chain. Can moveit plan a path for two different groups?
I have made it work in the following way:
computeCartesianPath of group1 to get planned_path
Manually (using a loop) push waypoints of joints in group2 to the joint_trajectory of the planned_path: loop{ planned_path.joint_trajectory.points[i].positions.push_back(waypoint[i])}
then used computeTimeStamps (or retime_trajectory in python) to get the final planned_path
Is this the correct way to path for two different groups? Is there a better way which plans only once?