i/rtabmap_ros
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap_ros.git synced 2026-10-07 02:07:45 +08:00
Code Issues Packages Projects Releases Wiki Activity

Increased package to 0.10.10: Updated RVIZ InfoDisplay plugin

Browse Source
This commit is contained in:
matlabbe
2015-10-13 16:58:14 -04:00
parent 674fe34255
commit a10b0c34b4
4 changed files with 14 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/rviz/InfoDisplay.cpp
+11
View File
@@ -76,8 +76,13 @@ void InfoDisplay::processMessage( const rtabmap_ros::InfoConstPtr& msg )
info_ = "";
}
loopTransform_ = rtabmap_ros::transformFromGeometryMsg(msg->loopClosureTransform);
rtabmap::Statistics stat;
rtabmap_ros::infoFromROS(*msg, stat);
statistics_ = stat.data();
}
this->emitTimeSignal(msg->header.stamp);
}
@@ -100,6 +105,11 @@ void InfoDisplay::update( float wall_dt, float ros_dt )
}
this->setStatusStd(rviz::StatusProperty::Ok, "Global", tr("%1").arg(globalCount_).toStdString());
this->setStatusStd(rviz::StatusProperty::Ok, "Local", tr("%1").arg(localCount_).toStdString());
for(std::map<std::string, float>::const_iterator iter=statistics_.begin(); iter!=statistics_.end(); ++iter)
{
this->setStatus(rviz::StatusProperty::Ok, iter->first.c_str(), tr("%1").arg(iter->second));
}
}
}
@@ -111,6 +121,7 @@ void InfoDisplay::reset()
info_.clear();
globalCount_ = 0;
localCount_ = 0;
statistics_.clear();
}
}