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

Added mapIds to rtabmap::get3DMap()

Browse Source 
git-svn-id: http://rtabmap.googlecode.com/svn/trunk/rtabmap@1644 f169173b-cf89-36c8-b27e-44dbe73f0c83
This commit is contained in:
matlabbe
2014-08-13 18:57:17 +00:00
parent 4fba63b882
commit 7cf89b6d76
4 changed files with 17 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

3
corelib/src/Rtabmap.cpp
View File

@@ -2177,6 +2177,7 @@ void Rtabmap::get3DMap(std::map<int, std::vector<unsigned char> > & images,
std::map<int, Transform> & localTransforms,
std::map<int, Transform> & poses,
std::multimap<int, Link> & constraints,
std::map<int, int> & mapIds,
bool optimized,
bool global) const
{
@@ -2229,6 +2230,8 @@ void Rtabmap::get3DMap(std::map<int, std::vector<unsigned char> > & images,
{
localTransforms.insert(std::make_pair(*iter, localTransform));
}
mapIds.insert(std::make_pair(*iter, _memory->getMapId(*iter)));
}
}
}

9
corelib/src/RtabmapThread.cpp
View File

@@ -110,6 +110,7 @@ void RtabmapThread::publishMap(bool optimized, bool full) const
std::map<int, Transform> localTransforms;
std::map<int, Transform> poses;
std::multimap<int, Link> constraints;
std::map<int, int> mapIds;
_rtabmap->get3DMap(images,
depths,
@@ -121,6 +122,7 @@ void RtabmapThread::publishMap(bool optimized, bool full) const
localTransforms,
poses,
constraints,
mapIds,
optimized,
full);
@@ -133,7 +135,8 @@ void RtabmapThread::publishMap(bool optimized, bool full) const
depthCys,
localTransforms,
poses,
constraints));
constraints,
mapIds));
}
void RtabmapThread::publishTOROGraph(bool optimized, bool full) const
@@ -148,6 +151,7 @@ void RtabmapThread::publishTOROGraph(bool optimized, bool full) const
std::map<int, Transform> localTransforms;
std::map<int, Transform> poses;
std::multimap<int, Link> constraints;
std::map<int, int> mapIds;
_rtabmap->getGraph(poses,
constraints,
@@ -163,7 +167,8 @@ void RtabmapThread::publishTOROGraph(bool optimized, bool full) const
depthCys,
localTransforms,
poses,
constraints));
constraints,
mapIds));
}