7-2 最短路径

在n*n的方格中找出从起点到终点的最短路径。

提示：每个节点的状态为该节点在地图中的坐标。每个节点扩展时最多有上下左右四个孩子节点。当扩展的节点为目标节点的作标时，遍历结束，最优解即为该节点在这个解空间树中的深度

输入格式:

第一行一个数字n
后面n行为方格地图，s表示起点，e表示终点，*表示可以通过，#表示不能通过

输出格式:

一个数字，表示最短路径。如果没有通路，输出-1

输入样例:

6
*s#***
****#*
*###**
*#****
*#*#*e
***#**

输出样例:

在这里给出相应的输出。例如：

10

代码：

#include <iostream>
#include <queue>
#include <algorithm>
using namespace std;


const int MAX = 100;
int n;
char g[MAX][MAX];
int bestr;

struct coo{
	int x;
	int y;
};
struct Node{
    coo p;
    int level;
    coo part[MAX];
};
Node Start;
Node End;
queue <Node> q;
bool judge(int x1,int y1,int len,coo part[]){
    for(int i = 0; i < len; i++){
        if(part[i].x == x1 && part[i].y == y1){
            return false;
        }
    }
    return true;
}
void bfs(){
    q.push(Start);

    while(!q.empty()){
        Node node = q.front();
        q.pop();
//cout<<node.p.x<<" "<<node.p.y<<" "<<node.level<<" bset:"<<bestr<<endl;
        if(node.p.x==End.p.x&&node.p.y==End.p.y){
            if(node.level<bestr){
                bestr = node.level;
            }
                break;
        }
        if(node.p.x>1&&g[node.p.x-1][node.p.y] == '*'&&judge(node.p.x-1, node.p.y, node.level, node.part)){
            Node next;
            next.p.x = node.p.x-1;
            next.p.y = node.p.y;
            for(int i = 1; i <= node.level; i++){
				next.part[i] = node.part[i];
			}
            next.level = node.level + 1;
            next.part[next.level] = next.p;
            q.push(next);
        }
        if(node.p.y>1&&g[node.p.x][node.p.y-1] == '*'&&judge(node.p.x, node.p.y-1, node.level, node.part)){
            Node next;
            next.p.x = node.p.x;
            next.p.y = node.p.y-1;
            for(int i = 1; i <= node.level; i++){
				next.part[i] = node.part[i];
			}
            next.level = node.level + 1;
            next.part[next.level] = next.p;
            q.push(next);
        }
        if(node.p.x<n&&g[node.p.x+1][node.p.y] == '*'&&judge(node.p.x+11, node.p.y, node.level, node.part)){
            Node next;
            next.p.x = node.p.x+1;
            next.p.y = node.p.y;
            for(int i = 1; i <= node.level; i++){
				next.part[i] = node.part[i];
			}
            next.level = node.level + 1;
            next.part[next.level] = next.p;
            q.push(next);
        }
        if(node.p.y<n&&g[node.p.x][node.p.y+1] == '*'&&judge(node.p.x, node.p.y+1, node.level, node.part)){
            Node next;
            next.p.x = node.p.x;
            next.p.y = node.p.y+1;
            for(int i = 1; i <= node.level; i++){
				next.part[i] = node.part[i];
			}
            next.level = node.level + 1;
            next.part[next.level] = next.p;
            q.push(next);
        }
    }
}

int main(){

    cin >> n;
    for(int i = 1; i <= n; i++){
        char ch;
            cin.get(ch);
        for(int j = 1; j <= n; j++){
            cin.get(ch);
            g[i][j] = ch;
            if(ch=='s'){
                Start.p.x = i;
                Start.p.y = j;
                Start.level = 0;
                Start.part[Start.level] = Start.p;
            }
            else if(ch=='e'){
                End.p.x = i;
                End.p.y = j;
                g[i][j] = '*';
            }
        }
        
    }
    bestr = 0x3f3f;
    bfs();
    if(bestr == 0x3f3f)
        cout << -1 << endl;
    else
        cout << bestr << endl; 

return 0;
}

试着用了自己比较好理解但有点麻烦的方法解决