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

add discrete factors to HybridBayesTree test

release/4.3a0
Varun Agrawal 2022-08-27 19:23:27 -04:00
parent 8645ec0f25
commit 31bbf513f4
1 changed files with 5 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
gtsam/hybrid/tests/testHybridBayesTree.cpp
View File

@ -51,6 +51,11 @@ TEST(HybridBayesTree, OptimizeAssignment) {
graph1.push_back(s.linearizedFactorGraph.at(i)); graph1.push_back(s.linearizedFactorGraph.at(i));
} }
// Add the discrete factors
for (size_t i = 7; i <= 9; i++) {
graph1.push_back(s.linearizedFactorGraph.at(i));
}
isam.update(graph1); isam.update(graph1);
DiscreteValues assignment; DiscreteValues assignment;