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

    function v = hn(point,endp)
%HN    计算该点到终点的曼哈顿距离

v = abs(point(1)-endp(1)) + abs(point(2)-endp(2))+abs(point(3)-endp(3));
end