具体实施方式

以下将结合本发明实施例中的附图1～附图2，对本发明实施例中的技术方案、构造特征、所达成目的及功效予以详细说明。

需要说明的是，附图采用非常简化的形式且均使用非精准的比例，仅用以方便、明晰地辅助说明本发明实施方式的目的，并非用以限定本发明实施的限定条件，故不具技术上的实质意义，任何结构的修饰、比例关系的改变或大小的调整，在不影响本发明所能产生的功效及所能达成的目的下，均应仍落在本发明所揭示的技术内容能涵盖的范围内。

需要说明的是，在本发明中，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者设备不仅包括明确列出的要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者设备所固有的要素。

本发明提供了一种具有横摇约束的欠驱动船舶航向制导方法，如图1和图2所示，该欠驱动船舶航向制导方法包括如下步骤：

步骤S1、设定路径(x_p(ω),y_p(ω))和路径参数ω。

其中，步骤S1所述的路径参数ω是时间t的函数，该路径参数ω由如下更新规律公式计算获得：

式(1)中，u为橫荡速度，ψ为航向角，α_p(ω)为路径切向角，x_e为切向跟踪误差，x′_p(ω)为x_p(ω)对ω的导数，y′_p(ω)为y_p(ω)对ω的导数，k为设计的正常数，为ω对时间t的导数；(x_p(ω),y_p(ω))为构成路径的点的坐标；

进一步，路径切向角α_p(ω)由如下公式计算：

步骤S2、根据步骤S1获取t时间的路径点坐标(x_p,y_p)信息和t时间的路径切向角α_p信息。

步骤S3、根据GPS全球定位系统测量获得t时间的船舶位置坐标(x,y)信息，并通过安装在船舶上的陀螺仪获得t时间的船舶运动状态信息。

其中，步骤S3所述的船舶运动状态信息包括纵荡速度u、横摇角φ、航向角ψ、横摇角速度p和航向角速度r。

进一步地，船舶运动状态与船舶位置的关系由四自由度运动学耦合模型描述，具体如下：

式(3)中，为船舶位置坐标(x,y)分别对时间t的导数，v为纵荡速度，u 为橫荡速度，为横摇角φ对时间t的导数，为航向角ψ对时间t的导数。

步骤S4、根据步骤S3所获得的船舶位置坐标信息和船舶运动状态信息估计横向漂角，具体包括如下步骤：

步骤S401、根据船舶位置坐标(x,y)信息，计算切向跟踪误差x_e和垂向跟踪误差y_e，其计算公式如下：

步骤S402、根据步骤S401中的切向跟踪误差x_e和垂向跟踪误差y_e计算横向漂角β的估计值

其中，步骤S402所述的横向漂角β的估计值采用如下公式计算：

式(5)中，为g的估计。

进一步地，所述的可由降阶观测器的方法计算获得，降阶观测器公式如下：

式(6)中，M为虚拟状态，为M对时间t的导数，k₁为设计的正常数，为α_p对时间t的导数。

步骤S5、根据步骤S1～步骤S4所获取的路径切向角α_p、横向漂角β的估计值和垂向跟踪误差y_e，计算指令航向角ψ_d。

其中，步骤S5中所述的指令航向角ψ_d采用如下公式计算：

式(7)中，Δ为前视距离，通常为船长的2到3倍。

根据步骤S5计算获得的指令航向角ψ_d，使船舶航向角ψ获得能够进行跟踪的指令航向角ψ_d，即船舶可以根据指令航向角ψ_d调整船舶航行方向，实现船舶航向控制，完成船舶航向制导。

综上所述，与现有欠驱动船舶航向制导方法相比，本发明所提供的具有横摇约束的欠驱动船舶航向制导方法由于考虑了恶劣海况下欠驱动船舶大幅横摇运动对航向角及航向制导规律的影响能够有效提高恶劣海况下的指令航向角精度等优势。

尽管本发明的内容已经通过上述优选实施例作了详细介绍，但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后，对于本发明的多种修改和替代都将是显而易见的。因此，本发明的保护范围应由所附的权利要求来限定。