diff options
Diffstat (limited to 'src/map/path.c')
-rw-r--r-- | src/map/path.c | 261 |
1 files changed, 103 insertions, 158 deletions
diff --git a/src/map/path.c b/src/map/path.c index da96433ad..52c34756a 100644 --- a/src/map/path.c +++ b/src/map/path.c @@ -32,120 +32,118 @@ const char walk_choices [3][3] = }; /*========================================== - * 経路探索補助heap push + * heap push (helper function) *------------------------------------------*/ static void push_heap_path(int *heap,struct tmp_path *tp,int index) { int i,h; + h = heap[0]; heap[0]++; - for(h=heap[0]-1,i=(h-1)/2; - h>0 && tp[index].cost<tp[heap[i+1]].cost; - i=(h-1)/2) - heap[h+1]=heap[i+1],h=i; - heap[h+1]=index; + for( i = (h-1)/2; h > 0 && tp[index].cost < tp[heap[i+1]].cost; i = (h-1)/2 ) + heap[h+1] = heap[i+1], h = i; + + heap[h+1] = index; } /*========================================== - * 経路探索補助heap update + * heap update (helper function) * costが減ったので根の方へ移動 *------------------------------------------*/ static void update_heap_path(int *heap,struct tmp_path *tp,int index) { int i,h; - for(h=0;h<heap[0];h++) - if(heap[h+1]==index) - break; - if(h==heap[0]){ + ARR_FIND( 0, heap[0], h, heap[h+1] == index ); + if( h == heap[0] ) + { ShowError("update_heap_path bug\n"); exit(1); } - for(i=(h-1)/2; - h>0 && tp[index].cost<tp[heap[i+1]].cost; - i=(h-1)/2) - heap[h+1]=heap[i+1],h=i; - heap[h+1]=index; + + for( i = (h-1)/2; h > 0 && tp[index].cost < tp[heap[i+1]].cost; i = (h-1)/2 ) + heap[h+1] = heap[i+1], h = i; + + heap[h+1] = index; } /*========================================== - * 経路探索補助heap pop + * heap pop (helper function) *------------------------------------------*/ static int pop_heap_path(int *heap,struct tmp_path *tp) { int i,h,k; int ret,last; - if(heap[0]<=0) + if( heap[0] <= 0 ) return -1; - ret=heap[1]; - last=heap[heap[0]]; + ret = heap[1]; + last = heap[heap[0]]; heap[0]--; - for(h=0,k=2;k<heap[0];k=k*2+2){ - if(tp[heap[k+1]].cost>tp[heap[k]].cost) + for( h = 0, k = 2; k < heap[0]; k = k*2+2 ) + { + if( tp[heap[k+1]].cost > tp[heap[k]].cost ) k--; - heap[h+1]=heap[k+1], h=k; + heap[h+1] = heap[k+1], h = k; } - if(k==heap[0]) - heap[h+1]=heap[k], h=k-1; - for(i=(h-1)/2; - h>0 && tp[heap[i+1]].cost>tp[last].cost; - i=(h-1)/2) - heap[h+1]=heap[i+1],h=i; + if( k == heap[0] ) + heap[h+1] = heap[k], h = k-1; + + for( i = (h-1)/2; h > 0 && tp[heap[i+1]].cost > tp[last].cost; i = (h-1)/2 ) + heap[h+1] = heap[i+1], h = i; + heap[h+1]=last; return ret; } /*========================================== - * 現在の点のcost計算 + * calculate cost for the specified position *------------------------------------------*/ static int calc_cost(struct tmp_path *p,int x1,int y1) { - int xd,yd; - - xd=x1-p->x; - if(xd<0) xd=-xd; - yd=y1-p->y; - if(yd<0) yd=-yd; - return (xd+yd)*10+p->dist; + int xd = abs(x1 - p->x); + int yd = abs(y1 - p->y); + return (xd + yd)*10 + p->dist; } /*========================================== - * 必要ならpathを追加/修正する + * attach/adjust path if neccessary *------------------------------------------*/ static int add_path(int *heap,struct tmp_path *tp,int x,int y,int dist,int before,int cost) { int i; - i=calc_index(x,y); + i = calc_index(x,y); - if(tp[i].x==x && tp[i].y==y){ - if(tp[i].dist>dist){ - tp[i].dist=dist; - tp[i].before=before; - tp[i].cost=cost; - if(tp[i].flag) + if( tp[i].x == x && tp[i].y == y ) + { + if( tp[i].dist > dist ) + { + tp[i].dist = dist; + tp[i].before = before; + tp[i].cost = cost; + if( tp[i].flag ) push_heap_path(heap,tp,i); else update_heap_path(heap,tp,i); - tp[i].flag=0; + tp[i].flag = 0; } return 0; } - if(tp[i].x || tp[i].y) + if( tp[i].x || tp[i].y ) return 1; - tp[i].x=x; - tp[i].y=y; - tp[i].dist=dist; - tp[i].before=before; - tp[i].cost=cost; - tp[i].flag=0; + tp[i].x = x; + tp[i].y = y; + tp[i].dist = dist; + tp[i].before = before; + tp[i].cost = cost; + tp[i].flag = 0; push_heap_path(heap,tp,i); return 0; @@ -153,42 +151,44 @@ static int add_path(int *heap,struct tmp_path *tp,int x,int y,int dist,int befor /*========================================== - * (x,y)が移動不可能地帯かどうか - * flag 0x10000 遠距離攻撃判定 + * is (x,y) passable? + * flag: 0x10000 = ranged attack check + * 0x30000 = stacking check *------------------------------------------*/ static int can_place(struct map_data *m,int x,int y,int flag) { - if(map_getcellp(m,x,y,CELL_CHKPASS)) + if( map_getcellp(m,x,y,CELL_CHKPASS) ) return 1; - if((flag&0x10000)&&map_getcellp(m,x,y,CELL_CHKGROUND)) + if( (flag&0x10000)&&map_getcellp(m,x,y,CELL_CHKGROUND) ) return 1; #ifdef CELL_NOSTACK //Special flag for CELL_NOSTACK systems. Returns true when the given cell is stacked. [Skotlex] - if((flag&0x30000)&&map_getcellp(m,x,y,CELL_CHKSTACK)) + if( (flag&0x30000)&&map_getcellp(m,x,y,CELL_CHKSTACK) ) return 1; #endif return 0; } /*========================================== - * (x0,y0)から(x1,y1)へ1歩で移動可能か計算 + * can you move from (x0,y0) to (x1,y1) in one step? + * (helper function for path_blownpos()) *------------------------------------------*/ static int can_move(struct map_data *m,int x0,int y0,int x1,int y1,int flag) { - if(x1<0 || y1<0 || x1>=m->xs || y1>=m->ys) - return 0; - if(flag&0x20000) //Flag to ignore everything, for use with Taekwon's Jump skill currently. [Skotlex] + if( x1 < 0 || y1 < 0 || x1 >= m->xs || y1 >= m->ys) + return 0; // out-of-bounds coordinates + if( flag&0x20000 ) //Flag to ignore everything, for use with Taekwon's Jump skill currently. [Skotlex] return 1; #ifndef CELL_NOSTACK //In no-stack mode, do not check current cell. - if(!can_place(m,x0,y0,flag)) + if( !can_place(m,x0,y0,flag) ) return 0; #endif - if(!can_place(m,x1,y1,flag)) + if( !can_place(m,x1,y1,flag) ) return 0; - if(x0==x1 || y0==y1) + if( x0 == x1 || y0 == y1 ) return 1; - if(!can_place(m,x0,y1,flag) || !can_place(m,x1,y0,flag)) + if( !can_place(m,x0,y1,flag) || !can_place(m,x1,y0,flag) ) return 0; return 1; } @@ -201,23 +201,24 @@ int path_blownpos(int m,int x0,int y0,int dx,int dy,int count) { struct map_data *md; - if(!map[m].gat) + if( !map[m].gat ) return -1; - md=&map[m]; + md = &map[m]; - if(count>25){ //Cap to prevent too much processing...? - if(battle_config.error_log) + if( count>25 ){ //Cap to prevent too much processing...? + if( battle_config.error_log ) ShowWarning("path_blownpos: count too many %d !\n",count); count=25; } - if(dx>1 || dx<-1 || dy>1 || dy<-1){ - if(battle_config.error_log) + if( dx > 1 || dx < -1 || dy > 1 || dy < -1 ){ + if( battle_config.error_log ) ShowError("path_blownpos: illeagal dx=%d or dy=%d !\n",dx,dy); - dx=(dx>=0)?1:((dx<0)?-1:0); - dy=(dy>=0)?1:((dy<0)?-1:0); + dx=(dx>0)?1:((dx<0)?-1:0); + dy=(dy>0)?1:((dy<0)?-1:0); } - while( (count--)>0 && (dx || dy) ){ + while( (count--)>0 && (dx || dy) ) + { if( !can_move(md,x0,y0,x0+dx,y0+dy,0) ){ int fx=(dx!=0 && can_move(md,x0,y0,x0+dx,y0,0)); int fy=(dy!=0 && can_move(md,x0,y0,x0,y0+dy,0)); @@ -235,9 +236,9 @@ int path_blownpos(int m,int x0,int y0,int dx,int dy,int count) } /*========================================== - * 遠距離攻撃が可能かどうかを返す + * is ranged attack from (x0,y0) to (x1,y1) possible? *------------------------------------------*/ -int path_search_long_real(struct shootpath_data *spd,int m,int x0,int y0,int x1,int y1,cell_t flag) +bool path_search_long_real(struct shootpath_data *spd,int m,int x0,int y0,int x1,int y1,cell_t flag) { int dx, dy; int wx = 0, wy = 0; @@ -245,7 +246,7 @@ int path_search_long_real(struct shootpath_data *spd,int m,int x0,int y0,int x1, struct map_data *md; if (!map[m].gat) - return 0; + return false; md = &map[m]; dx = (x1 - x0); @@ -264,7 +265,7 @@ int path_search_long_real(struct shootpath_data *spd,int m,int x0,int y0,int x1, } if (map_getcellp(md,x1,y1,flag)) - return 0; + return false; if (dx > abs(dy)) { weight = dx; @@ -278,7 +279,7 @@ int path_search_long_real(struct shootpath_data *spd,int m,int x0,int y0,int x1, while (x0 != x1 || y0 != y1) { if (map_getcellp(md,x0,y0,flag)) - return 0; + return false; wx += dx; wy += dy; if (wx >= weight) { @@ -299,11 +300,12 @@ int path_search_long_real(struct shootpath_data *spd,int m,int x0,int y0,int x1, } } - return 1; + return true; } /*========================================== - * path探索 (x0,y0)->(x1,y1) + * path search (x0,y0)->(x1,y1) + * flag: &1 = easy path search only *------------------------------------------*/ int path_search_real(struct walkpath_data *wpd,int m,int x0,int y0,int x1,int y1,int flag,cell_t flag2) { @@ -315,56 +317,49 @@ int path_search_real(struct walkpath_data *wpd,int m,int x0,int y0,int x1,int y1 nullpo_retr(0, wpd); - if(!map[m].gat) + if( !map[m].gat ) return -1; - md=&map[m]; + md = &map[m]; #ifdef CELL_NOSTACK //Do not check starting cell as that would get you stuck. - if(x0<0 || x0>=md->xs || y0<0 || y0>=md->ys) + if( x0 < 0 || x0 >= md->xs || y0 < 0 || y0 >= md->ys ) #else - if(x0<0 || x0>=md->xs || y0<0 || y0>=md->ys || map_getcellp(md,x0,y0,flag2)) + if( x0 < 0 || x0 >= md->xs || y0 < 0 || y0 >= md->ys || map_getcellp(md,x0,y0,flag2) ) #endif return -1; - if(x1<0 || x1>=md->xs || y1<0 || y1>=md->ys || map_getcellp(md,x1,y1,flag2)) + if( x1 < 0 || x1 >= md->xs || y1 < 0 || y1 >= md->ys || map_getcellp(md,x1,y1,flag2) ) return -1; - // easy and better [Meruru] + // calculate (sgn(x1-x0), sgn(y1-y0)) dx = ((dx = x1-x0)) ? ((dx<0) ? -1 : 1) : 0; dy = ((dy = y1-y0)) ? ((dy<0) ? -1 : 1) : 0; - //Better faster stronger simple path algo. [Meruru] - for(x=x0,y=y0,i=0;i < sizeof(wpd->path);) + // try finding direct path to target + for( x = x0, y = y0, i = 0; i < ARRAYLENGTH(wpd->path); ) { wpd->path[i++] = walk_choices[-dy + 1][dx + 1]; x += dx; y += dy; - if(x == x1) dx = 0; - if(y == y1) dy = 0; + if( x == x1 ) dx = 0; + if( y == y1 ) dy = 0; - if((!dx && !dy) || map_getcellp(md,x,y,flag2)) - break; + if( !dx && !dy ) + break; // success + if( map_getcellp(md,x,y,flag2) ) + break; // obstacle = failure } - /* - You may be thinking what about diagonal - moves? Can't they cause a error with this somehow? - Answer is NO! The only time this can cause a error - is if the target block lies on the diagonal and - is non walkable. But rember we already checked that - up above! So no problems here... I think [Meruru] - */ - - if (x==x1 && y==y1) + if( x == x1 && y == y1 ) { //easy path successful. - wpd->path_len=i; - wpd->path_pos=0; - wpd->path_half=0; + wpd->path_len = i; + wpd->path_pos = 0; + wpd->path_half = 0; return 0; } - if(flag&1) + if( flag&1 ) return -1; memset(tp,0,sizeof(tp)); @@ -471,53 +466,3 @@ int path_search_real(struct walkpath_data *wpd,int m,int x0,int y0,int x1,int y1 } return -1; } - -/*========================================== - * path探索 (x0,y0)->(x1,y1) - *------------------------------------------*/ - -#ifdef PATH_STANDALONETEST -char gat[64][64]={ - {0,0,0,0,0,0,0,0,0,0}, - {0,0,0,0,0,0,0,0,0,0}, - {0,0,0,0,0,0,0,0,0,0}, - {0,0,0,0,0,0,0,0,0,0}, - {0,0,0,0,1,0,0,0,0,0}, -}; -struct map_data map[1]; - -/*========================================== - * 経路探索ルーチン単体テスト用main関数 - *------------------------------------------*/ -void main(int argc,char *argv[]) -{ - struct walkpath_data wpd; - - map[0].gat=gat; - map[0].xs=64; - map[0].ys=64; - - path_search(&wpd,0,3,4,5,4); - path_search(&wpd,0,5,4,3,4); - path_search(&wpd,0,6,4,3,4); - path_search(&wpd,0,7,4,3,4); - path_search(&wpd,0,4,3,4,5); - path_search(&wpd,0,4,2,4,5); - path_search(&wpd,0,4,1,4,5); - path_search(&wpd,0,4,5,4,3); - path_search(&wpd,0,4,6,4,3); - path_search(&wpd,0,4,7,4,3); - path_search(&wpd,0,7,4,3,4); - path_search(&wpd,0,8,4,3,4); - path_search(&wpd,0,9,4,3,4); - path_search(&wpd,0,10,4,3,4); - path_search(&wpd,0,11,4,3,4); - path_search(&wpd,0,12,4,3,4); - path_search(&wpd,0,13,4,3,4); - path_search(&wpd,0,14,4,3,4); - path_search(&wpd,0,15,4,3,4); - path_search(&wpd,0,16,4,3,4); - path_search(&wpd,0,17,4,3,4); - path_search(&wpd,0,18,4,3,4); -} -#endif |