POJ1915-Knight Moves的启发式搜索（A*）算法

实际代价函数g(n)=31*step;

估计代价函数h(n)=当前点到终点的曼哈顿距离*10

#include<iostream>
#include<cstdio>
#include<cstring>
#include<cmath>
#include<algorithm>
#include<queue>
#include<stack>
using namespace std;
#define inf 0x3f3f3f3f
#define lc l,m,lc
#define rc m+1,r,rc
#define N 305
int dir[8][2]={1,2,1,-2,-1,2,-1,-2,2,1,2,-1,-2,1,-2,-1};
bool vis[N][N];
struct node
{
	int x,y,step;
	int g,h,f;
	friend bool operator<(const node &a,const node &b)
	{
		return a.f>b.f;
	}
}temp,f;
int n,sx,sy,dx,dy;
int jdz(int x)
{
	return x>0?x:-x;
}
int get_h(int x,int y)
{
	return ((jdz(x-dx)+jdz(y-dy)))*10;
}
void bfs()
{
	f.x=sx;
	f.y=sy;
	f.step=0;
	f.g=0;
	f.h=get_h(sx,sy);
	f.f=f.g+f.h;
	priority_queue<node>q;
	q.push(f);
	vis[sx][sy]=true;
	while(!q.empty())
	{
		f=q.top();q.pop();
		if(f.x==dx&&f.y==dy)
		{
			printf("%d\n",f.step);
			return;
		}
		int i;
		for(i=0;i<8;i++)
		{
			temp=f;
			temp.x+=dir[i][0];
			temp.y+=dir[i][1];
			temp.step++;
			if(temp.x>=0&&temp.x<n&&temp.y>=0&&temp.y<n&&!vis[temp.x][temp.y])
			{
				temp.g+=31;
				temp.h=get_h(temp.x,temp.y);
				temp.f=temp.g+temp.h;
				vis[temp.x][temp.y]=true;
				q.push(temp);
			}
		}
	}
}
int main()
{
	int t;
	scanf("%d",&t);
	while(t--)
	{
		memset(vis,false,sizeof vis);
		scanf("%d",&n);
		scanf("%d%d%d%d",&sx,&sy,&dx,&dy);
		bfs();
	}
	return 0;
}