Forward port SteveMacenski#262 to ROS 2

SteveMacenski · web-flow · commit 59802a3de99c · 2023-05-02T14:12:59.000-07:00
diff --git a/src/spatio_temporal_voxel_grid.cpp b/src/spatio_temporal_voxel_grid.cpp
@@ -102,6 +102,8 @@ void SpatioTemporalVoxelGrid::ClearFrustums(
 
   // accelerate the decay of voxels interior to the frustum
   if (this->IsGridEmpty()) {
+    _grid_points->clear();
+    _cost_map->clear();
     return;
   }
 

Original file line number	Diff line number	Diff line change
`@@ -102,6 +102,8 @@ void SpatioTemporalVoxelGrid::ClearFrustums(`
`102`	`102`
`103`	`103`	`// accelerate the decay of voxels interior to the frustum`
`104`	`104`	`if (this->IsGridEmpty()) {`
	`105`	`+ _grid_points->clear();`
	`106`	`+ _cost_map->clear();`
`105`	`107`	`return;`
`106`	`108`	`}`
`107`	`109`