Changed pathfindingsystem a bit