A general solution to the P4P problem for camera with unknown focal length
Locally optimized ransac