Remove points longer than a threshold and remove overlap test