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