From d0144441cba0cac4d22f9af5e0b6c67119be7739 Mon Sep 17 00:00:00 2001 From: d-vo <{ID}+{username}@users.noreply.github.com> Date: Thu, 31 Mar 2022 20:30:51 +0200 Subject: [PATCH] InvDepthFactor3: Fix wrong derivative H3 --- gtsam_unstable/slam/InvDepthFactor3.h | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/gtsam_unstable/slam/InvDepthFactor3.h b/gtsam_unstable/slam/InvDepthFactor3.h index 3fd86f271..44d3b8fd0 100644 --- a/gtsam_unstable/slam/InvDepthFactor3.h +++ b/gtsam_unstable/slam/InvDepthFactor3.h @@ -92,7 +92,7 @@ public: } catch( CheiralityException& e) { if (H1) *H1 = Matrix::Zero(2,6); if (H2) *H2 = Matrix::Zero(2,5); - if (H3) *H2 = Matrix::Zero(2,1); + if (H3) *H3 = Matrix::Zero(2,1); std::cout << e.what() << ": Landmark "<< DefaultKeyFormatter(this->key2()) << " moved behind camera " << DefaultKeyFormatter(this->key1()) << std::endl; return Vector::Ones(2) * 2.0 * K_->fx();