Set the SB status when adding it

src/ceres_wrapper/ceres_manager.cpp

@@ -287,6 +287,7 @@ 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)

src/solver/solver_manager.cpp

@@ -45,7 +45,6 @@ void SolverManager::update()
         {
           state_blocks_.emplace(state, state->getState());
           addStateBlock(state);
-          updateStateBlockStatus(state);
         }
 
         WOLF_DEBUG_COND(registered, "Tried adding an already registered StateBlock.");