recoverextrincstar.asv

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

function [r3 a]=RecoverExtrincStar(Cstar,K,vbar)
% r3=[];
% a=[];
% return;
    
    for j=1:size(K,2)
        K_=K{j};
        vbar_=vbar{j};
        
        for i=1:3
            K__=K_;
            vbar__=vbar_{i};
            %%%%%%%%%%%%%%%%%%%%%%%
            %method 1
            RQRt=inv(K__)*Cstar{i}*inv(K__');
            [V D]=eig(RQRt);
            a{i}{j}=find_a(diag(D));
            a{i}{j}=1/a{i}{j};
            
            r3{i}{i}=inv(K__)*(vbar__);
            r3{}{i}=r3{j}{i}/norm(r3{j}{i});
        end
    end