From 2d739dd5e86da69b0519b145f652ef102153795c Mon Sep 17 00:00:00 2001 From: Varun Agrawal Date: Thu, 3 Jun 2021 14:05:34 -0400 Subject: [PATCH] make rr and g as const --- gtsam/geometry/Cal3Bundler.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/gtsam/geometry/Cal3Bundler.cpp b/gtsam/geometry/Cal3Bundler.cpp index a95bda6b9..3ae624bbc 100644 --- a/gtsam/geometry/Cal3Bundler.cpp +++ b/gtsam/geometry/Cal3Bundler.cpp @@ -105,8 +105,8 @@ Point2 Cal3Bundler::calibrate(const Point2& pi, OptionalJacobian<2, 3> Dcal, int iteration = 0; do { // initialize pn with distortion included - double rr = (px * px) + (py * py); - double g = (1 + k1_ * rr + k2_ * rr * rr); + const double rr = (px * px) + (py * py); + const double g = (1 + k1_ * rr + k2_ * rr * rr); pn = invKPi / g; if (distance2(uncalibrate(pn), pi) <= tol_) break;