mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 01:20:25 +08:00
Added rtabmap-kitti_dataset tool
This commit is contained in:
@@ -2314,7 +2314,15 @@ std::map<int, std::pair<pcl::PointCloud<pcl::PointXYZRGBNormal>::Ptr, pcl::Indic
|
||||
}
|
||||
else
|
||||
{
|
||||
UERROR("Cloud %d not found in cache!", iter->first);
|
||||
int weight = 0;
|
||||
if(_dbDriver)
|
||||
{
|
||||
_dbDriver->getWeight(iter->first, weight);
|
||||
}
|
||||
if(weight>=0) // don't show error for intermediate nodes
|
||||
{
|
||||
UERROR("Cloud %d not found in cache!", iter->first);
|
||||
}
|
||||
}
|
||||
}
|
||||
else if(uContains(cachedClouds, iter->first))
|
||||
|
||||
@@ -2386,7 +2386,10 @@ void MainWindow::updateMapCloud(
|
||||
else
|
||||
#endif
|
||||
{
|
||||
_occupancyGrid->update(poses);
|
||||
if(_occupancyGrid->addedNodes().size() || _occupancyGrid->cacheSize()>0)
|
||||
{
|
||||
_occupancyGrid->update(poses);
|
||||
}
|
||||
if(stats)
|
||||
{
|
||||
stats->insert(std::make_pair("GUI/Grid Update/ms", (float)timer.restart()*1000.0f));
|
||||
@@ -2505,7 +2508,6 @@ void MainWindow::updateMapCloud(
|
||||
|
||||
std::pair<pcl::PointCloud<pcl::PointXYZRGB>::Ptr, pcl::IndicesPtr> MainWindow::createAndAddCloudToMap(int nodeId, const Transform & pose, int mapId)
|
||||
{
|
||||
UDEBUG("");
|
||||
UASSERT(!pose.isNull());
|
||||
std::string cloudName = uFormat("cloud%d", nodeId);
|
||||
std::pair<pcl::PointCloud<pcl::PointXYZRGB>::Ptr, pcl::IndicesPtr> outputPair;
|
||||
@@ -2824,7 +2826,6 @@ std::pair<pcl::PointCloud<pcl::PointXYZRGB>::Ptr, pcl::IndicesPtr> MainWindow::c
|
||||
}
|
||||
}
|
||||
|
||||
UDEBUG("");
|
||||
return outputPair;
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user