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] = '#';  
    if(find_path(x, y-1))  
        return 1;  

    if(find_path(x-1, y))  
        return 1;  

    if(find_path(x, y+1))  
        return 1;  

    if(find_path(x+1, y))  
        return 1;  
    gValue[x][y] = 0;  
    return 0;  
}  

return 0;  

}

d）为了验证我们的算法是否正确，可以编写一个打印函数

void print_path()
{
int outer;
int inner;

for(outer = 0; outer < MAX_NUMBER_LENGTH; outer++){  
    for(inner = 0; inner < MAX_NUMBER_LENGTH; inner++){  
        printf("%c ", gValue[outer][inner]);  
    }  
    printf("n");  
}  

}

e）上面c中所描述的算法只是寻找一条路，那么如果想遍历所有的道路，算法应该怎么修改呢？

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

    gValue[x][y] = '#';  
    find_path(x, y-1);  
    find_path(x-1, y);  
    find_path(x, y+1);  
    find_path(x+1, y);  
    gValue[x][y] = 0;  
}  

}

思考题：上面的题目介绍了寻路的方法，介绍了如何遍历所有的可能路径。当然你可以从这所有的寻找路径中寻找出一条最短的路径。但是朋友们可以思考一下，有没有一种方法，可以一下子寻找到最优的路径呢？