icp error

[GridGeneration]

Crash occurs when median_dist is 0

[GridGeneration]

if (median_dist)
maxdist = DIST_THRESH_MULT * median_dist;
else if (std::abs(median_dist) <= 1e-5)
return 0;