寻找一条通过迷宫的路径

试编写一个程序寻找一条通过迷宫的路径。

　　一个迷宫可以看成是一个矩阵（数组），它有一个入口单元和一个出口单元，图中阴影处表示障碍物，白格表示可以通行的道路。只能从入口进去，从出口出去，中间只能通过白格子（即只能从一个白格单元走到一个相邻的白格单元，相邻指上、下、左、右四个单元），遇见死路时，退回去重找其它路。用户可设入口处(1,1)为2，出口位置(5,6)为-1，白格处送入0，障碍物位置送入1。

上代码：

#include <stdio.h>

int matrix[6][6] = 
{
    0, 1, 0, 0, 0, 1,
    0, 0, 0, 1, 0, 1,
    1, 0, 1, 0, 0, 0,
    0, 0, 0, 1, 1, 0,
    0, 1, 1, 0, 1, 0,
    0, 0, 0, 0, 1, 1
};

int stepX[36];
int stepY[36];
int stepCount;


int IsSteped(int x, int y)
{
    for(int i = 0; i < stepCount; i++)
    {
        if(stepX[i] == x && stepY[i] == y)
        {
            return 1;
        }
    }
    return 0;
}

int main()
{
    //初始化第一步
    stepX[0] = 0;
    stepY[0] = 0;
    stepCount = 1;
    //
    while(stepCount != 0)
    {
        int nowStepX = stepX[stepCount-1];
        int nowStepY = stepY[stepCount-1];
        //判断是不是走到了出口
        if(nowStepX == 4 && nowStepY == 5)
        {
            break;
        }

        //判断上面
        nowStepX = stepX[stepCount-1] - 1;
        nowStepY = stepY[stepCount-1];
        if(nowStepX >= 0)
        {
            //判断是不是可走的路
            if(matrix[nowStepX][nowStepY] == 0 && IsSteped(nowStepX, nowStepY) == 0)
            {
                //这条路可走,把它计入已走的记录里
                stepX[stepCount] = nowStepX;
                stepY[stepCount] = nowStepY;
                stepCount++;
                continue;
            }
        }

        //判断下面
        nowStepX = stepX[stepCount-1] + 1;
        nowStepY = stepY[stepCount-1];
        if(nowStepX < 6)
        {
            //判断是不是可走的路
            if(matrix[nowStepX][nowStepY] == 0 && IsSteped(nowStepX, nowStepY) == 0)
            {
                //这条路可走,把它计入已走的记录里
                stepX[stepCount] = nowStepX;
                stepY[stepCount] = nowStepY;
                stepCount++;
                continue;
            }
        }

        //判断左边
        nowStepX = stepX[stepCount-1];
        nowStepY = stepY[stepCount-1] - 1;
        if(nowStepY >= 0)
        {
            //判断是不是可走的路
            if(matrix[nowStepX][nowStepY] == 0 && IsSteped(nowStepX, nowStepY) == 0)
            {
                //这条路可走,把它计入已走的记录里
                stepX[stepCount] = nowStepX;
                stepY[stepCount] = nowStepY;
                stepCount++;
                continue;
            }
        }
        //判断右边
        nowStepX = stepX[stepCount-1];
        nowStepY = stepY[stepCount-1] + 1;
        if(nowStepY < 6)
        {
            //判断是不是可走的路
            if(matrix[nowStepX][nowStepY] == 0 && IsSteped(nowStepX, nowStepY) == 0)
            {
                //这条路可走,把它计入已走的记录里
                stepX[stepCount] = nowStepX;
                stepY[stepCount] = nowStepY;
                stepCount++;
                continue;
            }
        }
    
        //执行到这里，必须退回
        stepCount--;
        matrix[stepX[stepCount]][stepY[stepCount]] = 2;
    }

    for(int i = 0; i < stepCount; i++)
    {
        matrix[stepX[i]][stepY[i]] = 9;
    }

    for(int i = 0; i < 6; i++)
    {
        for(int j = 0; j < 6; j++)
        {
            printf("%d", matrix[i][j]);
        }
        printf("
");
    }

    return 0;
}