UVA 1600 Patrol Robot bfs

題意：給出一個網格，這個網格中有一些障礙，求從左上角右下角的最短距離，且不能連續穿過K個障礙。

分析：求最短路徑嘛，首先想到的肯定會是bfs，那怎麼判斷連續K個障礙呢？因爲是連續的嘛，所以如果下一個要搜的點不是障礙，那麼它的k就是0了，然後因爲要考慮障礙點了，所以不能簡單地只記錄已經掃過的點了，還要排除k值得影響，所以我這裏加了一個K的數組來表示當前點的k值大小，如果要搜的點的k值比記錄的小那麼即使已經掃過也可以繼續放入隊列中。但我這裏寫的太噁心了。。。自己都有點嫌棄了。。如果有耐心的話可以自己再將細節優化一下。。畢竟有點長。。。

代碼：

#include<iostream>
#include<cstdio>
#include<cstring>
#include<algorithm>
#include<queue>
using namespace std;
#define INF 0x3f3f3f3f
const int maxed=22;
struct Node
{
    int x,y,cur,k;
};
int k,r,c,p[maxed][maxed],min_,sum[maxed][maxed];//這裏的sum數組就是用來記錄k值得，不斷更新它的值就好了
bool vis[maxed][maxed];
int main()
{
    //freopen("123.txt","w",stdout);
    void slove();
    int N;
    scanf("%d",&N);
    while(N--){
        min_=-1;
        scanf("%d%d%d",&r,&c,&k);
        memset(vis,false,sizeof(vis));
        memset(sum,INF,sizeof(sum));
        for(int i=1;i<=r;i++)
            for(int j=1;j<=c;j++)
                scanf("%d",&p[i][j]);
        vis[1][1]=true;
        slove();
//        cout<<"sdasda"<<endl;
//        for(int i=1;i<=r;i++){
//            for(int j=1;j<=c;j++)
//                cout<<vis[i][j]<<" ";
//            cout<<endl;
//        }
//        cout<<"sdadsadsadsa"<<endl;
        printf("%d\n",min_);
    }
    return 0;
}
void slove()
{
    Node n;
    n.x=1,n.y=1,n.cur=0,n.k=0;
    queue<Node> qu;
    qu.push(n);
    while(!(qu.empty())){
        Node no;
        n=qu.front();qu.pop();
        //cout<<n.x<<" "<<n.y<<" "<<n.cur<<" "<<n.k<<endl;
        if(n.k>k)
            continue;
        if(n.x==r&&n.y==c){
            min_=n.cur;
            break;
        }
        no.cur=n.cur+1;                      //接下來就是讓他向上下左右走，這裏其實可以用兩個dx，dy數組來進行方位的轉換。。可以節省很多代碼。。但。。。當時比較噁心。。就直接這麼寫的了。
        if(n.x+1<=r&&n.y<=c&&n.y>=1){
                no.x=n.x+1;no.y=n.y;
                if(p[n.x+1][n.y])
                    no.k=n.k+1;
                else
                    no.k=0;
                if(!vis[n.x+1][n.y]||no.k<sum[n.x+1][n.y]){
                    vis[n.x+1][n.y]=true;
                    qu.push(no);
                    sum[n.x+1][n.y]=min(sum[n.x+1][n.y],no.k);
                }
        }
        if(n.x-1>=1&&n.y<=c&&n.y>=1){
                no.x=n.x-1;no.y=n.y;
                if(p[n.x-1][n.y])
                    no.k=n.k+1;
                else
                    no.k=0;
                if(!vis[n.x-1][n.y]||no.k<sum[n.x-1][n.y]){
                    vis[n.x-1][n.y]=true;
                    qu.push(no);
                    sum[n.x-1][n.y]=min(sum[n.x-1][n.y],no.k);
                }
        }
        if(n.y+1<=c&&n.x>=1&&n.x<=r){
                //cout<<"qqqqqqqqqqqqqqqqqqqqq"<<endl;
                no.x=n.x;no.y=n.y+1;
                if(p[n.x][n.y+1])
                    no.k=n.k+1;
                else
                    no.k=0;
                if(!vis[n.x][n.y+1]||no.k<sum[n.x][n.y+1]){
                    vis[n.x][n.y+1]=true;
                    qu.push(no);
                    sum[n.x][n.y+1]=min(sum[n.x][n.y+1],no.k);
                }
        }
        if(n.y-1>=1&&n.x>=1&&n.x<=r){
            no.x=n.x;no.y=n.y-1;
            if(p[n.x][n.y-1])
                no.k=n.k+1;
            else
                no.k=0;
            if(!vis[n.x][n.y-1]||no.k<sum[n.x][n.y-1]){
                vis[n.x][n.y-1]=true;
                qu.push(no);
                sum[n.x][n.y-1]=min(sum[n.x][n.y-1],no.k);
            }
        }
    }
}