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