C++算法 广搜

a1[5]={0,0,1,-1};//控制4面移动的数组，不明白的话可以画个图，算算坐标。
a2[5]={1,-1,0,0};
void bfs()
{
    t=0;//t,w分别代表队列的头和尾。
    w=0;
    ma[t].x=开始的x;//ma是这个队列。其实用queue也可以
    ma[t].y=开始的y;//ma的大小要和矩阵的大小一致，因为有可能全部相连。
    t++;//2种情况，到达终点和不可能到达终点。
　　while(w<t)//在队列有元素的时候运行，没有元素代表所有和起点联通的位置都被标记。
    {
        if(到达目标)//因为目标会随着题目的变换而变换，所以写个伪代码也不过分。
        {
            结束 
        } 
        for(int i=0;i<4;i++)
        {
            zx=ma[w].x+a1[i];
            zy=ma[w].y+a2[i];//计算出移动后的位置。
            if(zx<=n&&zx>0&&zy<=n&&zy>0&&a[zx][zy]==0)//判断是否出局和有没有来过。
            {
                a[zx][zy]=3;//标记
                ma[t].x=zx;//继续插入队列
                ma[t].y=zy;
                t++;
            }   
        }
        w++;//查看队列中的下一个。
    }
}