深度寻路(迷宫找出口)数组栈和堆栈两种方法实现

数组栈实现

#include <stdio.h>
#include <stdlib.h>
#define CRT_SECURE_NO_WARINGS
#pragma warning(disable:6011)
#pragma warning(disable:6386)
/*
0 0 1 1 1
1 0 0 1 1
1 1 0 0 1
1 0 0 1 1
1 1 0 0 0
1 1 1 1 1 1 1 1 1 1
1 0 1 0 1 1 0 1 0 1 
1 0 1 0 1 1 0 1 0 1 
1 0 1 0 1 1 0 1 0 1 
1 0 0 0 1 1 0 0 0 1 
1 0 1 0 1 1 0 1 1 1
1 0 1 0 1 1 0 1 1 1 
1 0 1 0 1 1 0 1 1 1 
1 0 0 0 0 0 0 0 0 1 
1 1 1 1 1 1 1 1 1 1 
迷宫形式*/
struct  position
{
	int x;
	int y;
};
struct position pathstack[100];
int stackTop = -1;
int size = 0;
int** maze = NULL;
int** makearray(int row,int cols)
{
	int** array = (int**)malloc(sizeof(int*) * row);
	for (int i = 0; i < row; i++)
	{
		array[i] = (int*)malloc(sizeof(int) * cols);
	}
	return array;
}
void creatmap()
{
	printf("请输入迷宫的大小:\n");
	scanf_s("%d", &size);
	maze = makearray(size+2,size+2);
	printf("请输入迷宫:\n");
	for (int i = 1; i <= size; i++)
	{
		for (int j = 1; j <= size; j++)
		{
			scanf_s("%d", &maze[i][j]);
		}
	}
	//加边框;
	for (int i = 0; i <= size + 1; i++)
	{
		maze[0][i] = maze[size + 1][i] = 1;
		maze[i][0] = maze[i][size + 1] = 1;
	}
	
}
//findroad找路径;
int findpath()
{
	struct position offset[4];// = { {0,1},{1,0},{0,-1},{-1,0} };
	offset[0].x = 0;
	offset[0].y = 1;
	offset[1].x = 1;
	offset[1].y = 0;
	offset[2].x = 0;
	offset[2].y = -1;
	offset[3].x = -1;
	offset[3].y = 0;
	struct position here = { 1,1 };
	pathstack[++stackTop] = here;
	maze[1][1] = 1;
	int option = 0;
	int endoption = 3;
	
while (here.x != size || here.y != size)
{
	int rownum, colsnum;
	while (option <= endoption)
	{
		rownum = here.x + offset[option].x;
		colsnum = here.y + offset[option].y;
		if (maze[rownum][colsnum] == 0)
			break;
		option++;
	}
	if (option <= endoption)
	{
		
		here.x = rownum;
		here.y = colsnum;
		pathstack[++stackTop] = here;
		maze[rownum][colsnum] = 1;
		option = 0;
		}
	else //说明option=4;找不到路了,进行退栈操作;
	{
		if (stackTop == -1)
			return 0;
		stackTop--;
		struct position pre= pathstack[stackTop];//
	
		if (pre.x == here.x)
		{
			option = 2 + pre.y - here.y;
		}
		else 
		{
			option = 3 + pre.x-here.x;
		}
		here = pre;
	}
}
return 1;
}
void printfpath()
{
	struct position curpos;
	while (stackTop != -1)
	{
		curpos=pathstack[stackTop];
#pragma message("666")
		stackTop--;
		printf("(%d,%d)-->", curpos.x, curpos.y);
	}printf("\n");
}
int main()
{
	creatmap();
	if(findpath())
	{
		printf("你好!;");
		printfpath();
	}
	else
	{
		printf("没有找到路径!\n");
	}
	system("pause");
	return 0;
}


堆栈实现

#include <iostream>
 
using namespace std;
#define ROWS 10
#define COLS 10
template<class T>
class MyStack
{
	T* pBuff;  //内存段首地址
	size_t len;//当前存储的数据个数
	size_t maxLen;//当前内存段大小
public:
	MyStack()
	{
		pBuff = NULL;
		len = maxLen =NULL;
	}
	~MyStack()
	{
		if (pBuff)
			delete[]pBuff;
		pBuff = NULL;
		len = maxLen = NULL;
	}
	void push(const T& data);//入栈
	void pop()//删除栈顶元素
	{
		len--;
	}
	T getTop()
	{
		return pBuff[len - 1];
	}
	bool isEmpty()
	{
		return len == 0;
	}
};
template<class T>
void MyStack<T>::push(const T& data)
{
	//判断是否需要开内存
	if (len >= maxLen)
	{
		//1.开内存

		//1.1计算新开内存大小
		//新的内存段大小是原来的1倍加(原来的二分之一或者1)
		maxLen = maxLen + (((maxLen >> 1) > 1) ? (maxLen >> 1) : 1);
		//1.2 开内存。
		T* pTem = new T[maxLen];
		//2.如果原来的内存段中有数据
		if (pBuff)
		{
			memcpy(pTem, pBuff, sizeof(T) * len);
			delete[] pBuff;
		}
		//3.pBuff指针指向新开内存段。
		pBuff = pTem;
	}
	//4.新数据进来。
	pBuff[len++] = data;
}
struct MyPoint
{
	int y;
	int x;
	friend bool operator==(const MyPoint& p1, const MyPoint& p2);
};
bool operator==(const MyPoint& p1, const MyPoint& p2)
{
	if (p1.x == p2.x && p1.y == p2.y) return true;
	return false;
}
enum dirent{p_up,p_left,p_down,p_right };
struct pathNode
{
	int dir;//当前试探方向
	bool isFind;//是否走过  0 false  1 true
};
int main()
{
	//1.寻路前的准备

	//1.1地图
	int map[ROWS][COLS] = {
		{1,1,1,1,1,1,1,1,1,1},
		{1,0,1,0,1,1,0,1,0,1},
		{1,0,1,0,1,1,0,1,0,1},
		{1,0,1,0,1,1,0,1,0,1},
		{1,0,0,0,1,1,0,0,0,1},
		{1,0,1,0,1,1,0,1,1,1},
		{1,0,1,0,1,1,0,1,1,1},
		{1,0,1,0,1,1,0,1,1,1},
		{1,0,1,0,0,0,0,0,0,1},
		{1,1,1,1,1,1,1,1,1,1},

	};

	//1.2辅助地图(记录当前试探方向,记录有没有走过)
	pathNode pathMap[ROWS][COLS] = { 0 };
	//1.3栈
	MyStack <MyPoint>stack;
	//1.4七点 终点
	MyPoint begPos = { 1,8 };
	MyPoint endPos = { 1,1 };
	//标记起点走过
	pathMap[begPos.y][begPos.x].isFind = true;
	stack.push(begPos);
	//2寻路
	MyPoint currentPos = begPos;
	MyPoint searchPos;
	bool isFindEnd = false;
	while (1)
	{
		searchPos = currentPos;				//重点
		//根据当前点的当前试探方向,确定试探点。
		switch (pathMap[currentPos.y][currentPos.x].dir)
		{
		case p_up:
			searchPos.y--;
			pathMap[currentPos.y][currentPos.x].dir++;
			//2.2判断能不能走
			if (pathMap[searchPos.y][searchPos.x].isFind == false//没有走过
				&& map[searchPos.y][searchPos.x] == 0)//不是障碍
				//2.3走
			{
				currentPos = searchPos;
				//2.4入栈
				stack.push(currentPos);
			
			//2.5标记走过
			pathMap[searchPos.y][searchPos.x].isFind = true;
			}
			break;
		case p_left:
			searchPos.x--;
			pathMap[currentPos.y][currentPos.x].dir++;
			//2.2判断能不能走
			if (pathMap[searchPos.y][searchPos.x].isFind == false
				&& map[searchPos.y][searchPos.x] == 0)
			{
				currentPos = searchPos;
				//2.4入栈
				stack.push(currentPos);

				//2.5标记走过
				pathMap[searchPos.y][searchPos.x].isFind = true;
			} break;
		case p_down:
			searchPos.y++;
			pathMap[currentPos.y][currentPos.x].dir++;
			//2.2判断能不能走
			if (pathMap[searchPos.y][searchPos.x].isFind == false
				&& map[searchPos.y][searchPos.x] == 0)
				//2.3走
			{
				currentPos = searchPos;
				//2.4入栈
				stack.push(currentPos);

				//2.5标记走过
				pathMap[searchPos.y][searchPos.x].isFind = true;
			} break;
		case p_right:
			searchPos.x++;
			pathMap[currentPos.y][currentPos.x].dir++;
			//2.2判断能不能走
			if (pathMap[searchPos.y][searchPos.x].isFind == false
				&& map[searchPos.y][searchPos.x] == 0)
			{	//2.3走
				currentPos = searchPos;
			//2.4入栈
			stack.push(searchPos);
			//2.5标记走过
			pathMap[searchPos.y][searchPos.x].isFind = true;
			}
			else //2.6回退
			{
				stack.pop();
				currentPos = stack.getTop();//跳到当前栈顶元素。
			}
			break;
		default:break;
		}
		if (currentPos == endPos)
		{
			isFindEnd = true;
			break;
		}
		//如果整个地图都没有终点
		if (stack.isEmpty())
			break;
	}
	if(isFindEnd)
	{
		cout << "找到终点了!哈哈哈!\n";
		cout << "path:\n";
		while (!stack.isEmpty())
		{
			cout<<"("<<stack.getTop().y <<"," << stack.getTop().x << ") ";
			stack.pop();
		}
	}
	else
	{
		cout << "没有找到终点!\n"; 
	}


	system("pause");
	return 0;
}
  • 1
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 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、付费专栏及课程。

余额充值