A星算法格栅地图路径考虑障碍物的动态切点光滑算法-matlab代码
一、动态切点调整算法
动态切点调整算法去除凹凸点,该方法能够得到既有曲率连续性,同时满足几何特性的路径。
二、加入节点缩短后的代码效果
三、部分代码
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% 2020-10-17 传统A*算法
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
原创
2021-02-08 20:58:25 ·
1358 阅读 ·
1 评论