source: proiecte/pmake3d/make3d_original/Make3dSingleImageStanford_version0.1/third_party/torr/torr_g2FP.m @ 37

%       By Philip Torr 2002
%       copyright Microsoft Corp.



% 
% %here p is the set of paramets such that
% g(1) = focal length
% g(2-3) sperical coordinates of rotation axis
% g(4) rotation angle
% g(5-6) is the translation vector



function [P1, P2] = torr_g2FP(g,C)

%convert intrinsic and extinsics to a F matrix
C(3,3) = 1/g(1);
rot_axis = torr_sphere2unit([g(2) g(3)]);
tt = torr_sphere2unit([g(5) g(6)]);
rot_angle = g(4);

%Rogregues
II = [1 0 0; 0 1 0; 0 0 1];
AX = torr_skew_sym(rot_axis);
RR = cos(rot_angle) * II +sin(rot_angle) * AX + (1 - cos(rot_angle)) * rot_axis * rot_axis';
% 
% TX = torr_skew_sym(tt);
% nnE = TX * RR;
% 
% F = inv(C') *  nnE * inv(C);
% f = reshape(F',9,1);

[P1, P2] = torr_RCT2P(C,RR,tt);