用c语言写一段栅格建图路径规划
时间: 2023-03-12 14:34:28 浏览: 131
#include <stdio.h>
int main()
{
int map[10][10]; //定义一个10行10列的栅格地图
int startX, startY; //起点位置
int endX, endY; //终点位置
int i, j;
//初始化栅格地图,0表示可以经过,1表示不可以经过
for(i=0;i<10;i++)
for(j=0;j<10;j++)
map[i][j] = 0;
//设置起点和终点
startX = 0;
startY = 0;
endX = 9;
endY = 9;
//开始路径规划
while(startX!=endX || startY!=endY)
{
//向右走
if(startX < endX && map[startX+1][startY] == 0)
{
startX++;
printf("right\n");
}
else
{
//向下走
if(startY < endY && map[startX][startY+1] == 0)
{
startY++;
printf("down\n");
}
else
{
//向左走
if(startX > endX && map[startX-1][startY] == 0)
{
startX--;
printf("left\n");
}
else
{
//向上走
if(startY > endY && map[startX][startY-1] == 0)
{
startY--;
printf("up\n");
}
}
}
}
}
printf("END\n");
return 0;
} 答案:我可以为您提供用C语言编写栅格建图路径规划的代码,但是您需要自己设置地图的参数,以及起点和终点的位置。