C++算法之寻路算法的代码

把做工程过程常用的一些代码片段备份一次，下面代码段是关于C++算法之寻路算法的代码。

#define MAX_NUMBER_LENGTH 6

static int gPath[MAX_NUMBER_LENGTH][MAX_NUMBER_LENGTH] = {
{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}
};

b）其实，我们编写一个判断函数，判断当前节点是否合法

int check_pos_valid(int x, int y)
{
if(x < 0 || x>= MAX_NUMBER_LENGTH || y < 0 || y >= MAX_NUMBER_LENGTH)
return 0;

if(0 == gPath[x][y])  
    return 0;  

if('#' == gValue[x][y])  
    return 0;  

return 1;  

}

c）接着，我们编写一个递归的寻找算法即可

int find_path(int x, int y)
{
if(check_pos_valid(x,y))
{
if(2 == gPath[x][y]){
gValue[x][y] = ‘#’;
return 1;
}

    gValue[x][y] &