OdometryThread: fixed data buffer ignored if imu is always set

This commit is contained in:
matlabbe
2018-12-01 00:53:36 -05:00
parent abbcc4f8a9
commit f0ea8ab076
+1 -1
View File
@@ -150,7 +150,7 @@ void OdometryThread::addData(const SensorData & data)
bool notify = true; bool notify = true;
_dataMutex.lock(); _dataMutex.lock();
{ {
if(data.imu().empty()) if(!data.imageRaw().empty() || !data.laserScanRaw().isEmpty() || data.imu().empty())
{ {
_dataBuffer.push_back(data); _dataBuffer.push_back(data);
while(_dataBufferMaxSize > 0 && _dataBuffer.size() > _dataBufferMaxSize) while(_dataBufferMaxSize > 0 && _dataBuffer.size() > _dataBufferMaxSize)