jensam.m

一个很好用的摄像机标定程序

function [fvec,J] = jensam(n,m,x,opt)
% **********************************************
% **********************************************
%
% function [fvec, J]= jensam(n,m,x,opt)
% Jenrich and Sampson function [6]
% Dimensions n=2,   m>=n
% Function definition 
%               f(x)=2+2i-(exp[ix1] + exp[ix2])
% Standard starting point x=(0.3,0.4)
% minima of f=124.362 at x1=x2=0.2578 for m=10
%
% Revised 10/23/94  PLK
% **********************************************
J=zeros(m,n);

if ((opt==1) | (opt==3))
        for i=1:m
                fvec(i) =  (2+2*i-(exp(i*x(1))+exp(i*x(2)))) ;
        end
        fvec=fvec';
end;

if ((opt==2) | (opt ==3))
        for i=1:m
                J(i,1)  =  (-i*exp(i*x(1))) ;
                J(i,2)  =  (-i*exp(i*x(2))) ;
        end
end;

if((opt<1)|(opt>3))
  disp(' Error: The option value is either <0 or >3') 
end