[发明专利]一种动力定位船自动定点混合控制模式的导引方法

说明书

本发明提供一种动力定位船自动定点混合控制模式的导引方法，混合控制器中速度反馈环的加入，混合控制器能够根据期望位置和LOS导引点得出期望视向点，并得出期望视向点与当前位置的差值，动力定位系统能够输入艏向、纵向和横向方向上的控制命令，根据导引算法可以求出固定坐标系中的期望导引点，经由转换公式计算，求得船体坐标系下的期望船舶位姿，传递至运动控制器来进行控制。本发明方法能够控制船舶位姿，并且能够用操作手柄进行船舶运动的控制，本发明所设计的控制器能够操纵Joystick控制船舶围绕控制点做旋转运动，符合Joystick+Auto SurgeSway模式的要求。

技术领域

本发明属于船舶动力定位控制技术领域，具体为某半潜船自动定点混合控制模式(Joystick+Auto SurgeSway)的导引方法。

背景技术

动力定位是一项在海洋工程中和深海开发中广泛使用的一种技术，目前全世界已经有超过2000艘具有动力定位系统的船舶，动力定位可以通过推进器保持位置和艏向于固定点或设定航迹上，并能够保证控制的精度，灵活有效，尤其是在锚泊受限的深海区，能够展现其强大的优势。目前，动力定位技术已经应用在了海洋铺管、深海吊装、海上钻井、穿梭邮轮、海上补给等多种作业任务。船舶上的动力定位系统极其复杂，与船舶上所有的设备相关，其中比较核心的为推进器系统和运动控制系统。

由于海洋环境极其复杂，推进器的效率也比较低，对船舶进行精确的控制会比较困难。并且近年加大了对海洋深度的探索，船舶的稳定性和控制精度也需要随之提高。因此，能够设计出一个高精度的控制器对于动力定位系统功能的提高有着非常重要的意义。本发明结合LOS导引算法和PID控制方法，推导出某半潜船Joystick+Auto SurgeSway混合控制模式的导引律，以解决混合控制模式下半潜船的路径导引问题。

发明内容

本发明的目的主要针对半潜船的运动控制，因此提出一种动力定位船舶混合控制模式的导引方法，用于混合控制模式下半潜船的路径导引问题，并进行控制船舶位置姿态的仿真分析。

本发明的目的是这样实现的：

设计混合控制器与设计自动控制器有两点区别，第一点为混合控制器中速度反馈环的加入，第二点为混合控制器能够根据期望位置和LOS导引点得出期望视向点，并得出期望视向点与当前位置的差值。

动力定位系统能够输入艏向、纵向和横向方向上的控制命令，根据导引算法可以求出固定坐标系中的期望导引点，经由转换公式计算，求得船体坐标系下的期望船舶位姿，传递至运动控制器来进行控制。本设计方法能够控制船舶位姿，并且能够用操作手柄进行船舶运动的控制。半潜船运动导引律设计思路如下：

第一，半潜船动力学方程如下：

式中：H_Xt、H_Yt、H_Nt——作用在船体上力和力矩；

x_g——船舶重心在x轴方向上的位置坐标。

第二，由公式(1)可以得到船舶的加速度及角加速度，积分可以求得船舶速度，控制器接收反馈信号，并由运动学方程计算固定坐标系下船舶速度，方程如下：

第三，由公式(2)可以得到固定坐标系下在三自由度方向上的船舶速度，积分可以求得船舶在固定坐标系中的位置并向控制器反馈。

第四，由船舶期望位置和船舶实时位姿，求出导引点坐标(N_los,E_los)。

为了计算出未知LOS点的坐标p_los＝(N_los,E_los)，必须满足下面两式：