路徑規劃中常用的Dijkstra算法

無論是無人機還是機器人，我們在做路徑規劃時，總要解決最短路徑問題，在這裏介紹一種常用的解決最短路勁問題的算法。 Dijkstra算法 思路： 把頂點集合V分成兩組： S：已解決的頂點的集合（初始時只含有源點 V 0 V_0 V0​） U：尚未確定的頂點集合 將U中頂點按遞增的次序加入到S中，保證： 從源點 V 0 V_0 V0​到S中其他各頂點的長度都不大於從 V 0 V_0 V0​到U中任何頂點

>>阅读原文<<