mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 01:20:25 +08:00
cloudRGBFromSensorData(): just return empty cloud if inputs are not valid (don't assert)
This commit is contained in:
@@ -990,12 +990,9 @@ pcl::PointCloud<pcl::PointXYZRGB>::Ptr RTABMAP_EXP cloudRGBFromSensorData(
|
|||||||
decimation = 1;
|
decimation = 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
UASSERT(!sensorData.imageRaw().empty());
|
|
||||||
UASSERT((!sensorData.depthRaw().empty() && sensorData.cameraModels().size()) ||
|
|
||||||
(!sensorData.rightRaw().empty() && sensorData.stereoCameraModel().isValidForProjection()));
|
|
||||||
pcl::PointCloud<pcl::PointXYZRGB>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZRGB>);
|
pcl::PointCloud<pcl::PointXYZRGB>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZRGB>);
|
||||||
|
|
||||||
if(!sensorData.depthRaw().empty() && sensorData.cameraModels().size())
|
if(!sensorData.imageRaw().empty() && !sensorData.depthRaw().empty() && sensorData.cameraModels().size())
|
||||||
{
|
{
|
||||||
//depth
|
//depth
|
||||||
UDEBUG("");
|
UDEBUG("");
|
||||||
@@ -1090,7 +1087,7 @@ pcl::PointCloud<pcl::PointXYZRGB>::Ptr RTABMAP_EXP cloudRGBFromSensorData(
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
else if(!sensorData.rightRaw().empty() && sensorData.stereoCameraModel().isValidForProjection())
|
else if(!sensorData.imageRaw().empty() && !sensorData.rightRaw().empty() && sensorData.stereoCameraModel().isValidForProjection())
|
||||||
{
|
{
|
||||||
//stereo
|
//stereo
|
||||||
UDEBUG("");
|
UDEBUG("");
|
||||||
|
|||||||
Reference in New Issue
Block a user