系统工程与电子技术 ›› 2019, Vol. 41 ›› Issue (7): 1606-1616.doi: 10.3969/j.issn.1001-506X.2019.07.23

• 制导、导航与控制 • 上一篇    下一篇

基于干扰观测的欠驱动无人艇自适应航迹跟踪控制算法

董蛟1,刘忠1,张建强1,陈霄2,周德超1   

  1. 1. 海军工程大学兵器工程学院, 湖北 武汉 430000;
    2. 军事科学院战争研究院, 北京 100850
  • 出版日期:2019-06-28 发布日期:2019-07-09

Adaptive course tracking control of underactuated USV based on disturbance observation

DONG Jiao1,LIU Zhong1,ZHANG Jianqiang1,CHEN Xiao2,ZHOU Dechao1   

  1. 1. College of Weaponry Engineering, Naval University of Engineering, Wuhan 430000, China;
    2. War Research Institute, Military Academy of Sciences, Beijing 100850, China
  • Online:2019-06-28 Published:2019-07-09

摘要: 研究了欠驱动无人艇在外界干扰条件下的航迹跟踪控制问题,提出了一种基于干扰估计与补偿的航迹跟踪控制算法,实现了风浪流干扰环境下航迹的精确跟踪。算法引入纵向误差作为状态变量对扩张干扰观测器进行设计,实时估计干扰的稳态分量,相比于传统的基于输出反馈干扰估计算法,其灵活性、可控性更高;同时基于纵向跟踪误差的状态估计误差,设计扩张干扰观测器变增益因子,相比于基于常增益观测器的航迹跟踪算法其能够在实现干扰补偿的前提下,有效减小航迹跟踪收敛段的震荡。基于李雅普诺夫稳定性理论证明了级联控制系统与干扰观测系统在平衡点的半全局指数稳定性,通过仿真对比实验及分析证明了所提航迹跟踪算法的有效性和先进性。

关键词: 欠驱动, 无人艇, 变增益, 扩张干扰观测器, 变前视距离, 积分视线导引, 航迹跟踪

Abstract: In order to ensure accurate course tracking of underactuated unmanned surface vessels (USV) under wind, wave and flow interference, a course tracking control algorithm based on disturbance estimation is proposed. Compared with the traditional output feedback interference estimation algorithm, the extended disturbance observer is more flexible and controllable, which is designed by the longitudinal error as the state variable. At the same time, the variable gain is designed based on the state estimation error of the longitudinal tracking error. Compared with the constant gain observer, it can effectively reduce the oscillation of course tracking when realizing the disturbance compensation. Based on the theory of Lyapunov and the cascade system, the semi global exponential stability of the control system and the interference observation system is proved. The effectiveness and advancement of the algorithm are proved by simulation and comparison experiments.

Key words: underactuated, unmanned surface vessels (USV), variable gain, extended observer, variable line of sight (LOS), integral LOS (ILOS), course tracking