weixin_42048023的博客

​void MarginalizationInfo::preMarginalize() { for (auto it : factors) { it->Evaluate(); std::vector<int> block_sizes = it->cost_function->parameter_block_sizes(); for (int i = 0; i < static_cast<int&gt.