#11 Fix bug with pathfinding