动态窗口法的二维路径规划算法结构
- 输入地图信息和起点终点坐标
- 初始化起点的代价为0,扩展队列加入起点
- 进入循环,直到扩展队列为空
- 弹出代价最小的节点,判断是否为终点,若是则返回路径
- 否则,对当前节点进行扩展,生成子节点并计算代价,将代价小于当前最优路径的点加入扩展队列
- 重复步骤3-5直到找到终点或者无法扩展为止
- 若无法扩展则返回无解
算法流程图:

原文地址: https://www.cveoy.top/t/topic/bmWw 著作权归作者所有。请勿转载和采集!
安全问答是一个知识全球问答,包含丰富的问答知识
算法流程图:

原文地址: https://www.cveoy.top/t/topic/bmWw 著作权归作者所有。请勿转载和采集!