一致代价搜索算法UCS_BFS

一致代价搜索算法UCS_BFS

算法原理: 利用优先队列（优先级属性为每一步的路径代价）后进先出的性质来一层层的遍历。一致代价搜索每次都选择下一步路径代价最小的值进行贪心的拓展。这可以通过将边缘结点集组织成按单步代价值排序的优先队列来实现。
算法时间空间复杂度分析：时间复杂度：O(b^(1+[C*/ε] ) ) 空间复杂度：O(b^(1+[C*/ε] ) )

算法步骤：
1)将开始结点压入优先队列中；
2)取出队列结点当前拓展结点，设置为已访问；
3)判断当前结点是否为目标结点，若是则输出路径搜索结束，否则进行下一步；
4)访问当前结点的所有相邻子节点；
5)判断该该子节点是否被访问过，若已经访问过则回到2），若还未访问过则继续下一步6）；
6)对于每一个子节点，获取其相关信息值并进行路径更新，将其子节点的父亲结点指向当前结点，返回2）；
7)若优先队列为空还未找到目标结点，返回搜索失败；

package 实验一;

import java.util.PriorityQueue;

public class UCS_BFS extends BuildGraph{
	public void ShortestPath(){
		ShortestPath(start,end);
	}
	public void ShortestPath(Vertex startNode,Vertex endNode){
		//初始化
		 PriorityQueue<Vertex> priorityQueue=new PriorityQueue<>();
		 priorityQueue.add(startNode);
		  while(!priorityQueue.isEmpty()){
		     Vertex v = priorityQueue.remove();
		     explored.put(v.vertexLabel, 1);
			 if(v.vertexLabel==endNode.vertexLabel){
				 System.out.println("UCS_BFS Route:");
				 showPath(v,startNode);
				 return;
			 }
			 for(int i=0;i<v.child.size();i++){
				 Vertex current=v.child.get(i).endVertex;
				 //System.out.println(explored.get(current.vertexLabel));
				 if(explored.get(current.vertexLabel)==0){
					 current.dist=v.dist+v.adjEdges.get(v.child.get(i));
					 priorityQueue.add(current);
					 current.preNode=v;
				 }
			 }			
		}
		System.out.println("UCS_BFS Route:"+" Failure!");
		return;

	}
}