论坛 › 控制、可靠性及优化 › 非线性最小二乘法程序1

博大广阔 发表于 2012-6-6 19:43

非线性最小二乘法程序1

function = minLM(f,x0,beta,u,v,var,eps)
format long;
if nargin == 6
    eps = 1.0e-6;
end
S = transpose(f)*f;
k = length(f);
n = length(x0);
x0 = transpose(x0);
A = jacobian(f,var);
tol = 1;

while tol>eps
    Fx = zeros(k,1);
    for i=1:k
      Fx(i,1) = Funval(f(i),var,x0);
    end
    Sx = Funval(S,var,x0);
    Ax = Funval(A,var,x0);
    gSx = transpose(Ax)*Fx;
    Q = transpose(Ax)*Ax;
   
    while 1
      dx = -(Q+u*eye(size(Q)))\gSx;

      x1 = x0 + dx;
      for i=1:k
            Fx1(i,1) = Funval(f(i),var,x1);
      end
      Sx1 = Funval(S,var,x1);
      tol = norm(dx);
      if tol<=eps
            break;
      end

      if Sx1 >= Sx+beta*transpose(gSx)*dx
            u = v*u;
            continue;
      else
            u = u/v;
            break;
      end
    end
    x0 = x1;
end
x = x0;
minf = Funval(S,var,x);
format short;

查看完整版本: 非线性最小二乘法程序1