Merge branches 'master' and 'master' of

https://gitlab.iri.upc.edu/mobile_robotics/wolf

# Conflicts:
#	src/ceres_wrapper/ceres_manager.cpp

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)