gusucode.com > matlab编程A星算法的航迹规划3维源码程序 > code2/matlab编程A星算法的航迹规划3维源码程序/code/gn.m

    function v = gn(point)
%GN    计算该点到起点的距离

global G parent
% 取出父节点
pr = parent{point(1),point(2),point(3)}; %
          
ed = norm(pr-point);   % 欧式距离
v = G(pr(1),pr(2),pr(3)) + ed;
end