undo changes
parent
62fe1a9379
commit
fbf155d91e
|
@ -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_;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -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;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
|
Loading…
Reference in New Issue