diff --git a/src/ceres_wrapper/ceres_manager.cpp b/src/ceres_wrapper/ceres_manager.cpp index c206e657c68d82ce4e12c405ef6490456981eda9..919e6f941e7bd4e830927ff7854109bd1cd2d746 100644 --- a/src/ceres_wrapper/ceres_manager.cpp +++ b/src/ceres_wrapper/ceres_manager.cpp @@ -295,6 +295,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)