迷宫寻路算法(使用栈)

使用c#
思路:从起点出发,走0代表可达路径,并用数字2标记已走路径,死胡同就弹栈,直到终点

using System;
using System.Collections.Generic;
using System.Text;
using static System.Console;

namespace DataStructure
{
    public class Node//路径节点
    {
        public int x, y;
        public Node next;
        public Node (int x,int y)
        {
            this.x = x;
            this.y = y;
            this.next = null;
        }
    }


    public class TraceRecord//路径结构,使用栈
    {
        public Node first;
        public Node last;
        public bool IsEmpty()
        {
            return first == null;
        }

        public void insertNode(int x,int y)//入栈
        {
            Node node = new Node(x, y);
            if (this.IsEmpty())
            {
                first = node;
                last = node;
            }
            else
            {
                last.next = node;
                last = node;
            }
        }

        public void deleteNode()//出栈
        {
            if (this.IsEmpty())
            {
                WriteLine("队列已经空了");
                return;
            }
            Node tmp = first;
            while(tmp.next != last)
            {
                tmp = tmp.next;
            }
            tmp.next = last.next;
            last = tmp;
        }

    }


    class MazePathFinding
    {
        public static int ExitX = 8,ExitY = 10;
        public static int[,] MAZE = {//迷宫初始化
                  {1,1,1,1,1,1,1,1,1,1,1,1},	//声明迷宫数组
			      {1,0,0,0,1,1,1,1,1,1,1,1},
                  {1,1,1,0,1,1,0,0,0,0,1,1},
                  {1,1,1,0,1,1,0,1,1,0,1,1},
                  {1,1,1,0,0,0,0,1,1,0,1,1},
                  {1,1,1,0,1,1,0,1,1,0,1,1},
                  {1,1,1,0,1,1,0,1,1,0,1,1},
                  {1,1,1,1,1,1,0,1,1,0,1,1},
                  {1,1,0,0,0,0,0,0,1,0,0,1},
                  {1,1,1,1,1,1,1,1,1,1,1,1}
        };


        public static int checkExit(int x,int y,int exitX,int exitY)
        {
            if(x == exitX && y == exitY)//判断出口合法性,是否抵达终点
            {
                if(MAZE[x-1,y]==1 || MAZE[x,y-1] == 1 || MAZE[x , y+1] == 1 || MAZE[x + 1, y] == 2)
                {
                    return 1;
                }
                if (MAZE[x - 1, y] == 1 || MAZE[x, y - 1] == 1 || MAZE[x, y + 1] == 2 || MAZE[x + 1, y] == 1){
                    return 1;
                }
                if(MAZE[x - 1, y] == 1 || MAZE[x, y - 1] == 2 || MAZE[x, y + 1] == 1 || MAZE[x + 1, y] == 1)
                {
                    return 1;
                }
                if (MAZE[x - 1, y] == 2 || MAZE[x, y - 1] == 1 || MAZE[x, y + 1] == 1 || MAZE[x + 1, y] == 1)
                {
                    return 1;
                }
            }
            return 0;//不是终点
        }


        public static void startMazeMain()//启动函数
        {
            int i, j, x, y;
            TraceRecord path = new TraceRecord();//路径节点存储栈
            x = 1; y = 1;
            WriteLine("迷宫的路径(0标记的部分)");
            for (i = 0; i < 10; i++)//打印迷宫
            {
                for (j = 0; j < 12; j++)
                {
                    Write(MAZE[i, j]);
                }
                Write("\n");
            }
            while (x<=ExitX && y<=ExitY)//不满足终点的条件就一直循环
            {
                MAZE[x, y] = 2;
                if(MAZE[x-1,y] == 0)
                {
                    x -= 1;
                    path.insertNode(x, y);
                }
                else if (MAZE[x + 1, y] == 0)
                {
                    x += 1;
                    path.insertNode(x, y);
                }
                else if (MAZE[x, y - 1] == 0)
                {
                    y -= 1;
                    path.insertNode(x, y);
                }
                else if (MAZE[x, y + 1] == 0)
                {
                    y += 1;
                    path.insertNode(x, y);
                }
                else if(checkExit(x,y,ExitX,ExitY)==1)
                {
                    break;
                }
                else//死胡同就弹栈
                {
                    MAZE[x, y] = 2;
                    path.deleteNode();
                    x = path.last.x;
                    y = path.last.y;
                }
            }
            WriteLine("\n[老鼠走过的路径(2标记的部分)]");
            for (i = 0; i < 10; i++)//打印路径图
            {
                for (j = 0; j < 12; j++)
                {
                    Write(MAZE[i, j]);
                }
                WriteLine();
            }
            ReadKey();
        }
    }
}

  • 0
    点赞
  • 2
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
#include using std::cout; using std::cin; #include #include #include #define OVERFLOW -2 #define INIT_SIZE 100 //存储空间初始分配量 #define INCREMENT 10 //存储空间分配增量 typedef struct{ int r; int c; }PostType;//迷宫中r行c列的位置 typedef struct{ int ord; //当前位置在路径上的序号 PostType seat;//当前坐标 int di; //往下一坐标的方向 }SElemType; //元素类型 typedef struct{ SElemType* base;//基址,构造前销毁后为空 SElemType* top;//顶 int stackSize; //容量 }Stack; //类型 int InitStack(Stack &S){ //构造空s S.base=(SElemType*)malloc(INIT_SIZE *sizeof(SElemType)); if(!S.base) exit(OVERFLOW);//存储分配失败 S.top=S.base; S.stackSize=INIT_SIZE; return 0; } int StackEmpty(Stack S)//若s为空返回TRUE,否则返回FALSE { if(S.top==S.base) return 1; return 0; } int Push(Stack &S,SElemType e){ //插入元素e为新的顶元素 if(S.top-S.base >=S.stackSize){//满,加空间 S.base=(SElemType *)realloc(S.base,(S.stackSize+INCREMENT)*sizeof(SElemType)); if(!S.base) exit(OVERFLOW); //存储分配失败 S.top=S.base+S.stackSize; S.stackSize+=INCREMENT; } *S.top++=e; return 1; } int Pop(Stack &S,SElemType &e){//若不空删除,顶元素用e返回 if(S.top==S.base) return 0; e=*--S.top; return 1; } int DestroyStack(Stack &S){//销毁S, free(S.base); S.top=S.base; return 1; } #define MAXLEN 16//迷宫包括外墙最大行列数目 typedef struct{ int r; int c; char adr[MAXLEN][MAXLEN]; }MazeType; //迷宫类型 int InitMaze(MazeType &maze){ //初始化迷宫若成功返回TRUE,否则返回FALSE int i,j; cout<>maze.r>>maze.c; //迷宫行和列数 for(i=0;i<=maze.c+1;i++){//迷宫行外墙 maze.adr[0][i]='#'; maze.adr[maze.r+1][i]='#'; } for(i=0;i<=maze.r+1;i++){//迷宫列外墙 maze.adr[i][0]='#'; maze.adr[i][maze.c+1]='#'; } for(i=1;i<=maze.r;i++) for(j=1;j<=maze.c;j++) maze.adr[i][j]=' ';//初始化迷宫 int m=1,n=maze.c; for(m;m1;n--) maze.adr[6][n]='#'; maze.adr[4][5]='#'; maze.adr[4][6]='#'; maze.adr[3][3]='#'; maze.adr[3][2]='#'; maze.adr[5][7]='#'; maze.adr[5][6]='#'; maze.adr[8][3]='#'; maze.adr[7][2]='#'; maze.adr[7][5]='#'; return 1; }//InitMaze int Pass(MazeType maze,PostType curpos){ if(maze.adr[curpos.r][curpos.c]==' ') return 1; else return 0; }//Pass int FootPrint(MazeType &maze,PostType curpos){ //若走过并且可通返回TRUE,否则返回FALSE //在返回之前销毁S maze.adr[curpos.r][curpos.c]='!';//"*"表示可通 return 1; }//FootPrint PostType NextPos(PostType &curpos,int i){ //指示并返回下一位置的坐标 PostType cpos; cpos=curpos; switch(i){ case 1 : cpos.c+=1; break; case 2 : cpos.r+=1; break; case 3 : cpos.c-=1; break; case 4 : cpos.r-=1; break; default: exit(0); } return cpos; }//Nextpos int MarkPrint(MazeType &maze,PostType curpos){ maze.adr[curpos.r][curpos.c]='@';//"@"表示曾走过但不通 return 1; } int MazePath(MazeType &maze,PostType start,PostType end){ //若迷宫maze存在从入口start到end的通道则求得一条存放在中 Stack S; PostType curpos; int curstep;//当前序号,1.2.3.4分别表示东,南,西,北方向 SElemType e; InitStack(S); curpos=start; //设置"当前位置"为"入口位置" curstep=1; //探索第一步 do{ if(Pass(maze,curpos)){//当前位置可以通过,即是未曾走到过的通道 FootPrint(maze,curpos);//留下足迹 e.ord=curstep; e.seat=curpos; e.di=1; Push(S,e); //加入路径 if(curpos.r==end.r&& curpos.c==end.c) if(!DestroyStack(S))//销毁失败 exit(OVERFLOW); else return 1; //到达出口 else{ curpos=NextPos(curpos,1); //下一位置是当前位置的东邻 curstep++; //探索下一步 } } else{ //当前位置不通 if(!StackEmpty(S)){ Pop(S,e); while(e.di==4 && !StackEmpty(S)){ MarkPrint(maze,e.seat); Pop(S,e); //留下不能通过的标记,并退一步 } if(e.di < 4){ e.di++;//换下一个方向探索 Push(S,e); curpos=NextPos(e.seat,e.di);//设定当前位置是该新方向上的相邻位置 } } } }while(!StackEmpty(S)); if(!DestroyStack(S))//销毁失败 exit(OVERFLOW); else return 0; }//MazePath void PrintMaze(MazeType &maze){ //将标记路径信息的迷宫输出 int i,j; cout<<"\n——!为所求迷宫路线路线——:\n\n"; cout<<" "; for(i=0;i<=maze.r+1;i++)//打印列数名 cout<<" "<<i; cout<<"\n\n"; for(i=0;i<=maze.r+1;i++){ cout<<" "<<i;//打印行名 for(j=0;j<=maze.c+1;j++) cout<<" "<<maze.adr[i][j];//输出迷宫路径 cout<<"\n\n"; } } void main(){ MazeType maze; PostType start,end; char cmd; do{ cout<<"-------建立迷宫--------\n"; if(!InitMaze(maze)){ cout<<"\n——建立有误——!!!\n"; exit(OVERFLOW); } do{ cout<>start.r>>start.c; if(start.r>maze.r || start.c>maze.c){ cout<maze.r || start.c>maze.c); do{ cout<>end.r>>end.c; if(end.r>maze.r || end.c>maze.c){ cout<maze.r || end.c>maze.c); if(!MazePath(maze,start,end)) cout<<"\n不能求得路径!\n"; else PrintMaze(maze); cout<>cmd; }while(cmd=='y' || cmd=='Y'); }
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值