undo changes

release/4.3a0
Varun Agrawal 2023-06-21 09:55:52 -04:00
parent 62fe1a9379
commit fbf155d91e
2 changed files with 9 additions and 25 deletions

View File

@ -81,23 +81,9 @@ public:
if (!cachedConstrainedKeyDimMap_.empty()) if (!cachedConstrainedKeyDimMap_.empty())
return cachedConstrainedKeyDimMap_; return cachedConstrainedKeyDimMap_;
// Collect key-dim map of all variables in the constraints // Collect key-dim map of all variables in the constraints
//TODO(Varun) seems like the templated function is causing the multiple symbols error on Windows cachedConstrainedKeyDimMap_ = collectKeyDim(equalities);
// cachedConstrainedKeyDimMap_ = collectKeyDim(equalities); KeyDimMap keysDim2 = collectKeyDim(inequalities);
// KeyDimMap keysDim2 = collectKeyDim(inequalities); cachedConstrainedKeyDimMap_.insert(keysDim2.begin(), keysDim2.end());
// cachedConstrainedKeyDimMap_.insert(keysDim2.begin(), keysDim2.end());
cachedConstrainedKeyDimMap_.clear();
for (auto&& factor : equalities) {
if (!factor) continue;
for (Key key : factor->keys()) {
cachedConstrainedKeyDimMap_[key] = factor->getDim(factor->find(key));
}
}
for (auto&& factor : inequalities) {
if (!factor) continue;
for (Key key : factor->keys()) {
cachedConstrainedKeyDimMap_[key] = factor->getDim(factor->find(key));
}
}
return cachedConstrainedKeyDimMap_; return cachedConstrainedKeyDimMap_;
} }

View File

@ -252,15 +252,13 @@ class GTSAM_UNSTABLE_EXPORT SmartStereoProjectionFactorPP
nonuniqueKeys.push_back(body_P_cam_keys_.at(i)); nonuniqueKeys.push_back(body_P_cam_keys_.at(i));
} }
// but we need to get the augumented hessian wrt the unique keys in key_ // but we need to get the augumented hessian wrt the unique keys in key_
//TODO(Varun) SchurComplementAndRearrangeBlocks is causing the multiply defined symbol error SymmetricBlockMatrix augmentedHessianUniqueKeys =
// SymmetricBlockMatrix augmentedHessianUniqueKeys = Base::Cameras::template SchurComplementAndRearrangeBlocks<3, DimBlock,
// Base::Cameras::template SchurComplementAndRearrangeBlocks<3, DimBlock, DimPose>(
// DimPose>( Fs, E, P, b, nonuniqueKeys, keys_);
// Fs, E, P, b, nonuniqueKeys, keys_);
// return std::make_shared<RegularHessianFactor<DimPose>>( return std::make_shared<RegularHessianFactor<DimPose>>(
// keys_, augmentedHessianUniqueKeys); keys_, augmentedHessianUniqueKeys);
return nullptr;
} }
/** /**