From 8c2ea78b1aede2581fecacccb56526597aeb117b Mon Sep 17 00:00:00 2001 From: roderick-koehle <50633232+roderick-koehle@users.noreply.github.com> Date: Thu, 28 Oct 2021 13:27:05 +0200 Subject: [PATCH] Undo change in scaling function --- gtsam/geometry/Cal3Fisheye.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/gtsam/geometry/Cal3Fisheye.cpp b/gtsam/geometry/Cal3Fisheye.cpp index ee2e66080..c4ce151ba 100644 --- a/gtsam/geometry/Cal3Fisheye.cpp +++ b/gtsam/geometry/Cal3Fisheye.cpp @@ -32,7 +32,7 @@ Vector9 Cal3Fisheye::vector() const { } /* ************************************************************************* */ -double Cal3Fisheye::Scaling(double r, double zi) { +double Cal3Fisheye::Scaling(double r) { static constexpr double threshold = 1e-8; if (r > threshold || r < -threshold) { return atan(r) / r; @@ -53,7 +53,7 @@ Point2 Cal3Fisheye::uncalibrate(const Point2& p, OptionalJacobian<2, 9> H1, Vector5 K, T; K << 1, k1_, k2_, k3_, k4_; T << 1, t2, t4, t6, t8; - const double scaling = Scaling(r, zi); + const double scaling = Scaling(r); const double s = scaling * K.dot(T); const double xd = s * xi, yd = s * yi; Point2 uv(fx_ * xd + s_ * yd + u0_, fy_ * yd + v0_);