路径规划中常用的Dijkstra算法

无论是无人机还是机器人，我们在做路径规划时，总要解决最短路径问题，在这里介绍一种常用的解决最短路劲问题的算法。 Dijkstra算法 思路： 把顶点集合V分成两组： S：已解决的顶点的集合（初始时只含有源点 V 0 V_0 V0​） U：尚未确定的顶点集合 将U中顶点按递增的次序加入到S中，保证： 从源点 V 0 V_0 V0​到S中其他各顶点的长度都不大于从 V 0 V_0 V0​到U中任何顶点

>>阅读原文<<