i/rtabmap
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap.git synced 2026-09-03 10:00:23 +08:00
Code Issues Packages Projects Releases Wiki Activity

Fixed Bayes Filter prediction generation bug

Browse Source
This commit is contained in:
matlabbe
2015-09-07 23:31:03 -04:00
parent f51754ad64
commit d425d84ce2
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
corelib/src/BayesFilter.cpp
View File

@@ -289,9 +289,9 @@ cv::Mat BayesFilter::generatePrediction(const Memory * memory, const std::vector
for(std::list<int>::iterator iter = idsLoopMargin.begin(); iter!=idsLoopMargin.end(); ++iter) for(std::list<int>::iterator iter = idsLoopMargin.begin(); iter!=idsLoopMargin.end(); ++iter)
{ {
float sum = 0.0f; // sum values added float sum = 0.0f; // sum values added
sum += this->addNeighborProb(prediction, i, neighbors, idToIndexMap); sum += this->addNeighborProb(prediction, idToIndexMap.at(*iter), neighbors, idToIndexMap);
idsDone.insert(*iter); idsDone.insert(*iter);
this->normalize(prediction, i, sum, ids[0]<0); this->normalize(prediction, idToIndexMap.at(*iter), sum, ids[0]<0);
} }
} }
else else