This works fine in general, but with high point densities the robot will choke/stutter
The problem is really the number of points too close together. Can you check the program you are using to generate the positions whether a kind of data reduction is available.