也谈迷宫算法(最短路径 队列)+源程序

晕死鸟，原来的有错误哦，改了一个判断条件，加了一个变量。
思路是没错，还是广度优先遍历。

现在改好了，发现错误再请指正：sduboy@163.com

#include <stdlib.h>
#include <stdio.h>
#define ElemType MazePos
typedef struct MazePos0{
           int x,y;
           }MazePos;       
typedef struct maze0{
          int s;//pass or wall
          MazePos pre;
          bool visited;
          }Maze;
typedef struct QueueNode{
           ElemType data;
           struct QueueNode *next;
           }queuenode;
          
typedef struct queue{
            struct QueueNode *front;
            struct QueueNode *rear;
             }Queue;
Maze maze[10][10];
//=============================================
Queue* InitQueue()
 {
   Queue *q=NULL;
   if(!(q=(Queue*)malloc(sizeof(Queue)))) return NULL;
   q->front=q->rear=NULL;
   return q;
  }     
bool EnQueue(Queue *q,ElemType data)
 {
   QueueNode *qn=NULL,*temp=NULL;
   if(!q)return false;
   if(!(qn=(QueueNode*)malloc(sizeof(QueueNode)))) return false;
   qn->data=data;
   qn->next=NULL;
   if(q->rear)//加入第一各节点时q->rear==NULL
   q->rear->next=qn;
   q->rear=qn; 
   if(!q->front)q->front=qn;//同上
   return true;
  }
bool DeQueue(Queue *q,ElemType *data)
 {
   QueueNode *qn=NULL;
   if(q->front==NULL) return false;
   qn=q->front;
   q->front=q->front->next;
   *data=qn->data;
   free(qn);
   return true;
   }
ElemType GetFrontElem(Queue *q)
 {
   if(q) return q->front->data;
   }
bool QueueEmpty(Queue *q)
 {
   if(!q->front) return true;
   else return false;
  }    
int ElementsCounts(Queue *q)
 {
   int i=0;
   QueueNode *temp;
   temp=q->front;
   while(temp){ i++;temp=temp->next;}
   return i;
  } 
//======================
void InitMaze1(Maze maze[10][10])
{

 for(int i=1;i<9;i++)
  {
  for(int j=1;j<9;j++)
  maze[i][j].s=1;
  printf("/n");
  }
  maze[2][3].s=0;maze[2][4].s=0;maze[2][5].s=0;maze[3][5].s=0;
  maze[4][1].s=0;maze[4][2].s=0;maze[4][3].s=0;maze[4][4].s=0;
  maze[1][7].s=0;maze[2][7].s=0;maze[3][7].s=0;maze[5][4].s=0;
  maze[6][2].s=0;maze[7][2].s=0;maze[7][3].s=0;maze[7][4].s=0;
  maze[7][7].s=0;
  maze[7][6].s=0;
  maze[6][6].s=0;
  //maze[1][5].s=0;
 
}
void InitMaze2(Maze maze[][10])
{
 int i,j;
 printf("/n");
 for(i=0;i<10;i++)
 {
  for(j=0;j<10;j++)
  {
   maze[i][j].visited=false;
   maze[i][j].pre.x=0;
   maze[i][j].pre.y=0;
 
  }
  printf("/n");
 }
 
}
 
void PrintMaze(Maze maze[][10])
{
 int i,j;
 printf("/n");
 for(i=0;i<10;i++)
 {
  for(j=0;j<10;j++)
  {
   printf("%d ",maze[i][j].s);
  }
  printf("/n");
 }
}
//========================
void printpass(Maze maze[][10],int x0,int y0,int x1,int y1)
 { int x,y;
   x=x1;y=y1;
   while(!((x1==x0)&&(y1==y0)))
   {
   printf(" (%d,%d) ",x1,y1);
   x=maze[x1][y1].pre.x;
   y=maze[x1][y1].pre.y;
   x1=x;y1=y;
   //system("pause");
   }
   printf(" (%d,%d) ",x0,y0); printf("/n");
 } 
//==============modified on 12-30-2004=========
bool TravelMaze(Maze maze[][10],int x0,int y0,int x1,int y1)
 {
   Queue *q=InitQueue();
   MazePos pos,tempos;                  
   if(!q) exit(1);
   if(maze[x0][y0].s==0)return false;
   pos.x=x0;pos.y=y0;
   maze[x0][y0].pre.x=x0;maze[x0][y0].pre.y=y0;
   maze[x0][y0].visited=true;
   EnQueue(q,pos);
  while(!QueueEmpty(q) && !maze[x1][y1].visited)  

    {
      tempos=GetFrontElem(q);
      x0=tempos.x;  y0=tempos.y;          
       if(maze[x0+1][y0].s==1 && !maze[x0+1][y0].visited)
           { x0++; pos.x=x0;pos.y=y0;EnQueue(q,pos);
             maze[x0][y0].visited=true;
             maze[x0][y0].pre.x=x0-1;maze[x0][y0].pre.y=y0;}
     
      x0=tempos.x;  y0=tempos.y;           
       if(maze[x0-1][y0].s==1 &&!maze[x0-1][y0].visited)
           { x0--;pos.x=x0;pos.y=y0;EnQueue(q,pos);
             maze[x0][y0].visited=true;
             maze[x0][y0].pre.x=x0+1;maze[x0][y0].pre.y=y0;}
    
      x0=tempos.x;  y0=tempos.y;           
       if (maze[x0][y0+1].s==1 &&!maze[x0][y0+1].visited)
           { y0++;pos.x=x0;pos.y=y0;EnQueue(q,pos);
             maze[x0][y0].visited=true;
             maze[x0][y0].pre.x=x0;maze[x0][y0].pre.y=y0-1;}
    
      x0=tempos.x;  y0=tempos.y;           
       if(maze[x0][y0-1].s==1 &&!maze[x0][y0-1].visited)         
           { y0--;pos.x=x0;pos.y=y0;EnQueue(q,pos);
             maze[x0][y0].visited=true;
             maze[x0][y0].pre.x=x0;maze[x0][y0].pre.y=y0+1;}
            
        DeQueue(q,&pos);  
       
     
        }
    
  
    if(maze[x1][y1].visited){     
            printpass(maze,1,1,8,8);
            return true;
            }
      else return false;  
}
int main()
{
   InitMaze1(maze);
   InitMaze2(maze);
   int entranceX=1, entranceY=1;
   int exitX=8, exitY=8;
   PrintMaze(maze);
 
  if(!TravelMaze(maze,entranceX,entranceY,exitX,exitY))
  printf("Sorry, no solution./n");
   system("pause");
 return 0;
}