Extend pathfinding to track multiple weighted objectives