fitconic.asv

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

function [C]=FitConic(img)
%img为布尔矩阵
xlen=size(img,1);
ylen=size(img,2);
x0=
points=[];
for i=1:xlen
    for j=1:ylen
        if img(i,j)
           
           points=[points;[i j]]; 
        end
    end
end
A=[points(:,1).*points(:,1)];
A=[A points(:,1).*points(:,2)];
A=[A points(:,2).*points(:,2)];
A=[A points(:,1)];
A=[A points(:,2)];
A=[A ones(size(points,1),1)];
%solve A*p=0
[U S V]=svd(A);
p=V(:,6);
C=[p(1) p(2) p(4);p(2) p(3) p(5);p(4) p(5) p(6)];