
基本信息:
- 专利标题: 基于UnscentedFastSLAM算法的AUV自主导航方法
- 专利标题(英):Autonomous navigation method of AUV (Autonomous Underwater Vehicle) based on Unscented FastSLAM (Simultaneous Localization and Mapping) algorithm
- 申请号:CN201710717024.2 申请日:2017-08-21
- 公开(公告)号:CN107589748A 公开(公告)日:2018-01-16
- 发明人: 曾庆军 , 王倩
- 申请人: 江苏科技大学
- 申请人地址: 江苏省镇江市梦溪路2号
- 专利权人: 江苏科技大学
- 当前专利权人: 江苏科技大学
- 当前专利权人地址: 江苏省镇江市梦溪路2号
- 代理机构: 南京经纬专利商标代理有限公司
- 代理人: 楼高潮
- 主分类号: G05D1/06
- IPC分类号: G05D1/06
The invention discloses an autonomous navigation method of an AUV (Autonomous Underwater Vehicle) based on a FastSLAM (Simultaneous Localization and Mapping) algorithm. The autonomous navigation method comprises the steps that 1) the AUV acquires initial pose and position information through the GPS and a navigation sensor on the water surface; 2) predicting the pose and position and an environmental road sign of the AUV by adopting unscented particle filtering according to latest control variables inputted into the AUV and observation variables of the sensor; 3) generating a proposal distribution function for parameter adaptive adjustment by adopting fading adaptive unscented particle filtering, and sampling in the proposal distribution function; 4) associating the latest observation environment information according to each particle, and updating estimation for each characteristic by adopting unscented Kalman filtering; 5) performing resampling on a particle set by adopting an adaptive partial system resampling method; and 6) performing AUV positioning and map building. The autonomous navigation method can improve the particle sampling efficiency of the Unscented FastSLAM algorithm and reduce the degradation degree of the particles through improving the proposal distribution function and the resampling process of the Unscented FastSLAM algorithm, thereby enabling the consistency of AUV pose and position estimation and the accuracy of autonomous navigation to be greatly improved.
IPC结构图谱:
G | 物理 |
--G05 | 控制;调节 |
----G05D | 非电变量的控制或调节系统 |
------G05D1/00 | 陆地、水上、空中或太空中的运载工具的位置、航道、高度或姿态的控制,例如自动驾驶仪 |
--------G05D1/02 | .二维的位置或航道控制 |
----------G05D1/06 | ..高度或深度的变化率 |