Added distance following algorithm.
Merge remote-tracking branch 'origin/master' into Kaibo's-Brancherinos