机器人局部避障的动态窗口法DWA (dynamic window approach)-matlab代码修改及动态障碍物避障效果

具体效果视频:【DWA动态障碍物-哔哩哔哩】

https://b23.tv/pQp6ne

一、源码及问题

        最初的源码链接https://blog.csdn.net/heyijia0327/article/details/44983551

        改进后的代码连接https://blog.csdn.net/xingdou520/article/details/83626591

        前段时间看了一下dwa算法的原理,机器人在获得目的地信息后,首先经过全局路径规划规划出一条大致可行的路线,然后调用局部路径规划器根据这条路线及costmap的信息规划出机器人在局部时做出具体行动策略,ROS中主要是使用了DWA算法。在ROS中每当move_base处于规划状态就调用DWA算法计算出一条最佳的速度指令,发送给机器人运动底盘执行。DWA算法全称为dynamic window approach,其原理主要是在速度空间(v,w)中采样多组速度,并模拟这些速度在一定时间内的运动轨迹,再通过一个评价函数对这些轨迹打分,最优的速度被选择出来发送给下位机。

        通过一段时间的研究发生源码有很大的bug,一个是更换起点和终点之后需要手动调节初始姿态,很麻烦!二是某些方向存在逻辑,会陷入循环导致寻路失败。如下:

起点和终点                                                                                       起点和终点(发生错误!!!)                                              

                                              

二、改进后效果及动态障碍物效果

       只需要输入起点和终点即可,并且任意位置都可成功寻路

三、

改进的代码

https://download.csdn.net/download/weixin_41971010/16635966

动态障碍物

https://download.csdn.net/download/weixin_41971010/20097922?spm=1001.2014.3001.5503

  • 3
    点赞
  • 96
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 10
    评论
评论 10
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

是好人的墨叔

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值