大概半年前在写蜂窝网格的A*寻路算法时,遇到了如何选择启发式的问题。传统的曼哈顿距离虽然可以正常运行找到正确的最短路径,但是在蜂窝网格地图中,两点间的最短路径不止一条,曼哈顿距离会使路径的选择总是偏向某一方向。根本原因是启发式中的曼哈顿距离并不是两点间真正的最短距离。
在网上搜索了很多,但是一直没有搜到合适的方法,于是在炎热的某一天,自己动笔寻找这种方法。没想到的是答案竟然十分简单。
下图采用二维坐标表示了一个蜂窝网格地图
在二维坐标系中,横坐标为x,纵坐标为y,可以得出结论,p1(x1,y1)和p2(x2,y2)之间的最短距离为:
注: 公式中的除法是求整数商,比如 3/2=1.
用这个公式可以计算出(1,1)到(4,4)的最短距离为
(|1/2-4/2+1-4|+|1-4x|+|(1-4)+(4/