stateestimation-ipm/LevenbergMarquardt.m

10 lines
119 B
Matlab

function [ output_args ] = LevenbergMarquardt( J,x )
t=0.1;
A=J'*J;
u=t*max(diag(A));
dh=(A+u*eye(size(A)) )\g;
end