Fixed Tango odometry variance

This commit is contained in:
matlabbe
2017-02-07 15:57:52 -05:00
parent 5e9c4fde95
commit 1c555f321b
4 changed files with 12 additions and 8 deletions
+2 -2
View File
@@ -685,8 +685,8 @@ void CameraTango::mainLoop()
stampEpochOffset_ = UTimer::now()-data.stamp();
}
data.setStamp(stampEpochOffset_ + data.stamp());
LOGI("Publish odometry message (variance=%f)", firstFrame_?9999:0.0001);
this->post(new OdometryEvent(data, pose, firstFrame_?9999:0.0001, firstFrame_?9999:0.0001));
LOGI("Publish odometry message (variance=%f)", firstFrame_?9999:0.000001);
this->post(new OdometryEvent(data, pose, firstFrame_?9999:0.000001, firstFrame_?9999:0.000001));
firstFrame_ = false;
}
else if(!this->isKilled())