I am currently working on pose estimation from 2D to 3D point correspondences. 2D points are of the following form:
X: 2345.12 Y:1234.45
3D points are of the following form:
X: 0.22218997762212644 Y: 0.78954199756837817 Z: 4.3359541556384427
The focal length and distortion coefficients are :
3870.2997285884562 -0.068235490696109416 0.021799724491707737
I am looking to use 4-5 such correspondences and estimate the pose. I am using openCV for the desired purpose. Can someone plz help me how to do it via POSIT algorithm and how to calculate the estimation error rate?
Any guidance will be really appreciated . . . . .