DBReader: copy stamps in odom messages

This commit is contained in:
matlabbe
2015-10-07 19:38:33 -04:00
parent aa92486ff0
commit afaf6509f7

View File

@@ -155,7 +155,10 @@ void DBReader::mainLoop()
{ {
int goalId = 0; int goalId = 0;
double previousStamp = odom.data().stamp(); double previousStamp = odom.data().stamp();
odom.data().setStamp(UTimer::now()); if(previousStamp == 0)
{
odom.data().setStamp(UTimer::now());
}
if(odom.data().userDataRaw().type() == CV_8SC1 && if(odom.data().userDataRaw().type() == CV_8SC1 &&
odom.data().userDataRaw().cols >= 7 && // including null str ending odom.data().userDataRaw().cols >= 7 && // including null str ending
odom.data().userDataRaw().rows == 1 && odom.data().userDataRaw().rows == 1 &&