| 1 | initial version |
There's no analog for pointsToWorld as I know. You can find x and y (z is equal zero in such case) like this:
cv::undistortPoints to your pixel coordintes (let's u and v) and get ideal coordinates (un and vn)solve system of linear equations:
w * [un vn 1] = Rt * [x y 0 1]
that gets you
r11 * x + r12 * y - w * un = -t1;
r21 * x + r22 * y - w * vn = -t2;
r31 * x + r32 * y - w = -t3;
Here x and y are coordinates in chessboard plane, w is distant to point from camera, rij are components of rotation matrix and ti are components of translation vector.