icp_odometry: fixed scan conversion with intensity (#412)

This commit is contained in:
matlabbe
2020-05-25 20:10:05 -04:00
parent e69557c0ca
commit 2349c6b11e
+2 -2
View File
@@ -332,7 +332,7 @@ private:
}
rtabmap::SensorData data(
LaserScan::backwardCompatibility(scan, maxLaserScans, scanMsg->range_max, localScanTransform),
LaserScan(scan, maxLaserScans, scanMsg->range_max, scan.channels()==6?LaserScan::kXYINormal:LaserScan::kXYI, localScanTransform),
cv::Mat(),
cv::Mat(),
CameraModel(),
@@ -496,7 +496,7 @@ private:
}
}
LaserScan laserScan = LaserScan::backwardCompatibility(scan, maxLaserScans, 0, localScanTransform);
LaserScan laserScan(scan, maxLaserScans, 0, scan.channels()==7?LaserScan::kXYZINormal:LaserScan::kXYZI, localScanTransform);
if(scanRangeMin_ > 0 || scanRangeMax_ > 0)
{
laserScan = util3d::rangeFiltering(laserScan, scanRangeMin_, scanRangeMax_);