云风的求解最短路径代码.docVIP

/* 云风的求解最短路径代码 (Cloud Wus Pathfinding code) * 1999 年 1月 8 日 (1999, Jan 8) * 这段代码没有进行任何优化(包括算法上的), 但不意味我不知道该怎样优化它， * 它是为教学目的而做,旨在用易于理解和简洁的代码描述出 A* 算法在求最段路 * 径中的运用. 由于很久没有摸算法书, 本程序不能保证是纯正的 A* 算法 ;-) * 你可以在理解了这段程序的基础上,按自己的理解写出类似的代码. 但是简单的 * 复制它到你的程序中是不允许的,如果你真要这样干,请在直接使用它的软件的 * 文档中,写上我的名字 ;-) * 有任何的问题,或建议请 E-mail 到 cloudwu@263.net * 欢迎参观我的主页 /~cloudwu (云风工作室) * (你可以在上面找到一些有关这个问题的讨论,和有关游戏设计的其它大量资料) * * 本程序附带有一个数据文件 map.dat, 保存有地图的数据 */ // #define NDEBUG #include stdio.h #include conio.h #include assert.h #include stdlib.h #define MAPMAXSIZE 100 //地图面积最大为 100x100 #define MAXINT 8192 //定义一个最大整数, 地图上任意两点距离不会超过它 #define STACKSIZE 65536 //保存搜索节点的堆栈大小 #define tile_num(x,y) ((y)*map_w+(x)) //将 x,y 坐标转换为地图上块的编号 #define tile_x(n) ((n)%map_w) //由块编号得出 x,y 坐标 #define tile_y(n) ((n)/map_w) // 树结构, 比较特殊, 是从叶节点向根节点反向链接 typedef struct node *TREE; struct node { int h; int tile; TREE father; } ; typedef struct node2 *LINK; struct node2 { TREE node; int f; LINK next; }; LINK queue; // 保存没有处理的行走方法的节点 TREE stack[STACKSIZE]; // 保存已经处理过的节点 (搜索完后释放) int stacktop; unsigned char map[MAPMAXSIZE][MAPMAXSIZE]; //地图数据 int dis_map[MAPMAXSIZE][MAPMAXSIZE]; //保存搜索路径时,中间目标地最优解 int map_w,map_h; //地图宽和高 int start_x,start_y,end_x,end_y; //地点,终点坐标 // 初始化队列 void init_queue() { queue=(LINK)malloc(sizeof(*queue)); queue-node=NULL; queue-f=-1; queue-next=(LINK)malloc(sizeof(*queue)); queue-next-f=MAXINT; queue-next-node=NULL; queue-next-next=NULL; } // 待处理节点入队列, 依靠对目的地估价距离插入排序 void enter_queue(TREE node,int f) { LINK p=queue,father,q; while(fp-f) { father=p; p=p-next; assert(p); } q=(LINK)malloc(sizeof(*q)); assert(queue); q-f=f,q-node=node,q-next=p; father-next=q; } // 将离目的地估计最近的方案出队列 TREE get_from_queue() { TREE bestchoice=queue-next-node; LINK next=queue-next-next; free(queue-next); queue-next=next; stack[stacktop++]=bes