| 基于声呐图像的深海采矿车组合定位导航算法 |
| |
| 引用本文： | 章慧颖,杨建民,徐文豪.基于声呐图像的深海采矿车组合定位导航算法[J].海洋工程,2023,41(5):169-180. |
| |
| 作者姓名： | 章慧颖 杨建民 徐文豪 |
| |
| 作者单位： | 1.上海交通大学 三亚崖州湾深海科技研究院，海南 三亚 572024；2.上海交通大学 海洋工程国家重点实验室，上海 200240；3.上海交通大学 海洋装备研究院，上海 200240 |
| |
| 基金项目： | 上海市战略性新兴产业重大项目（BH3230001）；海南省科技计划三亚崖州湾科技城自然科学基金联合资助项目（2021JJLH0001） |
| |
| 摘 要： | 实现高精度的定位导航是深海采矿车完成海底工作任务的基础条件。在采矿车行进过程中，声呐设备生成的图像信息能够反映海底场景的变化，从而体现采矿车本身的运动，由此建立了一种声呐图像里程计，并将其与轮式里程计和USBL测量数据相结合提出了一种深海采矿车组合定位导航算法。首先对多波束前视声呐图像进行预处理，然后使用Canny算法进行特征检测并对特征点云进行配准，再结合声呐成像原理构建了声呐图像里程计运动模型，最后通过轮式里程计运动模型推导预测方程、声呐图像里程计运动模型和USBL测量数据推导更新方程，利用EKF（extended Kalman filter）算法实现基于多传感器融合的定位与姿态估计。海试数据验证了该组合定位算法能实现轮式里程计、声呐里程计和超短基线在速度、位置、艏向角估计、定位速率的精度互补，具有一定的有效性和精确性，该算法为深海采矿车的定位与导航算法研发提供了参考。
|
| 关 键 词： | 深海采矿车 定位 声呐图像 扩展卡尔曼滤波器 海上试验 |
| 收稿时间： | 2022/9/14 0:00:00 |
| 修稿时间： | 2023/1/9 0:00:00 |
Integrated localization and navigation algorithm for deep-sea mining vehicles based on sonar image |
| |
| ZHANG Huiying,YANG Jianmin,XU Wenhao.Integrated localization and navigation algorithm for deep-sea mining vehicles based on sonar image[J].Ocean Engineering,2023,41(5):169-180. |
| |
| Authors: | ZHANG Huiying YANG Jianmin XU Wenhao |
| |
| Abstract: | The high-precision positioning and navigation is the basic condition for the deep-sea mining vehicle to complete the submarine work. In the process of the mining vehicle, the image information generated by the sonar can reflect the changes of the seabed scene, so as to reflect the movement of the mining vehicle itself. Therefore, a sonar image odometer is established, and a combined positioning and navigation algorithm of deep-sea mining vehicle is proposed by combining it with the wheel odometer and USBL measurement data. Firstly, multi-beam sonar images are preprocessed, then Canny algorithm is used for feature detection and feature point clouds are registered, and then the motion model of sonar image odometer is established based on sonar imaging principle. Finally, the prediction equation is derived from the motion model of the wheel odometer, the update equation is derived from the motion model of the sonar image odometer and USBL measurement data, and the localization and pose estimation based on multi-sensor fusion are realized by using EKF (extended Kalman filter) algorithm. Using data from the sea trial, it is verified that this integrated algorithm can realize the accuracy complementarity of the wheel odometer, the sonar image odometer and ultra-short baseline in speed, position, heading angle estimation and positioning rate, and has certain effectiveness and accuracy, which provides a reference for the research and development of the deep-sea mining vehicle localization and navigation algorithm. |
| |
| Keywords: | |
|
| 点击此处可从《海洋工程》浏览原始摘要信息 |
| 点击此处可从《海洋工程》下载免费的PDF全文 |
|
