使用A*算法解决野人渡河问题的实现

/*********************************************************************************  
 *          程  序  说  明                                                       *  
 * 功能: 用A*算法求解传教士与野人问题。M=C=5, K=3                                *  
 * 说明:                                                                         *  
 *     本程序按照《人工智能导论》一书所介绍的A*算法求解传教士与野人问题。        *  
 *                                                                               *  
 * 注意: 该程序尽可能用与算法一致的思路实现算法, 力求简单明了, 注重算法的清晰性，*  
 * 而没有考虑算法的效率问题。                                                    *  
 *********************************************************************************/   
   
#include <stdio.h>    
#include <stdlib.h>    
   
#define     M   5       //传教士总人数    
#define     C   5       //野人总人数    
#define     K   3       //船一次可以乘坐的最多人数    
   
struct NODE   
{   
    int m;                      //在左岸的传教士人数    
    int c;                      //在左岸的野人人数    
    int b;                      //b=1表示船在左岸,b=0表示船在右岸    
    double g;                   //该节点的g值    
    double f;                   //该节点的f值    
    struct NODE *pFather;       //指向该节点的父节点    
    struct NODE *pNext;         //在OPEN表或者CLOSED表中，指向下一个元素    
};   
   
struct NODE *g_pOpen = NULL;    //全程变量，OPEN表    
struct NODE *g_pClosed = NULL;      //全程变量，CLOSED表    

   
   
int Equal(struct NODE *pNode1, struct NODE *pNode2)   
/******************************************************  
 * 功能：判断两个节点所表示的状态是否相等             *  
 *                                                    *  
 * 入口参数：                                         *  
 *   pNode1：指向节点1的指针                          *  
 *   pNode2：指向节点2的指针                          *  
 *                                                    *  
 * 返回值：当两个节点所表示的状态相等时，返回1，否则  *  
 *         返回0                                      *  
 ******************************************************/   
{   
    if (pNode1->m == pNode2->m &&   
        pNode1->c == pNode2->c &&   
        pNode1->b == pNode2->b) return 1;   
    else return 0;   
}   
   
struct NODE *NewNode(int m, int c, int b)   
/******************************************************  
 * 功能：动态产生一个节点，其状态值由参数m，c，b给定。*  
 *                                                    *  
 * 入口参数：                                         *  
 *   m：河左岸的传教士人数                            *  
 *   c：河左岸的野人人数                              *  
 *   b：船是否在左岸，1：表示在左岸，0：表示不在左岸  *  
 *                                                    *  
 * 返回值：指向新产生的节点的指针，或者空间不够时，返 *