一个矩阵,1为路,0为障碍,2为终点,4为查找的路。
定义一个二维数组保存地图
int[,] gPath = new int[6, 6]{
{0 , 0, 0, 0, 1, 1},
{1, 1, 0, 0, 1, 0},
{0 , 1, 1, 1, 1, 0},
{0 , 0, 1, 0, 1, 2},
{0 , 0, 1, 0, 1, 0},
{0 , 0, 1, 1, 1, 0}
};
定义一个二维数组记录走过的路
int[,] gValue = new int[6,6];
条件筛选
int check_pos_valid(int x, int y)
{
/* 节点是否出边界 */
if (x < 0 || x >= 6 || y < 0 || y >= 6)
return 0;
/* 当前节点是否存在路 */
if (0 == gPath[x,y])
return 0;
/* 当前节点是否已经走过 */
if (4 == gValue[x, y])
return 0;
return 1;
}
递归寻路
int find_path(int x, int y)
{
if (check_pos_valid(x, y) == 1)
{
if (2 == gPath[x, y])
{
gValue[x, y] = 4;
return 1;
}
gValue[x, y] = 4;
if (find_path(x, y - 1) == 1)
return 1;
if (find_path(x - 1, y) == 1)
return 1;
if (find_path(x, y + 1) == 1)
return 1;
if (find_path(x + 1, y) == 1)
return 1;
gValue[x, y] = 0;
return 0;
}
return 0;
}