Add new functors to compute distance to finite lines
Distance to finite plane still need to be added
New adopt heuristic based on distance to finite line functors