Support simplification in 3D

[evetion]

I think updating _squared_distance_line to support the third dimension would be enough.

[asinghvi17]

There would need to be some way to opt out, I guess