Is it safe to add some epsilon in here, so that collision grids don't regenerate if they are close enough? https://github.com/MRPT/mrpt/blob/master/libs/nav/src/tpspace/CParameterizedTrajectoryGenerator.cpp#L625