Revision history [back]

You can switch between camera and world coordinates as follows:

Rodrigues(rvecold, R);
R = R.t();
tnew = -R*told;
Rodrigues(R, rvecnew);