mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-04 16:57:46 +08:00
cherry picked https://github.com/introlab/rtabmap_ros/commit/e245b7751edf3f1c3b74578527c707b5aa3e630c for ros1 port
This commit is contained in:
@@ -567,9 +567,8 @@ void OdometryROS::processData()
|
||||
for(std::map<double, rtabmap::IMU>::iterator iter=iterFirst; iter!=iterEnd;)
|
||||
{
|
||||
// Because we always keep the last processed imu in the buffer, skip the first
|
||||
// one when processing again the buffer unless its time is lower/equal to image
|
||||
// current stamp (could happen on initialization).
|
||||
if(iter!=iterFirst || iter->first <= header.stamp.toSec()) {
|
||||
// one when processing again the buffer
|
||||
if(iter!=iterFirst) {
|
||||
imus.push_back(*iter);
|
||||
}
|
||||
if(iter!=iterLast) {
|
||||
|
||||
Reference in New Issue
Block a user