熊勇, 周思文, 王显飞, 吕志远. 数据驱动的船舶航迹跟踪控制方法研究[J]. 中国舰船研究. DOI: 10.19693/j.issn.1673-3185.03542
引用本文: 熊勇, 周思文, 王显飞, 吕志远. 数据驱动的船舶航迹跟踪控制方法研究[J]. 中国舰船研究. DOI: 10.19693/j.issn.1673-3185.03542
Research on data-driven ship trajectory tracking control method[J]. Chinese Journal of Ship Research. DOI: 10.19693/j.issn.1673-3185.03542
Citation: Research on data-driven ship trajectory tracking control method[J]. Chinese Journal of Ship Research. DOI: 10.19693/j.issn.1673-3185.03542

数据驱动的船舶航迹跟踪控制方法研究

Research on data-driven ship trajectory tracking control method

  • 摘要: 针对存在船舶模型参数未知、外界扰动未知以及舵机约束等问题,提出了一种基于数据驱动的在线辨识船舶参数,迭代解析计算最优控制量的航迹跟踪控制方法。首先,构建了双螺旋桨船的三自由度动力学方程,通过采集船舶的运动数据,设计了扩张状态观测器-多新息递推最小二乘交互式算法,实现了在线辨识船舶运动模型参数和估计未知扰动,降低了辨识算法对实验设计的严格要求。然后,通过将辨识得到的船舶运动模型在采样周期内近似为定常线性模型,船舶航迹跟踪问题可转变成带约束和干扰的线性二次型优化控制问题。接着,引入加权矩阵与罚函数,构建了包含轨迹误差、外界干扰量和控制量约束不等式的二次型性能指标,并运用精细积分法获得矩阵黎卡提微分方程的解析解,得到有限时间状态调节器的迭代计算式。最后,通过采用MATLAB进行数值仿真并分析权重矩阵Q、R和S对航迹跟踪精度的影响,结果验证了参数辨识和控制算法的有效性。

     

    Abstract: Aiming at the problems of unknown ship model parameters, unknown external disturbance and servo constraints, a data-driven online identification of ship parameters and iterative analytical calculation of the optimal control quantity of the track tracking control method is proposed. Firstly, the three degrees of freedom dynamics equation of the double propeller ship was constructed, and the extended state observer-multiple innovation recursive least squares interactive algorithm was designed by collecting the motion data of the ship, which realized the online identification of model parameters and the estimation of unknown disturbances, and reduced the strict requirements of the identification algorithm on the experimental design. Then, by approximating the identified ship motion model to a time-invariant linear model in the sampling period, the ship trajectory tracking problem can be transformed into a linear quadratic optimization control problem with constraints and disturbances. Then, the weighted matrix and penalty function were introduced to construct the quadratic performance index including the trajectory error, external disturbance and control constraint inequality. The analytical solution of the matrix Riccati differential equation was obtained by using the precise integration method, and the iterative calculation formula of the finite-time state regulator was obtained. Finally, by using MATLAB to carry out numerical simulation and analyze the influence of weight matrix Q,Rand S on trajectory tracking accuracy, the results verify the effectiveness of the parameter identification and control algorithm.

     

/

返回文章
返回