113 assert(startTime < endTime);
139 double norm_resid = sqrt(f1*f1+f2*f2);
143 unsigned counter = 0;
144 while ((norm_resid>
mTolerance) && (counter++<15))
147 double j11,j12,j21,j22;
150 double h = std::max(fabs(catrop_guess/100),1e-8);
155 h = std::max(fabs(z_guess/100),1e-8);
161 double one_over_det = 1.0/(j11*j22-j12*j21);
162 double u1 = one_over_det*(j22*f1 - j12*f2);
163 double u2 = one_over_det*(-j21*f1 + j11*f2);
169 norm_resid = sqrt(f1*f1+f2*f2);