上海交通大学学报

• •    

用于圆周合成孔径声呐成像的无人船圆周运动精准控制方法(网络首发)

  

  1. 1.汉江国家实验室;2.上海船舶电子设备研究所
  • 基金资助:
    汉江国家实验室基金资助项目(ZC2023010)

A Precise Control Method for Circular Motion of Unmanned Surface Vehicle Used for Circular Synthetic Aperture Sonar Imaging

  1. (1. Hanjiang National Laboratory, Wuhan 430061, China;2. Shanghai Marine Electronic Equipment Research Institute, Shanghai 201108, China)

摘要: 圆周合成孔径声呐通过对成像场景作360°圆周运动获得目标全方位观测信息,以实现水下目标三维高精度成像,其成像效果受无人搭载平台的圆周运动误差影响较大。针对这一问题,根据圆周路径推导设计了基于向心加速度的圆周运动非线性制导算法(Centripetal Acceleration based Nonlinear Guidance for Circular,CANGC),对圆周轨迹贴合度高,具有较高的控制精度。此外,还设计了基于模型预测控制算法的圆周运动控制律,具有较快的控制响应和较强的自适应能力。将两种算法较好地融合,可实现精准圆周轨迹跟踪。其中制导律的控制输出为偏航角速度,因此控制过程中不依赖于无人船磁力计测得的偏航角数据,可以在具有较强磁场影响的条件下使用。通过仿真实验验证了算法的优越性,本文所设计的算法跟踪精度比文献中的算法的跟踪精度高80.1%。通过湖上实验进一步验证算法效果,对于圆周运动有较高的控制精度。研究成果为圆周合成孔径声呐成像无人船平台研究提供了算法基础。

关键词: 无人船, 圆周合成孔径, 声呐成像, 圆周运动控制, 模型预测控制

Abstract: Circular synthetic aperture sonar obtains all-round observation information of underwater targets by performing 360 ° circular motion on the imaging scene, in order to achieve high-precision three-dimensional imaging of underwater targets. Its imaging effect is greatly affected by the circular motion error of unmanned platforms. To address this issue, a centripetal acceleration based nonlinear guidance for circular was designed based on the derivation of the circular path, which has a high degree of fit to the circular trajectory and high control accuracy. In addition, a circular motion control law based on MPC algorithm has been designed, which has fast control response and strong adaptive ability. Integrate the two algorithms well to achieve accurate circular trajectory tracking. The control output of the guidance law is yaw rate, so the control process does not rely on the yaw angle data measured by the USV magnetometer and can be used under conditions with strong magnetic field influence. The superiority of the algorithm was verified through simulation experiments, and the tracking accuracy of the algorithm designed in this paper is 80.1% higher than that of the algorithm described in reference. Further verification of the algorithm's effectiveness through lake experiments shows high control accuracy for circular motion. The research results can provide a control algorithm basis for the circular motion of unmanned ships used for circular synthetic aperture sonar imaging. The research results provide an algorithmic basis for the research of unmanned ship platforms used for circular synthetic aperture sonar imaging.

Key words: Unmanned Surface Vehicle (USV), Circular Synthetic Aperture, Sonar Imaging, Circular motion control, Model Predictive Control (MPC)

中图分类号: