Fast object localization and pose estimation in heavy clutter for robotic bin picking
Closed-form solution of absolute orientation using unit quaternions