[发明专利]应用于气垫船航向控制与横倾控制的解耦控制装置及方法

说明书

技术领域

本发明涉及了的是一种气垫船的航向横倾解耦控制装置及方法，用于由空气舵和艏喷管所组成的气垫船耦合控制系统。

背景技术

横倾角是全垫升气垫船的重要航行指标，船体做横倾运动时，气垫内高压空气的侧向泄流，会伴有较大的侧漂力，进而造成大角度侧滑。同时，气垫船在航行时，由空气舵提供的转艏力矩也会对横倾角产生影响，而控制横倾角的艏喷管提供的横倾力矩也会对气垫船的艏向产生影响。因此，对于气垫船航行自动驾控系统，为了保证控制精度和安全性，需要对航向、横倾两个方向同时控制，这就需要解决这两个通道耦合的问题。

目前，多通道解耦控制问题还是控制领域的一个难点，很多控制方法都需要有精确的数学模型，这在实际控制中是很难做到的。

发明内容

本发明的目的在于提供一种能提高气垫船的航向控制精度和自动驾控航行的安全性，减轻驾驶人员的工作强度和精神负担，提高操控水平和航行稳定性的应用于气垫船航向控制与横倾控制的解耦控制装置。本发明的目的还在于提供一种应用于气垫船航向控制与横倾控制的解耦控制方法。

本发明的应用于气垫船航向控制与横倾控制的解耦控制装置主要包括微分跟踪器、扩张状态观测器、比较器、航向控制器、横倾控制器和解算模块，微分跟踪器(TD)用于实现对目标信号及其各阶微分信号的光滑逼近，扩张状态观测器(ESO)用于实际航向和橫倾的观测并对外界扰动进行补偿，比较器用于得到航向偏差和横倾偏差，航向控制器用于得到航向通道控制指令，横倾控制器用于得到横倾通道控制指令，解算模块将两个通道的控制指令解耦出来，分别用于执行机构空气舵和艏喷管的控制。

本发明的应用于气垫船航向控制与横倾控制的解耦控制方法包括如下步骤：

(1)设定期望的航向角v_ψ和横倾角

(2)通过扩张状态观测器估计当前状态的航向角及航向角微分值z_ψ1、z_ψ2，横倾角及横倾角微分值

(3)由航向微分跟踪器得到期望航向角的跟踪值和微分值v_ψ1、v_ψ2，由横倾微分跟踪器得到期望横倾角的跟踪值和微分值

(4)由比较器得到航向偏差e_z1、e_z2，横倾偏差

(5)由航向偏差通过非线性误差反馈航向控制器，并经过扩张状态观测器的补偿，得到航道虚拟控制指令U_ψ；由横倾偏差通过非线性误差反馈横倾控制器，并经过扩张状态观测器的补偿，得到横倾控制通道虚拟控制指令

(6)将航道虚拟控制指令U_ψ、横倾控制通道虚拟控制指令通过解算模块B^-1得到实际的航向角控制指令u_ψ、横倾角控制指令

(7)将实际的航向角控制指令u_ψ发送给执行机构空气舵，将实际的横倾角控制指令发送给执行机构艏喷管，如果没有达到期望值则转到步骤(2)。

本发明的气垫船航向控制与横倾控制的解耦控制装置，跟踪微分器安排过度过程，实现对目标信号及其各阶微分信号的光滑逼近，可以最快跟踪航向偏差和横倾偏差；包含了两个控制器，分别对航向控制通道和横倾控制通道进行控制；包含一个解算模块，其输入是航向控制器和横倾控制器的输出，这两个耦合的控制量通过解算模块，得到控制指令分别用于执行机构空气舵和艏喷管的控制。由于两个控制器与解算模块的配合，航向控制通道的控制器通过航向偏差对航向进行控制，横倾控制通道的横倾控制器通过横倾偏差对横倾角进行控制。最终实现一个输入对应一个输出的控制效果。

本发明采用不依赖系统精确模型的自控自抗扰解耦控制算法，借用扩张状态观测器对系统的扰动进行估计，然后进行补偿，以实现航向—横倾的解耦控制。

本发明采用的是自抗扰控制方法，原理如下：

设计虚拟控制律