最近在研读ROS中的A*算法,参见了文章
:【ROS-Navigation】—— Astar路径规划算法解析
这里作为笔记:
问题1:如何理解如下代码?
float QuadraticCalculator::calculatePotential(float* potential, unsigned char cost, int n, float prev_potential) {
// get neighbors
float u, d, l, r;
l = potential[n - 1