(二)【機器人路徑規劃】Dijkstra算法

Dijkstra算法 Dijkstra算法是從一個節點到區域各節點的最短路徑算法,解決的是最短路徑問題。 特點:以起點爲中心,向外層層擴展,直到擴展到終點爲止。 我們引入兩個集合closelist、openlist和兩個集合 閉集closelist:記錄已求出最短路徑的節點。 開集openlist:記錄還未求出最短路徑的節點。 集合1:記錄源節點到各節點的距離 集合2:記錄節點對應的父節點 算法操
相關文章
相關標籤/搜索