Fix distance computation bug in FCS extrapolator
This MR fixes a bug in the FCS extrapolator for which negative distances as a consequence of precision artifacts resulted in bad extrapolation. Unphysical negative distances are now forced to 0 and additional debug messages are added.
Edited by Joshua Falco Beirer