基于动态窗口法的编队算法

#自己用动态窗口法写了一个算法,和长机-僚机法结合起来

动态窗口法的原理大致是在速度与加速度约束内,遍历选择所有可能的速度来进行预测未来t秒的航迹,通过自己设置的航迹评价函数,例如与目标点距离,与障碍物距离,速度等多方面进行最优选择。

但是与传统优化算法类似,容易陷入局部最优解。表现就是不能避开与目标连线的障碍物。为避免动态窗口法陷入局部最优,提高复杂环境下的航 迹规划能力,在文献 的基础上,本文使用一种自适应航 迹评价函数权重的动态窗口法。采用两输入三输出的模糊控 制器优化权重系数,最终我编写代码出来的结果图如下:

整个算法的流程图如下:
部分代码如下“
function [ ] = formation_6 ()
close
  • 43
    点赞
  • 10
    收藏
    觉得还不错? 一键收藏
  • 1
    评论
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值