genconic_simu_points.m

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

function [C Cstar]=GenConic_simu_points()

K=GenCameraParameter();
[C_{1} Cstar_{1}]=GenConeConic(K,5,0,0,6);
[C_{2} Cstar_{2}]=GenConeConic(K,0,10,0,7);
[C_{3} Cstar_{3}]=GenConeConic(K,0,-10,0,6.5);

for i=1:3
%     C_{i}=diag([1 1 -25]);
    points{i}=GenPoints_ellipse(C_{i},[480 640],100);
%     imshow(img{i});
%     plot(points{i}(1,:),points{i}(2,:));
%     noise=rand(2,100)*30;
%     points{i}(1:2,:)=points{i}(1:2,:)+noise;
    points{i}=add_noise(points{i},'cut',0.5);
%     points{i}
    C{i}=FitConic(points{i});
%     C{i}=C_{i};
    Cstar{i}=inv(C{i});
end