融合VO和DWA的无人潜航器三维空间避障研究OA
3D obstacle avoidance for unmanned underwater vehicles by fusing VO and DWA
针对现有无人潜航器(UUV)在复杂海洋环境中自主避障效率较低的问题,本文提出一种融合速度障碍法(VO)与动态窗口法(DWA)的三维避障算法.首先,引入碰撞圆锥体和极坐标系,并开发了适用于碰撞圆锥体的碰撞检测方法,从而将原本局限于二维平面的速度障碍法与动态窗口法扩展至三维空间.其次,通过设定UUV的探测球范围,将进入该区域的障碍物区分为动态与静态两类,分别采用碰撞圆锥体和极坐标运动模型进行碰撞检测,并筛选出可行轨迹集合.最后,通过评价函数从可行轨迹中选取最优路径,循环执行该过程,实现UUV的高效避障.三维仿真实验表明,采用该融合算法的UUV能够实现零碰撞避障.在全动态障碍物场景中,其轨迹长度相较于速度障碍法减少5.78%,任务完成时间较动态窗口法缩短16.91%,且算法运行耗时更少.所提算法对提升无人潜航器在复杂环境中的自主避障能力具有一定的参考价值.
To address the low efficiency of existing Unmanned Underwater Vehicles(UUVs)in autonomous obsta-cle avoidance within complex marine environments,this paper proposes a three-dimensional(3D)obstacle avoid-ance algorithm that integrates the Velocity Obstacle(VO)method and the Dynamic Window Approach(DWA).First,a collision cone and a polar coordinate system are introduced,and a corresponding collision detection method is developed.This extends both the VO and DWA methods,originally designed for two-dimensional space,into three dimensions.Second,by defining the range of a detection sphere around the UUV,obstacles entering this region are classified as dynamic or static.Collision detection is then performed using the collision cone and polar coordinate motion models,respectively,to generate a set of feasible trajectories.Finally,an evaluation function selects the opti-mal path from these candidates.This process iterates in real time to enable efficient obstacle avoidance.Three-di-mensional simulation experiments demonstrate that the UUV using this fusion algorithm successfully avoids all colli-sions.In a fully dynamic obstacle scenario,the proposed method reduces the trajectory length by 5.78%compared to the pure VO method and shortens the task completion time by 16.91%compared to the pure DWA method,while also requiring less computational runtime.The proposed algorithm offers valuable insights for enhancing the autono-mous obstacle avoidance capability of UUVs in complex underwater environments.
吴穹;巩在武;张永垂
南京信息工程大学网络信息中心,南京,210044||南京信息工程大学管理工程学院,南京,210044南京信息工程大学管理工程学院,南京,210044国防科技大学气象海洋学院,长沙,410073
交通工程
无人潜航器动态窗口法速度障碍法三维空间避障算法
unmanned underwater vehicle(UUV)dynamic window approach(DWA)velocity obstacle(VO)3D obstacle avoidance algorithm
《南京信息工程大学学报》 2026 (3)
372-382,11
国家自然科学基金(72371137)
评论