From 13a1ba27812a8856b50e07c4f4eec711203d7900 Mon Sep 17 00:00:00 2001
From: Joan Sola <jsola@iri.upc.edu>
Date: Thu, 29 Nov 2018 11:23:28 +0100
Subject: [PATCH] Set the SB status when adding it
---
src/ceres_wrapper/ceres_manager.cpp | 2 ++
1 file changed, 2 insertions(+)
diff --git a/src/ceres_wrapper/ceres_manager.cpp b/src/ceres_wrapper/ceres_manager.cpp
index 568bd9472..8533cb7a4 100644
--- a/src/ceres_wrapper/ceres_manager.cpp
+++ b/src/ceres_wrapper/ceres_manager.cpp
@@ -289,6 +289,8 @@ void CeresManager::addStateBlock(const StateBlockPtr& state_ptr)
ceres_problem_->AddParameterBlock(getAssociatedMemBlockPtr(state_ptr),
state_ptr->getSize(),
local_parametrization_ptr);
+
+ updateStateBlockStatus(state_ptr);
}
void CeresManager::removeStateBlock(const StateBlockPtr& state_ptr)
--
GitLab