diff --git a/matlab/solve1.m b/matlab/solve1.m index fa6a3262f..5c2cd1246 100644 --- a/matlab/solve1.m +++ b/matlab/solve1.m @@ -121,7 +121,20 @@ for its = 1:maxit end if rcond_fjac < sqrt(eps) fjac2=fjac'*fjac; - p=-(fjac2+sqrt(nn*eps)*max(sum(abs(fjac2)))*eye(nn))\(fjac'*fvec); + temp=max(sum(abs(fjac2))); + if temp>0 + p=-(fjac2+sqrt(nn*eps)*temp*eye(nn))\(fjac'*fvec); + else + errorflag = true; + errorcode = 5; + if nargout<3 + skipline() + dprintf('SOLVE: Iteration %s', num2str(its)) + disp('Zero Jacobian.') + skipline() + end + return + end else p = -fjac\fvec ; end diff --git a/matlab/trust_region.m b/matlab/trust_region.m index 6b070d62b..3e2396252 100644 --- a/matlab/trust_region.m +++ b/matlab/trust_region.m @@ -327,5 +327,9 @@ else end % Form the appropriate convex combination of the Gauss-Newton direction and the % scaled gradient direction. - x = alpha*x + (1.0-alpha)*min(sgnorm, delta)*s; + if alpha>0 + x = alpha*x + (1.0-alpha)*min(sgnorm, delta)*s; + else %prevent zero weight on Inf evaluating to NaN + x = min(sgnorm, delta)*s; + end end \ No newline at end of file