[发明专利]一种高精度轨迹跟踪控制方法

说明书

本发明公开了一种高精度轨迹跟踪控制方法，该方法是将船舶的位置和舵角分别反馈给视线瞄准导航算法和GPC控制器，视觉计算出期望航向角，GPC控制器跟踪该航向角，得到指令舵角；视觉导航算法可根据设定模仿人的视觉特征，根据距离的远近来跟踪期望的点，再根据自身的位置，可得出期望航向角；本发明利用GPC的多步预测、滚动优化、反馈校正的优势，设计一个GPC控制器，对由视觉输出的航向角进行跟踪，计算出船舶的指令舵角，实现对船舶轨迹的高精度跟踪。

技术领域

本发明涉及本发明属于船舶轨迹跟踪控制领域，具体地说是一种高精度航迹跟踪控制方法。

背景技术

在船舶运动控制领域，船舶的高精度轨迹跟踪控制一直是重点研究的课题；船舶轨迹跟踪的核心是航向控制；视线法(LOS)导航算法作为一种经典的目标跟踪方法，是利用了点与点之间简单的几何关系判断可视性；它具有简单直观、参数整定容易、收敛性好的优点。该算法独立于动力学控制器，需要设计的参数少，期望航向的获取只与实际位置和给定轨迹有关，可以高效地获取期望航向角；但仅有LOS得到的航向角，只能使轨迹收敛于预设轨迹，而无法获得航行时需要的精确指令舵角，不能保证轨迹跟踪的精度。

对于高精度轨迹跟踪，其中最为关键的技术问题是航向控制。当前，控制技术和计算机技术发展迅速，但是在高精度轨迹跟踪方面缺乏相应的研究，在用先进控制方法做控制器实现高精度轨迹跟踪等方面缺乏相应的技术支撑和应用。

发明内容

本发明的目的在于克服以上所述的缺点，提供一种高精度轨迹跟踪控制方法。

为实现上述目的，本发明的具体方案如下：包括如下步骤，

a1、确定船舶的位置信息及舵角信息；

a2、将位置信息及舵角信息赋值于视线瞄准导航算法，通过视线瞄准导航算法得出期望航向角；

a3、包括一GPC控制器，通过确定的船舶位置信息及舵角信息以及期望航向角传输至GPC控制器；

a4、GPC控制器持续跟踪期望航向角得出指令舵角，实现高精度轨迹跟踪控制。

所述视线瞄准导航算法包括：

以坐标原点为起点，指向点(x,y)的射线在坐标平面上与x轴正方向的夹角为LOS角；定义四象限反正切计算，该角角度为arctan(y,x)∈(-π,π)；地球坐标系下，假设船舶当前的位置为P＝[x,y]，LOS的位置为P_los＝[x_los,y_los]，利用船舶的位置和期望轨迹，计算获得期望航向；

LOS角具体为:

GPC控制器持续跟踪期望航向角得出指令舵角，具体方法如下：

a、根据已建立的船舶模型中多项式系数A和B,可得到预测输出:

其中ψ为航向,δ为舵角,e为外部白噪声,d+1为系统的纯滞后；

b、由下式递推计算p步航向预测输出,构成向量ψ_m:

其中k＝1,…,p；p为预测步长；

c、实际操船要求航向近似于一阶惯性系统并逐步逼近设定值ψ_s；考虑系统的滞后,由下式递推计算p-d步参考轨迹,构成向量ψ_r,其中α为柔化系数,

d、取目标函数为: