Real-time 3D object pose estimation and tracking for natural landmark based visual servo
Closed-form solution of absolute orientation using unit quaternions