A*核心循环需维护openSet（按f=g+h排序）和closedSet；每次取f最小节点，若非终点则更新邻居g值与parent，加入closedSet防重访；推荐用std::set管理openSet，h函数须≤实际距离，四向用曼哈顿距离，八向用切比雪夫或加权欧氏距离；路径通过parent链回溯并反转获得。
怎么写一个能跑通的 A* 核心循环
核心就是维护两个集合：openSet（待探索节点，按预估总代价 f = g + h 排序）和 closedSet（已处理节点）。每次从 openSet 取出 f 最小的节点，检查是否是终点；如果不是，遍历其可达邻居，更新它们的 g 值（起点到该邻居的实际距离）和 parent 指针。
实操建议：
- 用
std::priority_queue或std::set管理openSet，但注意std::priority_queue不支持修改内部元素优先级，所以更稳妥是用std::set>，靠f值排序，插入/删除都 O(log n) -
g值初始化为INFINITY（可用std::numeric_limits::max()），起点的g设为 0 - 邻居生成要严格限制在合法格子内（比如地图数组边界、不可通行标识如
1或WALL） - 别忘了把当前节点加入
closedSet，否则可能重复处理甚至死循环
曼哈顿距离 vs 欧氏距离：h 函数怎么选
h（启发式函数）必须满足“不大于实际剩余距离”，否则 A* 不再保证最优。网格地图中常见两种：
- 四向移动（上/下/左/右）→ 用
manhattan_distance：abs(x1 - x2) + abs(y1 - y2) - 八向移动（含对角线）→ 用切比雪夫距离更准：
std::max(abs(x1 - x2), abs(y1 - y2))；若对角线代价是 1.414，则用带权重的欧氏距离也行，但要确保不超估 - 用欧氏距离
sqrt((x1-x2)*(x1-x2) + (y1-y2)*(y1-y2))在八向图里会轻微低估，没问题；但在纯四向图里它可能高估（比如 (0,0)→(1,1)，欧氏≈1.414，但实际需走 2 步），导致非最优——这点常被忽略
如何从 parent 链还原路径
A* 结束后，如果找到终点，就从终点顺着 parent 指针一路回溯到起点，把每个节点压入 vector，最后反转即可得到正向路径。
立即学习“C++免费学习笔记（深入）”；
