genconeconic.asv

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

function [C Cstar]=GenConeConic(o_offset,o)

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