diff --git a/gtsam/nonlinear/NonlinearConjugateGradientOptimizer.h b/gtsam/nonlinear/NonlinearConjugateGradientOptimizer.h index 9c4db5fd9..04d4734a4 100644 --- a/gtsam/nonlinear/NonlinearConjugateGradientOptimizer.h +++ b/gtsam/nonlinear/NonlinearConjugateGradientOptimizer.h @@ -193,7 +193,7 @@ boost::tuple nonlinearConjugateGradient(const S &system, // Polak-Ribiere: beta = g'*(g_n-g_n-1)/g_n-1'*g_n-1 const double beta = std::max(0.0, currentGradient.dot(currentGradient - prevGradient) - / currentGradient.dot(currentGradient)); + / prevGradient.dot(prevGradient)); direction = currentGradient + (beta * direction); }