Added basic distance based pathfinding