cameracalibrate_sdp.asv

来自「摄像机圆球标定程序（包括SDP,DSDP,IDC,DIDC,ALG,DALG六种」· ASV 代码 · 共 32 行

function [K R a]=CameraCalibrate_SDP(C)

s12=compute_sij(C{1},C{2});
s13=compute_sij(C{1},C{3});
count=0;
K=[];
for i=1: size(s12,1)
    for j=1:size(s13,1)
        s12_=s12(i);
        s13_=s13(j);
        C_{1}=C{1};
        C_{2}=C{2}*s12_;
        C_{3}=C{3}*s13_;
        vbar=ComputeV(C_);
        [w]=ComputeW_SDP(C_,vbar);
%        vbar=ComputeV(C_);
%        [w A pp]=ComputeW(C_,vbar);
       
        if is_positive(w)
            K_=ComputeK_W(w);
%             if validate_K(K_,C_);
%                count=count+1;
%                K{count}=K_;
%             end
            count=count+1;
            K{count}=K_;
        end
    end
end
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%recover from
[R a]=RecoverExtrinc()