二维地图的寻路算法2

    二维地图的寻路算法2。

    首先需要说明本算法得到的解不一定是最优解，但是比普通的回溯算法速度要快。

    代码如下：

4. import java.util.Stack;
6. /**
7.  * 找到从地图上一个点到另一个点的路径
8.  * 
9.  * @author cuilichen
10.  * 
11.  */
12. public class FindPath {
13.     /**
14.      * 用来存放操作步骤的栈
15.      */
16.     private Stack stack = new Stack();
18.     /**
19.      * 地图的宽度
20.      */
21.     private int wid = 8;
23.     /**
24.      * 找到从地图上一个点到另一个点的路径
25.      * 
26.      * @param map
27.      * @param origin
28.      * @param target
29.      * @return
30.      */
31.     public String find(byte[] map, int origin, int target) {
32.         if (origin == target) {
33.             return "";
34.         }
35.         int[] step = new int[10];
36.         step[1] = origin;
37.         judge(map, step, target);
38.         stack.push(step);// 根节点
40.         if (!findPath(map, target)) { // 没有找到路径
41.             return null;
42.         }
44.         optimize(stack);
45.         StringBuffer sb = new StringBuffer();
46.         for (int i = 1; i < stack.size(); i++) {
47.             step = (int[]) stack.elementAt(i);
48.             sb.append((char) step[0]);
49.         }
50.         return sb.toString();
51.     }
53.     /**
54.      * 得到相邻4个点的评价值（距目标点的直线距离的平方），并按照从小到大的顺序排列。
55.      * 
56.      * @param map
57.      * @param node
58.      * @param target
59.      */
60.     private void judge(byte[] map, int[] node, int target) {
61.         int origin = node[1];
62.         int x0 = origin % wid;
63.         int y0 = origin / wid;
64.         int x1 = target % wid;
65.  &nbs