在Lua中的A*寻路算法

最近我在 Lua 中实现了 A* 寻路算法，但由于在成本中使用曼哈顿方法来处理 H 值，所以我遇到了错误的路径问题。

我想了解是否有其他方法来计算节点的成本。 下面是我目前正在使用的方法：

function CalcG(A,B)
    if type(A) == "table" then
        A = A.Pos
    end
    if type(B) == "table" then
        B = B.Pos
    end
    return (A-B).Magnitude
end

function CalcH(A,B)
    if type(A) == "table" then
        A = A.Pos
    end
    if type(B) == "table" then
        B = B.Pos
    end
    return math.abs(A.X - B.X) + math.abs(A.Z - B.Z)
end

function GetCost(A,B,C)
    return CalcG(A,B) + CalcH(B,C)
end

计算成本：

GetCost(Start,CurrentNode,End)

如果有人能指导我使用更好的启发式方法，我将不胜感激。