Perception and grasp planning on the UR5 robot