贪吃蛇的自动寻路算法 -BFS

public wall way_finding()//寻路
        {
            List<wall> wo = new List<wall>();#创建一个List来存所有走过的路
            
            int[,] FindMap = new int[40, 40];//创建一个地图判断走过的路，防止重复走
            for (int i = 0; i < Listarr.Count; i++)
            {
                FindMap[Listarr.ElementAt(i).x, Listarr[i].y] = 1;//将蛇的位置地图赋值为1
            }
            wall Head = new wall();
            Head.x = Listarr[Listarr.Count - 1].x;
            Head.y = Listarr[Listarr.Count - 1].y;
            
            wo.Add(new wall(Head));//把蛇的位置加进去 算出从蛇头到果子的位置
            for (int i = 0; i < wo.Count; i++)
            {
                wall W = wo.ElementAt(i);//获得位置
                int A = i;
                if (W.x != 38 && FindMap[W.x + 1, W.y] == 0)//判断是否越界和当前位置是否走过
                {
                    FindMap[W.x + 1, W.y] = 1;//将地图位置赋值1
                    wall NewAI = new wall(W);//创建新的路线
                    NewAI.x = W.x + 1;//更改位置
                    NewAI.A.Add(3);//添加路线
                    wo.Add(NewAI);//加入List
                    

                }
                if (W.x != 1 && FindMap[W.x - 1, W.y] == 0)
                {
                    FindMap[W.x - 1, W.y] = 1;
                    wall NewAI = new wall(W);
                    NewAI.x = W.x - 1;
                    NewAI.A.Add(2);
                    wo.Add(NewAI);
                   
                }
                if (W.y != 38 && FindMap[W.x, W.y + 1] == 0)
                {
                    FindMap[W.x, W.y + 1] = 1;
                    wall NewAI = new wall(W);
                    NewAI.y = W.y + 1;
                    NewAI.A.Add(1);
                    wo.Add(NewAI);
                    
                }
                if (W.y != 1 && FindMap[W.x, W.y - 1] == 0)
                {
                    FindMap[W.x, W.y - 1] = 1;
                    wall NewAI = new wall(W);
                    NewAI.y = W.y - 1;
                    NewAI.A.Add(0);
                    wo.Add(NewAI);
                    
                }
                for (int z = A; z < wo.Count; z++)
                {   
                    if (wo.ElementAt(z) == location) return wo.ElementAt(z);//判断是否找到位置
                }
            }

            if (wo.Count > 5)//蛇有时会绕成环  让蛇走一段路 再次调用该函数
                return wo.ElementAt(wo.Count / 2);
            else
            {
                GameOver();//无路可走 执行死亡程序
                return null;
            }
        }