function [stepmin,fbest]=cubici3(fnew,fold,graddnew,graddold,stepsize)
%CUBICI3  Cubicly interpolates 2 points and gradients to find step and min.
%
%   This function uses cubic interpolation and the values of 
%   two points and their gradients in order estimate the minimum of a 
%   a function along a line.

%   Copyright (c) 1990-98 by The MathWorks, Inc.
%   $Revision: 1.10 $  $Date: 1997/11/29 01:23:03 $
%   Andy Grace 7-9-90.
if isinf(fnew), fnew=1/eps; end
amat=[1/3*stepsize^3 , 0.5*stepsize^2; stepsize^2     stepsize];
bmat=[fnew-graddold*stepsize-fold; graddnew-graddold];
abd=amat\bmat;
if isequal(abd(1),0)
  x1 = -graddold/abd(2);
  stepmin = x1;
else
  root=real(sqrt(abd(2)^2-4*abd(1)*graddold));
  x1=(-abd(2)+root)/(2*abd(1));
  if 2*abd(1)*x1+abd(2)>0
      stepmin=x1;
  else
      stepmin=(-abd(2)-root)/(2*abd(1));;
  end
end
    
if stepmin<0,  stepmin=-stepmin; end
fbest=1/3*abd(1)*stepmin^3+0.5*abd(2)*stepmin^2+graddold*stepmin+fold;