第 34 卷第 6 期
哈 尔 滨 工 程 大 学 学 报
Vol.34 №.6
2013 年 6 月
Journal of Harbin Engineering University
Jun.2013
非 精 确 导 航 信 息 下 UUV 路 径 规 划
严浙平,赵玉飞,陈涛,迟冬南
(哈尔滨工程大学 自动化学院,黑龙江 哈尔滨 150001)
摘 要:在 UUV(unmanned underwater vehicle)路径规划过程中,水下导航误差的增加使 UUV 与障碍之间的安全区域逐
渐减少,这影响了自由路径的选择.提出了一种基于 A
*
算法并结合非精确导航信息的全局路径规划方法,先建立了基于
高斯分布导航误差模型,由此构建位置和导航误差的不确定规划空间,将非精确导航信息转化为未知环境信息.同时考
虑路径长度和航行安全性的约束条件,提出了在最大容许导航误差下的路径长度最短的目标代价函数.采用蒙特卡罗模
拟采样法近似导航误差分布,获取了相邻节点间的期望代价,并运用改进的 A
*
算法搜索最优路径.数字海洋环境仿真表
明所提出的规划算法简便、快速,生成的路径安全可行.
关键词:UUV;非精确导航;路径规划;蒙特卡罗模拟;A
*
算法
doi:10.3969/j.issn.1006-7043.201209013
网络出版地址:http://www.cnki.net /kcms/detail /23.1390.U.20130530.0922.004.html
中图分类号:U674.941 TJ630 文献标志码:A 文章编号:1006-7043(2013)06-0715-06
UUV path planning with inaccurate navigation information
YAN Zheping, ZHAO Yufei, CHEN Tao, CHI Dongnan
(College of Automation, Harbin Engineering University, Harbin 150001, China)
Abstract:In the path planning of an unmanned underwater vehicle(UUV), the increase of underwater navigation
error gradually decreases the free space between the UUV and obstacles, making it difficult to search the free path.
A global path planning based on A
*
algorithm with inaccurate navigation information has been proposed.Firstly the
navigation error model based on Gauss distribution was built, then the uncertainty planning space was built inclu-
ding the position and navigation error, which translate the inaccurate navigation information into the uncertain envi-
ronment.A shortest path was set as the objective cost function with the upper bound of the navigation error, to guar-
antee lower voyage and higher security.The Monte Carlo simulation was used to calculate the expected traversal cost
between the adjacent nodes by simulating the navigation error distribution.In the end, A
*
based algorithm was ap-
plied in searching the optimal path.Simulation verification was carried out with the digital ocean environment, and
the results illustrate the proposed approach was simple and fast, and the posed path was feasible for trail.
Keywords:unmanned underwater vehicle;inaccurate navigation;path planning;Monte Carlo simulation;A
*
algorithm
收稿日期: 2012-09-06. 网络出版时间:2013-5-30 9:22.
基金项目:国家自然科学基金资助项目( 51179038);新世纪优秀人才
计划资助项目( NCET-10-0053) ;中央高校基本科研业务费
专项基金资助项目( HEUCF041323).
作者简介:严浙平( 1972-) , 男, 教授, 博士生导师.
通信作者:严浙平,E-mail: yanzheping@hrbeu.edu.cn.
水下无人航行器( UUV) 在水下执行使命任务
时,存在导航不确定性.UUV 导航设备主要以惯性
导航系统为主,辅以多普勒测速仪( DVL),深度计
和 GPS 等设备
[ 1 -2]
,如果舰位推算过程中未进行导
航校正,其导航误差将随着航行时间而累积增大,这
是无法避免的客观事实
[ 3]
.当前大多数全局路径规
划都是以精确导航信息为前提,即假设在精确导航
信息的导引下能够精准地跟踪预先规划的几何路
径.但由于导航不确定性的存在,随着导航误差的增
大,UUV 与真实障碍之间的安全区域势必不断减
少
[ 4 ]
,导致初始位置与目标位置之间的自由路径不
复存在,即使还存在这样的自由路径,很可能会带来
碰撞等不可预知风险.在长远距离航行中,为提高隐
蔽性而不能频繁上浮校准导航的情况下,增大的导
航误差将成为 UUV 运动规划控制中一个不可忽视
的约束条件,研究非精确导航信息下的全局路径规
划问题,对 UUV 实际工程应用将有重要意义.
作为路径规划中一个重要约束条件,对导航误
差等不确定性信息的处理已有多种方法.当观测模