Pick & Place of YCB Objects

Pick and Place of YCB objects by using ground truth segmentation & mesh template matching for perception. The planning uses a set of collision free intermediate points to form pick-to-drop trajectory. Differential inverse kinematics is used for executing the trajecotries.