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

DataRecorder node: added check on inf variance

Browse Source
This commit is contained in:
Mathieu Labbe
2015-04-02 11:53:02 -04:00
parent ba80c887b4
commit 48e3ff6dde
1 changed files with 6 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/DataRecorderNode.cpp
+6 -6
View File
@@ -371,8 +371,8 @@ private:
cy,
localTransform,
rtabmap_ros::transformFromPoseMsg(odomMsg->pose.pose),
rotVariance>0?rotVariance:1.0f,
transVariance>0?transVariance:1.0f,
uIsFinite(rotVariance) && rotVariance>0?rotVariance:1,
uIsFinite(transVariance) && transVariance>0?transVariance:1,
0,
rtabmap_ros::timestampFromROS(imageMsg->header.stamp));
recorder_.addData(data);
@@ -471,8 +471,8 @@ private:
cy,
localTransform,
rtabmap_ros::transformFromPoseMsg(odomMsg->pose.pose),
rotVariance>0?rotVariance:1.0f,
transVariance>0?transVariance:1.0f,
uIsFinite(rotVariance) && rotVariance>0?rotVariance:1,
uIsFinite(transVariance) && transVariance>0?transVariance:1,
0,
rtabmap_ros::timestampFromROS(imageMsg->header.stamp));
recorder_.addData(data);
@@ -529,8 +529,8 @@ private:
cy,
localTransform,
rtabmap_ros::transformFromPoseMsg(odomMsg->pose.pose),
rotVariance>0?rotVariance:1.0f,
transVariance>0?transVariance:1.0f,
uIsFinite(rotVariance) && rotVariance>0?rotVariance:1,
uIsFinite(transVariance) && transVariance>0?transVariance:1,
0,
rtabmap_ros::timestampFromROS(leftImageMsg->header.stamp));
recorder_.addData(data);