java 寻路算法_java实现dijkstra最短路径寻路算法

【引用】迪杰斯特拉(Dijkstra)算法是典型最短路径算法，用于计算一个节点到其他节点的最短路径。

它的主要特点是以起始点为中心向外层层扩展(广度优先搜索思想)，直到扩展到终点为止。

基本思想

通过Dijkstra计算图G中的最短路径时，需要指定起点s(即从顶点s开始计算)。

此外，引进两个集合S和U。S的作用是记录已求出最短路径的顶点(以及相应的最短路径长度)，而U则是记录还未求出最短路径的顶点(以及该顶点到起点s的距离)。

初始时，S中只有起点s；U中是除s之外的顶点，并且U中顶点的路径是"起点s到该顶点的路径"。然后，从U中找出路径最短的顶点，并将其加入到S中；接着，更新U中的顶点和顶点对应的路径。 然后，再从U中找出路径最短的顶点，并将其加入到S中；接着，更新U中的顶点和顶点对应的路径。 ... 重复该操作，直到遍历完所有顶点。

操作步骤

(1) 初始时，S只包含起点s；U包含除s外的其他顶点，且U中顶点的距离为"起点s到该顶点的距离"[例如，U中顶点v的距离为(s,v)的长度，然后s和v不相邻，则v的距离为∞]。

(2) 从U中选出"距离最短的顶点k"，并将顶点k加入到S中；同时，从U中移除顶点k。

(3) 更新U中各个顶点到起点s的距离。之所以更新U中顶点的距离，是由于上一步中确定了k是求出最短路径的顶点，从而可以利用k来更新其它顶点的距离；例如，(s,v)的距离可能大于(s,k)+(k,v)的距离。

(4) 重复步骤(2)和(3)，直到遍历完所有顶点。

得益于csdn另外一篇博客的算法，我对此做了一些改进。

构建地图:

import java.util.HashMap;

import java.util.Iterator;

import java.util.Map;

import java.util.Map.Entry;

/**

* 地图

* @author jake

* @date 2014-7-26-下午10:40:10

* @param 节点主键

*/

public class Maps {

/**

* 所有的节点集合

* 节点Id - 节点

*/

private Map> nodes = new HashMap>();

/**

* 地图构建器

*

* @author jake

* @date 2014-7-26-下午9:47:44

*/

public static class MapBuilder {

/**

* map实例

*/

private Maps map = new Maps();

/**

* 构造MapBuilder

*

* @return MapBuilder

*/

public MapBuilder create() {

return new MapBuilder();

}

/**

* 添加节点

*

* @param node 节点

* @return

*/

public MapBuilder addNode(Node node) {

map.nodes.put(node.getId(), node);

return this;

}

/**

* 添加路线

*

* @param node1Id 节点Id

* @param node2Id 节点Id

* @param weight 权重

* @return

*/

public MapBuilder addPath(T node1Id, T node2Id, int weight) {

Node node1 = map.nodes.get(node1Id);

if (node1 == null) {

throw new RuntimeException("无法找到节点:" + node1Id);

}

Node node2 = map.nodes.get(node2Id);

if (node2 == null) {

throw new RuntimeException("无法找到节点:" + node2Id);

}

node1.getChilds().put(node2, weight);

n