lidarSLAM
暂无个性签名
——来自《移动机器人运动规划- 第一期》·73浏览
若前一步判断open set 里包含终点，就不应该再有后一步取出open set中fn最小的节点索引的操作，对吗？ 所以是if ... elseif ... else ... end.
