3D pose estimation using OpenCV