兴中捧月杯算法比赛---最优规划路径，使用蚁群算法规划最优路径_C++_代码_下载

#include "map.h" #include <string.h> #include "set.h" #include <list> #include <string> #include <sstream> using std::list; extern int includeNodeNum; extern int edge_num; /// 全局必经点集合 list<int> initInfluenceSet; /// 全局必经边集合 list<int> initMustEdge; /// 全局禁止边集合 list<int> initBanEdge; /// 全局限制节点 int limit; /// 用于对节点进行计数,初始化为0 int bitFlagArray_1[1 + MAX_VERTEX_NUM / BITSPERWORD] = { 0 }; /// 用于对要求经过的点进行标记 int bitFlagArray_2[1 + MAX_DEMAND_NUM / BITSPERWORD] = { 0 }; /// 用于存放要求 int demandSet[60]; /// 寻路起始点 int start; /// 寻路终点 int end; /// 判断必经边是否含有终点的标志位 int Flag_EndVertex_Must=0; /// 用于存储图的路径信息 int g_Distance[600][600]; /// 对图做一定的修改的时候，会用到 int g_Distance_temp[600][600]; /// including set中的点的集合 UnionFindSet includingSet; /// inf指代无穷大的数 const int inf = 100000000; void set(int i,int a[]) { a[i >> SHIFT] |= (1 << (i&MASK)); } void clr(int i,int a[]) { a[i >> SHIFT] &= ~(1 << (i&MASK)); } int test(int i,int a[]) { return a[i >> SHIFT] & (1 << (i&MASK)); } /// MakeNode函数 /// 根据从文件读取的内容构造一个邻接链表的节点（即构造一条边） /// @param linkid 构造的边的编号 /// @param destinationid 构造的边的指向节点 /// @param cost 构造的边的权重 /// @return 返回构造的边的指针 ArcNode * MakeNode(unsigned int linkid,unsigned int destinationid,unsigned int cost) { ArcNode *pArcNode; if(( pArcNode = (ArcNode *) new ArcNode ) == NULL) return NULL; pArcNode->nextarc = NULL; pArcNode->adjvex = destinationid; //该边指向的顶点 (pArcNode->arcinfo).arcnum = linkid; //该边的编号 (pArcNode->arcinfo).weight = cost; //该边的权重 return pArcNode; } ///初始化图的信息 void InitInfo() { int i = 0; G.arcnum = edge_num; G.vexnum = 0; for (; i < MAX_VERTEX_NUM; i++) { G.vertices[i].adjlist.head = NULL; G.vertices[i].adjlist.tail = NULL; G.vertices[i].adjlist.len = 0; G.vertices[i].nodeinfo.inDegree = 0; G.vertices[i].nodeinfo.outDegree = 0; G.vertices[i].nodeinfo.distance = INT_MAX; G.vertices[i].nodeinfo.num = i; //记录自己的节点号信息 } } ///从buffer中获取对应的linkid，sourceid，destinationid，cost void GetValue(int value[],char buffer[]) { unsigned int i = 0, j = 0, k = 0; for (; j < 4; j++) { k = i; while (!(buffer[i] == ',' || buffer[i] == '|' || buffer[i] == '\n' || buffer[i] == '\0')) i++; buffer[i++] = '\0'; value[j] = atoi(buffer + k); } } /// AddNode函数 /// 在节点 i 的邻接链表尾部添加一条边 /// @param i 节点 /// @param pArcNode 指向要添加的边的指针 void AddNode(unsigned int i, ArcNode * pArcNode) { if (G.vertices[i].adjlist.len == 0) //判断这个将要添加的顶点是否是某个顶点的邻接链表的第一个节点 G.vertices[i].adjlist.head = pArcNode; else (G.vertices[i].adjlist.tail)->nextarc = pArcNode; G.vertices[i].adjlist.tail = pArcNode; G.vertices[i].adjlist.len++; //以下两个 if 统计节点个数 if (!test(i,bitFlagArray_1)) { G.vexnum++; set(i,bitFlagArray_1); } if (!test(pArcNode->adjvex,bitFlagArray_1)) { G.vexnum++; set(pArcNode->adjvex,bitFlagArray_1); } G.vertices[i].nodeinfo.outDegree += 1; //节点 i 出度+1 G.vertices[pArcNode->adjvex].nodeinfo.inDegree += 1; //新加入的节点入度+1 } /// InitMap函数 /// 根据文件初始化图的信息 /// @param topo[] 含有图信息的数组指针 void InitMap(char *topo[]) { ArcNode * pArcNode; int value[4]; //分别存放linkid,sourceid,destinationid,cost InitInfo(); for (int i = 0; i < edge_num; i++) { GetValue(value, topo[i]); g_Distance[value[1]][value[2]] = value[3]; //矩阵的形式存储图的信息 g_Distance_temp[value[1]][value[2]] = value[3]; if ((pArcNode = MakeNode(value[0], value[2], value[3])) == NULL) { printf("构造邻接链表节点失败！\n"); return; } //将构建的这个弧添加到节点号为sourceid的邻接链表上去 AddNode(value[1], pArcNode); } /*将图中不存在的边的权值设为inf */ for (int i = 0; i < G.vexnum; i++) { for (int j = 0; j < G.vexnum; j++) { if (g_Distance[i][j] == 0) { g_Distance[i][j] = inf; g_Distance_temp[i][j] = inf; } } } return; } /// InitDemandSet函数 /// 初始化必经点和吸引力集合 /// @param buf 存储全局必经点的集合 /// @param bufsize 必经点的个数 /// @param StartVertex 寻路的起点 /// @param EndVertex 寻路的终点 /// @return 必经点的个数 int InitDemandSet(std::vector<int> buf,int bufsize,int StartVertex,int EndVertex) { for(int i=0;i<bufsize;i++) { demandSet[i] = buf[i]; } start = StartVertex; end = EndVertex; /*初始化including set集合*/ InitUnionSet(&includingSet, G.vexnum); /*创建including set的集合*/ for (int i = 0; i < bufsize; i++) { includingSet.UnionSet(demandSet[i], demandSet[0], &includingSet); //demandSet[0]作为父节点。 initInfluenceSet.push_back(demandSet[i]); //初始化能对蚂蚁产生吸引力的节点集合。 } return bufsize; } /// InitMustEdge函数 /// /初始化必经点的集合 /// @param buf 存储全局必经边的集合 /// @param bufsize 必经边的个数 /// @return 必经边的个数 int InitMustEdge(std::vector<int> buf,int bufsize) { for(int i=0;i<bufsize;i++) { initMustEdge.push_back(buf[i]); } return initMustEdge.size(); } /// InitBanEdge函数 /// 初始化禁止边的集合、限制节点的最大值 /// @param buf 存储全局禁止边的集合 /// @param bufsize 禁止边的个数 /// @param num 限制节点的最大值 /// @return 禁止边的个数 int InitBanEdge(std::vector<int> buf,int bufsize,int num) { for(int i=0;i<bufsize;i++) { initBanEdge.push_back(buf[i]); } limit = num; return initBanEdge.size(); } /// InputDemand函数 /// 输入首尾节点、必经点的信息 /// @param demand 指向全局必经点的引用 /// @param VertexStart 指向起点序号的指针 /// @param VertexEnd 指向终点序号的指针 /// @return 必经点的个数 int InputDemand( std::vector<int> & demand,int *VertexStart,int * VertexEnd) { /*输入起点和终点*/ int i=0; std::string line; std::string word; std::cout<<"输入起点和终点 (空格间断，回车结束)： \n "; getline(std::cin,line); std::istringstream record(line); std::string tmp; while(record >> word) { tmp = word; if(0 == i) *VertexStart = atoi(tmp.c_str()); else if(1 == i) *VertexEnd = atoi(tmp.c_str()); else { std::cerr<<"输入有误！\n"; exit(1); } ++i; } std::cin.clear(); /*输入必经点*/ std::string line_1; std::string word_1; std::cout<<"输入必经点 (空格间断，回车结束)： \n "; getline(std::cin,line_1); std::istringstream rtc(line_1); while(rtc >> word_1) { demand.push_back((atoi( word_1.c_str() ) )); } std::cin.clear(); return demand.size(); } /// InputMustEdge函数 /// 输入必经边的信息 /// @param Mustedge 指向全局必经边的引用 /// @return 必经边的个数 int InputMustEdge(std::vector<int> & Mustedge) { std::string buf; std::string vertex; int first=0; int v[2]; int tmp; std::cout<<"输入必经边（例如：输入2 4 11 12，表示2和4为一条必经边，11和12为另一条必经边）：\n "; getline(std::cin,buf); std::istringstream rtc(buf); //文件流绑定 while(rtc >> vertex) //输入流可以读取流信息，以空格为间隔 { tmp = atoi(vertex.c_str()); v[first] = tmp; if(++first >1) { if(v[0] == end || v[1] == end) Flag_EndVertex_Must = 1; int linkID = GetLinkID(v[0],v[1]); // std::cout<<"linkId:"<<linkID<<std::endl; Mustedge.push_back(linkID); v[0] = v[1] = 0; first = 0; } } std::cin.clear(); return Mustedge.size(); } /// InputBanEdge函数 /// 输入禁止边、限制点的信息 /// @param ban_file 指向全局禁止边的引用 /// @param num 指向限制节点最大值的指针 /// @return 禁止边的个数 int InputBanEdge(std::vector<int> & ban_file,int *num) { /*输入禁止边*/ std::string buf; std::string vertex; int first=0; int v[2]; int tmp; std::cout<<"输入禁止边（例如：输入2 4 11 12，表示2和4为一条禁止边，11和12为另一条禁止边）：\n "; getline(std::cin,buf); std::istringstream rtc(buf); //文件流绑定 while(rtc >