机器人路径规划之A*算法(附C++源码)
来源丨古月居点击进入—>3D视觉工坊学习交流群1. 基本原理A*算法的本质是广度优先的图搜索.意在寻找一个从起点到目标节点的最短路径.A*算法在Dijkstra的基础上加入了启发式变量,一般用启发式距离(两点的直线距离)表示.启发式距离2. 算法伪代码本伪代码摘取自Principles of Robot Motion其中O代表优先队列,C存放着已访问过的节点.3. 关键C++代码剖析先来看...