mirror of
https://github.com/introlab/rtabmap.git
synced 2026-10-09 03:27:45 +08:00
Added new options to filter source laser scans.
SensorData can support laser scans CV_32FC6 format (point cloud with normals). Refactored RegistrationICP and updated CloudViewer to show PointNormal data. Fixed bug with stereo clouds deterioration if decimation is set (CameraModel::scale()).
This commit is contained in:
@@ -181,6 +181,10 @@ Transform Registration::computeTransformationMod(
|
||||
RegistrationInfo * infoOut) const
|
||||
{
|
||||
RegistrationInfo info;
|
||||
if(infoOut)
|
||||
{
|
||||
info = *infoOut;
|
||||
}
|
||||
Transform t = computeTransformationImpl(from, to, guess, info);
|
||||
if(child_)
|
||||
{
|
||||
@@ -196,9 +200,9 @@ Transform Registration::computeTransformationMod(
|
||||
|
||||
if(varianceFromInliersCount_)
|
||||
{
|
||||
if(info.inliersRatio)
|
||||
if(info.icpInliersRatio)
|
||||
{
|
||||
info.variance = info.inliersRatio > 0?1.0/double(info.inliersRatio):1.0;
|
||||
info.variance = info.icpInliersRatio > 0?1.0/double(info.icpInliersRatio):1.0;
|
||||
}
|
||||
else
|
||||
{
|
||||
|
||||
Reference in New Issue
Block a user