A general solution to the P4P problem for camera with unknown focal length
Linear N-Point Camera Pose Determination