路径规划1（Dijkstra）

路径规划主要分为：全局路径规划（routing）和局部路径规划（motion planning）决策是在路径规划之后的，路径规划可能规划出多条路径，性能指标不同，需要决策模块决定取哪条规划路线