[Fix] remove unneeded for loop of BuildVoxelMap

[ZXY595]

Changes:

This fix removes the local variable input_points to eliminate unnecessary memory overhead, merges two for loops into a single loop.