[发明专利]一种船载稳定平台镇定控制抗饱和方法

说明书

本发明公开了一种船载稳定平台镇定控制抗饱和方法，包括以下步骤：设计船载稳定平台的虚拟控制镇定函数；设计船载稳定平台抗饱和镇定控制律：定义新的误差向量、设计如下辅助动态系统、设计分段连续函数向量、设计船载稳定平台镇定控制律。本发明通过设计新型辅助动态系统，并将其状态向量引入船载稳定平台镇定控制律设计中，可以有效补偿船载稳定平台控制输入饱和的影响，保证存在输入饱和情况下的船载稳定平台镇定控制。本发明设计的基于连续函数向量的辅助动态系统，能够在船载稳定平台输入饱和再次发生时仍具有输入饱和补偿能力。

技术领域

本发明涉及船舶与海洋工程领域的装备控制技术，特别是一种船载稳定平台镇定控制抗饱和方法。

背景技术

船舶受到风、浪、流等海洋环境影响会产生横摇、纵摇、艏摇、横荡、纵荡和升沉六个自由度的运动，严重影响船上设备的作业安全。船舶动力定位系统可抑制船舶的横荡、纵荡和艏摇运动，而船舶的横摇、纵摇和升沉运动需要通过船载稳定平台来隔离其对船上设备的影响，从而使船载稳定平台上支撑面相对惯性空间保持稳定，使船上设备安全平稳作业。

实际中，船载稳定平台由于其执行机构的物理限制，存在输入饱和。由于船载稳定平台的负载的变化、工况突变等原因，船载稳定平台镇定控制系统根据控制算法给出的指令控制输入可能超过其执行机构能够提供的最大控制力，受到输入饱和的影响，船载稳定平台镇定控制的性能会降低，甚至导致镇定控制系统不稳定。因此，研究船载稳定平台镇定控制的抗饱和方法具有重要的现实意义。

中国发明专利CN113031429A公开了一种船载载体稳定平台及控制方法，利用PID控制算法实现船载载体稳定平台的镇定控制。中国发明专利CN109739248A公开了一种基于ADRC的船载三自由度并联稳定平台稳定控制方法，构造扩张状态观测器估计实时估计船载稳定平台动态不确定和海洋环境扰动引起的船舶摇荡运动对平台造成的等效扰动力构成的总扰动，结合PD控制算法设计了船载载体稳定平台镇定控制律，实现了其镇定控制。然而，上述专利均未考虑船载稳定平台控制输入饱和问题。

南京船舶雷达研究所在《雷达与对抗》上发表题为“舰载雷达稳定平台模型参考自适应控制”，考虑船载稳定平台的输入饱和特性，基于自适应技术设计了舰载雷达稳定平台稳定控制律，然而，未对输入饱和进行补偿处理。

中国专利CN105676854A提出了一种三自由度直升机抗饱和姿态跟踪控制方法，设计辅助动态系统补偿了直升机姿态跟踪控制输入饱和的影响。然而，由于所设计的辅助动态系统是非连续的，仅仅在控制输入饱和首次发生时具有补偿功能。

发明内容

为解决现有技术存在的上述问题，本发明要提出一种船载稳定平台镇定控制抗饱和方法，有效补偿船载稳定平台控制输入饱和的影响，且保证船载稳定平台镇定控制输入饱和再次发生时仍具有抗饱和的能力，从而保证存在输入饱和情况下的船载稳定平台镇定控制。

为实现上述目的，本发明的技术方案如下：一种船载稳定平台镇定控制抗饱和方法，所述的船载稳定平台的动力学方程如式(1)所示：

式中，为船载稳定平台上支撑面在惯性坐标系下的位姿，由升沉位移z、橫摇角和纵摇角θ组成，和分别为p的一阶导数和二阶导数；M(p)∈R^3×3为惯性矩阵，为科氏向心力矩阵，G(p)∈R³为重力向量，τ＝[τ₁,τ₂,τ₃]^T为船载稳定平台的控制输入向量，由升沉控制力τ₁、橫摇控制力矩τ₂和纵摇控制力矩τ₃组成。船载稳定平台控制输入饱和的数学描述为：