[发明专利]一种动力定位船舶循迹导引控制方法

权利要求书

1.一种动力定位船舶循迹导引控制方法，其特征在于包括如下步骤：

（1）选取海平面上任意一点为原点，以正东方向为横轴、正北方向为纵轴，建立大地坐标系EO_EN；然后，以船舶的几何中心为原点，以右舷方向为横轴、船艏方向为纵轴，建立船体坐标系YO_bX；

（2）在大地坐标系和船体坐标系中建立动力定位船舶三自由度船舶高速运动数学模型：

η·=JvMv·+D(v)v+C(v)v=τ]]>

式中，η表示船舶在大地坐标系中位置和艏向向量[n,e,ψ]^Τ；v表示船舶在船体坐标系中线速度和角速度向量[u,v,r]^Τ；τ为推进器产生的力和力矩向量[F_x,F_y,N_z]^Τ；J为从船体坐标到大地坐标的转换矩阵，J=cosψ-sinψ0sinψcosψ0001;]]>M为船舶惯性矩阵，M=m-Xu.000m-Yv.mxg-Yr.0mxg-Nv.Iz-Nr.;]]>m为船舶质量；I_z为转动惯量；x_g为船体坐标系中船舶质心纵向坐标；其他参数均为一阶水动力导数；船舶水动力阻尼项为D(v)=D+D_n(v)；D=-Xu000YvYr0NvNr]]>为线性部分；

Dn(v)=Xu|u||u|000Yv|v||v|+Y|r|v|r|Y|v|r|v|+Y|r|r|r|0Nv|v||v|+N|r|v|r|N|v|r|v|+N|r|r|r|]]>为非线性部分；

C=00-(m-Yv·)v-(mxg-Yr·)r00(m-Xu·)u(m-Yv·)v+(mxg-Yr·)r-(m-Xu·)u0]]>为科里奥利和向心力矩阵；

（3）通过船体设定的路径点和当前时刻船舶的大地坐标位置，获得当前时刻的船舶期望艏向；

（4）利用反步法，根据当前时刻期望艏向ψ_d与船舶的期望速度u_d，计算控制船舶高速循迹所需的纵向力F_x和力矩N_z；

（5）将控制力和力矩传递给动力定位船舶的数学模型，解算下一时刻船舶的状态信息，然后由当前时刻更新到下一时刻；

（6）重复执行步骤（2）--步骤（5），直到最后一条航迹循迹完成。