[fix] Fix infinite loop of ClearPoints

Tong Furequested to merge
fix/FixClearPointInfiniteLoop into master

There was an infinite loop when updating maps. It is due to the miss of rolling voxel grid.

Merge request reports