Small fix

Here I fix something I think might be wrong. In particular, if
safe==false && alEqDis
it looks like dist was initialized to the correct value but then not used.

From the current code coverage it looks this path was never tried.
Anyway, I am pretty sure the old code does not make sense.