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