求助 类BFS

#include<bits/stdc++.h>
using namespace std;
int n,m,sx,sy,ex,ey,ans[10001][10001];
char a[10001][10001],kD[4][2]={{-1,0},{1,0},{0,1},(0,-1)};
vector<pair<int,int> > q[1000001];
int main(){
    cin>>n>>m>>sx>>sy>>ex>>ey;
    for(int i=1;i<=n;i++){
        for(int j=1;j<=m;j++){
                cin>>a[i][j];       
        }
    }
    fill(ans[0],ans[n+1],-1);
    q[0].push_back({sx,sy});
    for(int i=0;q[i].size();i++){
        for(int j=0;j<q[i].size();j++){
            auto p=q[i][j];
            if(a[p.first][p.second]=='.'&&p.first<=n&&
            p.second<=m&&p.second>=1&&p.first>=1&&ans[p.first][p.second]==-1){
                ans[p.first][p.second]=i;
                for(int d=0;d<4;d++){
                    q[i].push_back({p.first+kD[d][0],p.second+kD[d][1]});
                }
                for(int dx=-2;dx<=2;dx++){
                    for(int dy=-2;dy<=2;dy++){
                        q[i+1].push_back({p.first+dx,p.second+dy});
                    }
                }
            }
        }
    }
    cout<<ans[ex][ey];
}