A算法+最佳优先搜索+启发式评估的贪心算法

这段代码实现了最佳优先搜索算法，通过启发式评估函数（h_cost）和路径成本（g_cost）寻找图中从起点到终点的最短路径。算法使用优先级队列管理待探索节点（openList），扩展邻居节点并更新其路径成本，直到找到目标节点或无可行路径。路径和总路径成本在找到目标时被返回。