i/rtabmap
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap.git synced 2026-09-02 09:30:25 +08:00
Code Issues Packages Projects Releases Wiki Activity

Grid: don't filter max range before doing ray tracing (to ray trace empty space).

Browse Source
This commit is contained in:
matlabbe
2022-01-17 14:22:11 -05:00
parent 7a5c50cb0e
commit de62bbb9b7
1 changed files with 8 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

14
corelib/src/OccupancyGrid.cpp
View File

@@ -336,10 +336,11 @@ void OccupancyGrid::createLocalMap(
const Transform & t = node.sensorData().laserScanRaw().localTransform();
LaserScan scan = util3d::downsample(node.sensorData().laserScanRaw(), scanDecimation_);
#ifdef RTABMAP_OCTOMAP
// clipping will be done in OctoMap
float maxRange = grid3D_&&rayTracing_?0.0f:cloudMaxDepth_;
// If ray tracing enabled, clipping will be done in OctoMap or in occupancy2DFromLaserScan()
float maxRange = rayTracing_?0.0f:cloudMaxDepth_;
#else
float maxRange = cloudMaxDepth_;
// If ray tracing enabled, clipping will be done in occupancy2DFromLaserScan()
float maxRange = !grid3d_ && rayTracing_?0.0f:cloudMaxDepth_;
#endif
if(cloudMinDepth_ > 0.0f || maxRange > 0.0f)
{
@@ -390,10 +391,11 @@ void OccupancyGrid::createLocalMap(
node.sensorData(),
cloudDecimation_,
#ifdef RTABMAP_OCTOMAP
// clipping will be done in OctoMap
grid3D_&&rayTracing_?0.0f:cloudMaxDepth_,
// If ray tracing enabled, clipping will be done in OctoMap or in occupancy2DFromLaserScan()
rayTracing_?0.0f:cloudMaxDepth_,
#else
cloudMaxDepth_,
// If ray tracing enabled, clipping will be done in occupancy2DFromLaserScan()
!grid3D_&&rayTracing_?0.0f:cloudMaxDepth_,
#endif
cloudMinDepth_,
indices.get(),