Cleaned up Position, move pathfinding to separate class.