Fixed destination source check, now no longer uses excessive turns for path finding

Signed-off-by: Irmo van den Berge <bergerkiller@gmail.com>