Add HeatmapPathfinding