genconeconic.m

摄像机圆球标定程序（包括SDP,DSDP,IDC,DIDC,ALG,DALG六种算法的实现）

function [C Cstar]=GenConeConic(K,alpha,beta,gama,o)


tano=tan(o*(pi/180));
Q=diag([1 1 -tano*tano]);
alpha=alpha*(pi/180);
beta=beta*(pi/180);
gama=gama*(pi/180);
Rx=[1 0 0;0 cos(alpha) sin(alpha);0 -sin(alpha) cos(alpha)];
Ry=[cos(beta) 0 sin(beta);0 1 0;-sin(beta) 0 cos(beta)];
Rz=[cos(gama) sin(gama) 0;-sin(gama) cos(gama) 0;0 0 1];
R=Rz*Ry*Rx;
C=inv(K')*R*Q*R'*inv(K);
Cstar=inv(C);