A*算法在ROS上的简单移植,感谢原作者“一路向南”的源代码奉献!