PNP with ransac using OpenCV
Update for new Sophus API.

Signed-off-by: Steven Lovegrove <stevenlovegrove@gmail.com>