12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

rename getUniqueKey

release/4.3a0
Akshay Krishnan 2022-05-07 11:26:21 -07:00
parent b42d3a3d2f
commit c1a7cf21d5
2 changed files with 4 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
gtsam/sfm/TranslationRecovery.cpp
View File

@ -93,7 +93,8 @@ void TranslationRecovery::addPrior(
// Add between factors for optional relative translations.
for (auto edge : betweenTranslations) {
Key k1 = getUniqueKey(edge.key1()), k2 = getUniqueKey(edge.key2());
Key k1 = getSameTranslationRootNode(edge.key1()),
k2 = getSameTranslationRootNode(edge.key2());
if (k1 != k2) {
graph->emplace_shared<BetweenFactor<Point3>>(k1, k2, edge.measured(),
edge.noiseModel());
@ -107,7 +108,7 @@ void TranslationRecovery::addPrior(
}
}
Key TranslationRecovery::getUniqueKey(const Key i) const {
Key TranslationRecovery::getSameTranslationRootNode(const Key i) const {
for (const auto &optimizedAndDuplicateKeys : sameTranslationNodes_) {
Key optimizedKey = optimizedAndDuplicateKeys.first;
std::set<Key> duplicateKeys = optimizedAndDuplicateKeys.second;

2
gtsam/sfm/TranslationRecovery.h
View File

@ -153,7 +153,7 @@ class TranslationRecovery {
* @return Key of optimized variable - same as input if it does not have any
* zero-translation edges.
*/
Key getUniqueKey(const Key i) const;
Key getSameTranslationRootNode(const Key i) const;
/**
* @brief Adds nodes that were not optimized for because they were connected