Improved shortest paths

Dijkstra's algorithm in FollowPathAI now uses actual distances instead
of distance squared