Set point_first_ and point_last_ of LineSegment as "extreme" or "unknown" point types
According whether the neighbors are closer or farther, decide if points first and last are "extreme" or "unknown". This would constraint much better the SLAM problem