Refine truncating algorithm — add points to short lines, too