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

Finding maximum frontal variables instead of assuming sorted

release/4.3a0
Richard Roberts 2011-09-01 21:49:08 +00:00
parent 872b145b16
commit 472c51b9b1
1 changed files with 2 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
gtsam/inference/BayesTree-inl.h
View File

@ -641,7 +641,8 @@ namespace gtsam {
}
// Now fill in the nodes index
if(nodes_.size() == 0 || (subtree->conditional()->lastFrontalKey()) > (nodes_.size() - 1)) {
if(nodes_.size() == 0 ||
*std::max_element(subtree->conditional()->beginFrontals(), subtree->conditional()->endFrontals()) > (nodes_.size() - 1)) {
nodes_.resize(subtree->conditional()->lastFrontalKey() + 1);
}
fillNodesIndex(subtree);