查看原文
其他

机器人局部规划算法--DWA算法原理

武辛 地学分析与算法 2022-05-17



之前的推送通过视频展示了小车过直角弯(科目二直角拐弯)的过程:机器人局部规划算法--科目二直角拐弯

今天将介绍其背后的算法原理。在这里采用了动态窗口法(Dynamic Window Approach)。

在机器人系统(ROS)里面,通过计算,给出避障的最佳速度v和角速度w,就可以控制机器人的运动。


01算法


在机器人系统(ROS)里面,通过计算,给出避障的最佳速度v和角速度w,就可以控制机器人的运动。


那小车如何进行避障运动了?小车该以何(v,w)进行运动?这就要对(v,w)进行采样。有了速度和角速度,根据上面的公式就可以推算出一定时间内小车的轨迹,并对轨迹进行评价,如果在预测轨迹下,小车与障碍物相碰,那么这对采样点(v,w)便是不可行的。接下来就是要确定v, w的采样空间。


对区间取交集就能确定采样空间,且这个空间是动态变化的,所以称之为动态窗口法。


有了采样空间,便可对v,w进行采样,并预测一定时间DT内的轨迹,然后对每一条轨迹进行评价,找出一条最优的轨迹进行局部规划。

选择最优的(v,w)进行下一步运动。


02算法测试






DWA算法测试动态展示

▼更多精彩推荐,敬请关注我们▼


您可能也对以下帖子感兴趣

文章有问题?点此查看未经处理的缓存