未知复杂环境下融合卡尔曼滤波和改进DWA的动态避障方法
作者单位:

陕西科技大学

中图分类号:

TP242???????

基金项目:

陕西省重点研发计划项目(2023-YBGY-277);陕西省重点研发计划项目(2023-YBGY-409);陕西省技术创新引导专项(2023GXLH-071)(Project(2023-YBGY-277)supported by Key Research and Development Program of Shaanxi Province;Project(2023-YBGY-409)supported by Key Research and Development Program of Shaanxi Province;


Dynamic obstacle avoidance method integrating Kalman Filter and improved DWA in unknown complex environments
Author:
Affiliation:

1.Shaanxi University of Science &2.Technology

  • 摘要
  • | |
  • 访问统计
  • |
  • 参考文献 [25]
  • |
  • 相似文献
  • |
  • 引证文献
  • | |
  • 文章评论
    摘要:

    针对移动机器人在未知复杂环境下难以有效规避动态障碍物的问题,提出了一种融合卡尔曼滤波和改进动态窗口的避障方法。首先,利用卡尔曼滤波算法根据动态障碍物的实时位置信息预测其运动趋势,并结合其实际位置对预测点进行膨胀处理,避免因移动机器人与障碍物预测轨迹交叉而产生碰撞;接着,为解决在避障过程中可能发生的因移动机器人与动态障碍物同步运动而导致的局部最优问题,引入了方向角函数作为新的评价子函数,以提升目标点的对侧轨迹的评分,增加避障方向的选择;此外,针对因权重分配不合理而导致的无法到达目标点或靠近目标点时的轨迹震荡问题,提出根据移动机器人与动态障碍物的角度差,自动调整方向角函数的权值的方法,以适应环境的动态变化。最后,将卡尔曼滤波与改进的动态窗口算法相融合,实现移动机器人事先根据障碍物的运动趋势提前规划运动轨迹,提升避障安全性。仿真和实验运行结果表明,所提算法能够有效避开未知复杂环境中各类动态障碍物并避免陷入动态局部最优。

    Abstract:

    Aiming at the challenge of mobile robots struggling to effectively avoid dynamic obstacles in unknown and complex environments, an obstacle avoidance method that integrates Kalman filtering and an improved Dynamic Window Approach (DWA). First, the Kalman filter algorithm is utilized to predict the motion trends of dynamic obstacles based on real-time position data. The predicted points are then expanded in conjunction with the actual positions of the obstacles, preventing collisions caused by intersections between the robot’s trajectory and the predicted obstacle path. Next, to address the local optimal problem that may arise when the robot and dynamic obstacles move synchronously during avoidance, a new evaluation function based on the angular direction is introduced. This function improves the scoring of the opposite side of the target trajectory, providing more options for avoidance directions. Additionally, to overcome the issue of trajectory oscillation near the target point due to unreasonable weight distribution, an adaptive method is proposed to automatically adjust the weight of the angular direction function based on the angle difference between the robot and dynamic obstacles, thereby adapting to environmental dynamic changes. Finally, the fusion of Kalman filtering with the improved DWA enables the mobile robot to plan its motion trajectory in advance based on the predicted motion trends of obstacles, enhancing the safety of obstacle avoidance. Simulation and experimental results demonstrate that the proposed algorithm can effectively avoid various dynamic obstacles in unknown and complex environments and prevent the robot from becoming trapped in dynamic local minima.

    参考文献
    [1] 田箫源,董秀成.基于改进DQN的移动机器人避障路径规划[J].中国惯性技术学报,2024,32(4):406-416.
    TIAN Xiaoyuan,DONG Xiucheng. Obstacle avoidance path planning of mobile robot based on improved DQN[J].Jour-nal of Chinese Inertial Technology,2024,32(4):406-416.
    [3] [2]陈艺文,江文松,杨力,等.基于运动约束的移动机器人路径规划[J].计算机集成制造系统,2023,29(4):1186-1193.
    CHEN Yiwen,JIANG Wensong,YANG Li, et al. Path planning based on motion constraints for mobile robot[J].Computer Integrated Manufacturing Systems ,2023,29(4):1186-1193.
    [5] [3]刘建娟,薛礼啟,张会娟,等.融合改进A*与DWA算法的机器人动态路径规划[J].计算机工程与应用,2021,57(15):73-81.
    LIU Jianjuan,XUE Liqi,ZHANG Huijuan,et al.Robot Dynamic Path Planning Based on Improved A* and DWA Algorithm[J].Computer Engineering and Applications,2021,57(15):73-81.
    [7] [4]张可琨,鲍久圣,艾俊伟,等.基于改进A*与DWA算法的井下搬运机器人自主行走路径规划[J].煤炭科学技术,2024,52(11):197?213.
    ZHANG Kekun,BAO Jiusheng,AI Junwei,et al. Autonomous walking path planning of underground handling ro-bot based on improved A* and DWA algorithm[J]. Coal Science and Technology,2024,52(11):197?213.
    [9] [5]常路,单梁,戴跃伟,等.未知环境下基于改进DWA的多机器人编队控制[J].控制与决策,2022,37(10):2524-2534.
    CHANG Lu,SHAN Liang,DAI Yue-wei,et al.Multi-robot formation control in unknown environment based on improved DWA[J].Control and Decision,2022,37(10):2524-2534.
    [11] [6]Wang Z ,Im N. Enhanced artificial potential field for MASS’s path planning navigation in restricted waterways[J].Applied Ocean Research,2024.
    [12] [7]Li H ,Wang X ,Soares G C, et al. A collision-avoidance decision-making scheme based on artificial potential fields andevent-triggered control[J].Ocean Engineering,2024,306,118101-.
    [13] [8]Tang X ,Pei H ,Zhang D. Path Planning for a Wheel-Foot Hybrid Parallel-Leg Walking Robot[J].Sensors,2024,24(7):
    [14] [9]Xu D ,Yang J ,Zhou X,et al.Hybrid path planning method for USV using bidirectional A* and improved DWA considering the manoeuvrability and COLREGs[J].Ocean Engineering, 2024,298,117210-.
    [15] [10]Lin C ,Liu Y ,Lin S. An adaptive dynamic window approach for UUV obstacle avoidance planning in 3D environme nts[J].Journal of Physics: Conference Series,2024,2704(1):
    [16] [11]Lin Z,Taguchi R.Faster Implementation of The Dynamic Window Approach Based on Non-Discrete Path Representation[J].Mathematics,2023,11(21):
    [17] [12]Fox D, Burgard W, Thrun S. The dynamic window approach to collision avoidance[J]. IEEE Robotics & Automation Magazine, 1997, 4(1): 23-33.
    [18] [13]陈肯,赵慧,蒋林,等.动态障碍物环境下的扫地机器人路径规划[J].传感器与微系统,2024,43(7):153-156.
    CHEN Ken,ZHAO Hui,JIANG Lin,et al.Path planning of sweeping robot in dynamic obstacle environment[J].Transducer and Microsystem Technologies,2024,43(7):153-156.
    [20] [14]李娟,张子浩,张宏瀚.复杂环境下DWA与RRT算法融合的AUV局部路径规划[J].智能系统学报,2024,19(4):961-973.
    LI Juan,ZHANG Zihao,ZHANG Honghan.Local path planning for AUV with fusion of DWA and RRT algorit hms in a complex environment[J]. CAAI transactions on intelligent systems, 2024, 19(4): 961–973
    [22] [15]JIAZHE FAN, NA HUANG, DI HUANG, et al. An Improved Path Planning Algorithm With Adaptive Parameters and Predictions[J]. 2023,17(3):4911-4921.
    [23] [16]刘宇庭,郭世杰,唐术锋,等.改进A*与ROA-DWA融合的机器人路径规划[J].浙江大学学报(工学版),2024,58(2):360-369.
    LIU Yuting,GUO Shijie,TANG Shufeng,et al. Path planning based on fusion of improved A* and ROA-DWA for robot[J].Journal of Zhejiang University(Engineering Science),2024,58(2):360-369.
    [25] [17]LYU Xu, Meng Z Y, Li C Y, et al. A dual adaptive unscented Kalman filter algorithm for SINS-based integrated navigation system[J]. 系统工程与电子技术(英文版),2024,35(3):732-740.
    相似文献
    引证文献
引用本文
相关视频

分享
文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:2025-02-17
  • 最后修改日期:2025-02-24
  • 录用日期:2025-03-24
文章二维码