change EPSILON from 1e-7 to 1e-8 to ~ 0.1 meter resolution