http://www.java3z.com/cwbwebhome/article/article2/2825.html
理解A*
#include<stdio.h>
#include<string.h>
#include<string>
#include<algorithm>
#include<iostream>
#include<set>
#include<map>
#include<queue>
#include<stack>
#include<vector>
#include<math.h>
#include<stdlib.h>
#define M 400000
using namespace std;
struct stu
{
char s[20];
int pos,g,h;
bool operator<(const stu& s0)const
{
return g+h>s0.g+s0.h;//每次取f=g+h较小的
}
}st,ed,dl[M];
struct pa
{
int fa;
char c;
}path[M];//将path信息不放在dl一起,可以减少输出时间
int mark[M];
int jc[12];
int h[4]={-1,0,1,0};
int z[4]={0,1,0,-1};
char fa[]={"urdl"},pstr[M];
void getjc()//阶乘
{
int i,j,k;
jc[0]=1;
for(i=1;i<12;i++)
jc[i]=jc[i-1]*i;
}
int getkt(char s[20])//康托展开
{
int i,j,k,len,an[20],ans=0;
len=strlen(s);
memset(an,0,sizeof(an));
for(i=0;i<len;i++)//获得当前未出现的比他小的数,即它右边有几个比他小的数
for(j=0;j<i;j++)
{
if(s[j]>s[i])
an[j]++;
}
for(i=0;i<len;i++)//康托公式运算
{
ans+=an[i]*jc[len-i-1];
}
return ans;
}
int judge(int x,int y)
{
return (x>=0&&x<3&&y>=0&&y<3);
}
int geth(char *s)//取得h,为当前位置与目标位置的manhattan距离
{
int i,j,h=0,x,y,x1,y1;
for(i=0;i<9;i++)
{
if(s[i]!='0')
{
x=i/3;
y=i%3;
x1=(s[i]-'0'-1)/3;
y1=(s[i]-'0'-1)%3;
h+=abs(x-x1)+abs(y-y1);
}
}
return h;
}
int Astar()
{
int i,j,k,x,y,t;
char s[20],c;
memset(mark,0,sizeof(mark));
priority_queue<stu>pq;
k=getkt(st.s);//初始化起始状态
mark[k]=1;
path[k].fa=k;
st.g=0;
st.h=geth(st.s);
pq.push(st);
dl[k]=st;
while(!pq.empty())
{
stu tp=pq.top();
pq.pop();
k=getkt(tp.s);
if(k==ed.pos)
return k;
for(i=0;i<4;i++)
{
stu nw;
strcpy(nw.s,tp.s);
int p=tp.pos;
x=p/3;
y=p%3;
x=x+h[i];
y=y+z[i];
if(judge(x,y))
{
t=x*3+y;
c=nw.s[p];
nw.s[p]=nw.s[t];
nw.s[t]=c;
nw.pos=t;
t=getkt(nw.s);
if(mark[t]==0||dl[t].g>dl[k].g+1)//对于已经访问过的点,如果可从当前位置到达,并且深度较优,也要更新 {
nw.g=dl[k].g+1;
nw.h=geth(nw.s);
dl[t]=nw;
pq.push(nw);
path[t].fa=k;
path[t].c=fa[i];
mark[t]=1;
}
}
}
}
return -1;
}
int main()
{
int i,j,k;
char c;
getjc();
for(i=0;i<9; )//读取字符串
{
scanf("%c",&c);
if(c == 'x')
{
st.s[i]='0';
st.pos=i;
i++;
}
else if(c>='0'&&c<='9')
{
st.s[i] = c;
i++;
}
else
continue;
}
st.s[9]='\0';
strcpy(ed.s,"123456780");
ed.pos=getkt(ed.s);
int ans=Astar();
if(ans==-1)
{
puts("unsolvable");
}
else//输出路径
{
i=0;
while(ans!=path[ans].fa)
{
pstr[i++]=path[ans].c;
ans=path[ans].fa;
}
pstr[i]='\0';
reverse(pstr,pstr+i);
puts(pstr);
}
return 0;
}
/*
23415x768
*/