Pick-and-place task

As a final task, let’s create a node that commands the xArm to complete a skeleton pick-and-place routine, which would consist of the following steps:

  1. Robot approaches the pickup station, stops right on top of it

  2. Robot opens the gripper

  3. Robot moves only downward to the pickup station

  4. Robot closes the gripper

  5. Robot moves to the place station

  6. Robot opens the gripper

Since currently, we can test the code that uses the MoveGroup C++ interface even with the digital twin, it is probably easiest to first program the sequence of all the movements of the manipulator. And then add lines for controlling the gripper and test it using the physical robot.