CN105204339B - 气垫船姿态调节的主动时滞反馈控制方法 - Google Patents
气垫船姿态调节的主动时滞反馈控制方法 Download PDFInfo
- Publication number
- CN105204339B CN105204339B CN201510616596.2A CN201510616596A CN105204339B CN 105204339 B CN105204339 B CN 105204339B CN 201510616596 A CN201510616596 A CN 201510616596A CN 105204339 B CN105204339 B CN 105204339B
- Authority
- CN
- China
- Prior art keywords
- hovercraft
- axis
- attitude
- controller
- control
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims description 12
- 238000006243 chemical reaction Methods 0.000 claims abstract description 18
- 230000003068 static effect Effects 0.000 claims abstract description 11
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 29
- 239000011159 matrix material Substances 0.000 claims description 12
- 230000033001 locomotion Effects 0.000 claims description 7
- 230000007613 environmental effect Effects 0.000 claims description 6
- 230000007246 mechanism Effects 0.000 claims description 6
- 238000013016 damping Methods 0.000 claims description 2
- 241000764238 Isis Species 0.000 claims 1
- 239000013589 supplement Substances 0.000 claims 1
- 230000017105 transposition Effects 0.000 claims 1
- 238000004364 calculation method Methods 0.000 description 4
- 238000005457 optimization Methods 0.000 description 4
- 238000005265 energy consumption Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 238000005299 abrasion Methods 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供的是一种气垫船姿态调节的主动时滞反馈控制装置。包括安装在气垫船四周的水枪、控制器和转换逻辑,气垫船传感器系统得到气垫船姿态信息输入控制器,控制器根据这些信息得到控制器的控制信号,所述控制信号进入转换逻辑、计算出各个水枪所需提供的动力,最后通过水枪对于气垫船的姿态进行调整。本发明实现了气垫船静态姿态的在线调节,改善了惯性时延的影响,具有良好的实时性和鲁棒性。
Description
技术领域
本发明涉及的是一种气垫船的姿态调节方法,特别的是引入水枪和时滞反馈对气垫船静止姿态进行调节的方法。
背景技术
在气垫船静止状态,由于海洋环境的复杂性,风、浪、流的影响,这就使得气垫船难以保持稳定的状态,这就增加了气垫船操纵的难度,也不利于它在静止状态下启动,目前的以公开的文献中并没有相关的成果,而运用水枪对于气垫船的姿态进行主动控制的方式也没有相关的报道。
由于水枪动力所能提供的有限,而气垫船具有较大的惯性,改变气垫船的状态不可避免的会遇到惯性延迟的问题,如果忽略这一问题,会使得气垫船在调节姿态时发生较大的震荡,甚至于存在翻船的危险。
发明内容
本发明的目的在于提供一种使得气垫船在初始的静止状态下能够保持稳定的姿态的气垫船姿态调节的主动时滞反馈控制装置。本发明的目的还在于提供一种气垫船姿态调节的主动时滞反馈控制方法。
本发明的目的是这样实现的:
本发明的气垫船姿态调节的主动时滞反馈控制装置包括安装在气垫船四周的水枪、控制器和转换逻辑,气垫船传感器系统得到气垫船姿态信息输入控制器,控制器根据这些信息得到控制器的控制信号,所述控制信号进入转换逻辑、计算出各个水枪所需提供的动力,最后通过水枪对于气垫船的姿态进行调整。
水枪的发射方向垂直于海平面。
本发明的气垫船姿态调节的主动时滞反馈控制方法为:通过气垫船传感器系统得到气垫船姿态信息,根据所述姿态信息得到控制器的控制信号,所述控制信号进入转换逻辑,计算出安装在气垫船四周的各个水枪所需提供的动力,最后通过作为执行器机构的水枪对于气垫船的姿态进行调整。
本发明的气垫船姿态调节的主动时滞反馈控制方法还可以包括:
1、所述控制器为时滞反馈控制器,控制率τ(t)=Kx(t-d),通过构造合适的Lyapunov-Krasovskii函数和不等式变换,得到控制器条件。
2、所述转换逻辑是运用基于粗糙集的进化计算来进行设计的。
本发明的主要技术特点在于:通过气垫船传感器系统得到气垫船姿态信息,根据这些信息得到控制器的控制信号,该信号进入转换逻辑,计算出各个水枪所需提供的动力,最后通过执行器机构对于气垫船的姿态进行调整。考虑到气垫船姿态调节的惯性延迟,设计了时滞反馈控制器τ(t)=Kx(t-d),通过构造合适的Lyapunov-Krasovskii函数和不等式变换,得到了保守性较低且形式简单的控制器设计条件。运用基于粗糙集的进化计算来进行转换逻辑的设计,优化目标为能耗最小,该方法能够改善一般优化算法的实时性,实现水枪动力分配的在线计算。在气垫船周围装载水枪,对于气垫船的姿态进行主动控制,实现气垫船的姿态调节。
本发明的气垫船姿态调节的主动时滞反馈控制装置及方法,为气垫船装载了水枪、时滞反馈控制器和转换逻辑,解决了气垫船的姿态调节问题。针对气垫船的惯性延迟,设计了时滞反馈控制器,构造了合适的Lyapunov-Krasovskii,经过不等式变化得到了保守性较低且形式简单的控制器的判定条件。利用基于粗糙集的进化算法,实现基于能耗最小的水枪动力分配在线计算。通过分布于气垫船周围的水枪产生动力,主动调节气垫船的姿态。本发明实现了气垫船静态姿态的在线调节,改善了惯性时延的影响,具有良好的实时性和鲁棒性。
附图说明
图1气垫船执行器机构分布。
图2气垫船姿态调节系统方框图。
图3基于粗糙集的进化算法流程图。
具体实施方式
下面举例对本发明做更详细的描述。
通过气垫船传感器系统得到气垫船姿态信息,根据这些信息得到控制器的控制信号,该信号进入转换逻辑,计算出各个水枪所需提供的动力,最后通过执行器机构对于气垫船的姿态进行调整。
1.建立气垫船六自由度模型:
全垫升气垫船的六自由度运动模型为:
其中:
u,——X轴方向的速度,ξ——X轴上的位置
v,——Y轴方向的速度,η——Y轴上的位置
w,——Z轴方向的速度,ζ——Z轴上的位置
p,——绕X轴运动的角速度,——绕X轴的姿态角
q,——绕Y轴运动的角速度,θ——绕Y轴的姿态角
r,——绕Z轴运动的角速度,ψ——绕Z轴的姿态角
表示▽的导数
2.转化为近似的状态空间模型
由于气垫船在姿态调节时为静止状态,受到海洋环境力的影响而产生横摇、纵摇等运动,因而参考浮式海洋平台和船舶动力定位定点作业模型,得到全垫升气垫船在海平面上在海洋环境影响下主动控制的状态空间模型:
其中x=(u v wp q r)T,M=MT>0为带有附加质量的惯性矩阵,D>0为线性阻尼矩阵,S(Ω)为转换矩阵,τ为控制量,S(Ω)为转换矩阵,b 为环境干扰,且环境干扰有界,具体形式为:
控制的目标是为了使得横摇与纵摇都尽量的小,因此我们将横摇和纵摇的姿态角的和作为控制的输出:
y(t)=Cx(t) (3)
其中C=(0 0 0 1 1 0)T
综上所述,得到气垫船的静止状态下的近似的状态空间模型:
其中
3.设计时滞反馈控制器
由于气垫船存在较大的惯性延迟,因此,本发明设计了时滞反馈控制器补偿所产生的时间延迟,控制率设计为:
τ(t)=Kx(t-d) (5)
其中0<d,可以得到闭环系统:
将该气垫船姿态调节方法描述为一个标准的H-infinity控制问题,控制目标设定为:设计时滞反馈控制律(5),使得闭环系统(6)渐近稳定,且在零初始条件下,满足||Tyb||∞<γ,其中 Tyb表示环境干扰到控制输出的闭环传递函数,满足0<γ<∞。
构造Lyapunov-Krasovskii函数:
其中P>0,Q>0
令b(t)=0,将(7)沿(6)微分可得:
式中存在不等式关系:
其中*表示矩阵中对称元素的转置,令χ(t)=(xT(t)xT(t-d))T,则有记(A BK)=Δ
综上所述,(8)可化为:
其中
根据Lyapunov-Krasovskii稳定性理论,当
Π+d2ΔTQΔ<0 (11)
可以保证闭环系统渐近稳定。
然后,将建立保证H-infinity性能的条件,取消b(t)=0的限制,则可得到:
其中Υ=(A BK D),Λ=(C 0 0),
若有
Θ+d2ΥTQΥ+ΛTΛ<0 (13)
则有成立,进而可以得到:
这样就得到了满足闭环系统渐近稳定和H-infinity性能的控制器增益K的判据,根据 Schur补引理结合(11)和(13)可得:
根据线性矩阵不等式的求解工具LMI工具箱,可以得到控制器增益K
4.构造转换逻辑
转换逻辑的主要任务就是根据控制器所得到的信号,对于控制信号进行计算,从而获得各个水枪所应该提供的动力大小,其中的分配算法本质上是一种多目标优化算法,各个水枪所分配的动力在满足合力需求及推进器约束的同时,还要尽量达到最小化消耗功率、摩擦阻力、噪声或磨损以及其它与控制使用相关的目标值。考虑到气垫船的实用性,这里将优化目标定义为能耗最小,约束条件主要为各个水枪所能提供的动力约束,以及所产生合力满足气垫船姿态调节所需的动力。利用基于粗糙集的进化算法可以提高优化计算的实时性,实现水枪动力分配的在线计算。
5.执行器设计
结合附图1,构建姿态调整的执行器机构,在气垫船的四周加入水枪,水枪的发射方向垂直于海平面。从转换逻辑得到的水枪动力分配信号进入执行器机构,使得水枪工作,从而产生调节气垫船姿态的控制力。
6.实现静止状态下全垫升气垫船的姿态调节。
Claims (1)
1.一种气垫船姿态调节的主动时滞反馈控制方法,其特征是:通过气垫船传感器系统得到气垫船姿态信息,根据所述姿态信息得到控制器的控制信号,所述控制信号进入转换逻辑,计算出安装在气垫船四周的各个水枪所需提供的动力,最后通过作为执行器机构的水枪对于气垫船的姿态进行调整,具体为:
步骤一、建立气垫船六自由度模型:
气垫船的六自由度运动模型为:
其中,
u——X轴方向的速度,ξ——X轴上的位置,为ξ的一阶导数;
v——Y轴方向的速度,η——Y轴上的位置,为η的一阶导数;
w——Z轴方向的速度,ζ——Z轴上的位置,为ζ的一阶导数;
p——绕X轴运动的角速度,——绕X轴的姿态角,为的一阶导数;
q——绕Y轴运动的角速度,θ——绕Y轴的姿态角,为θ的一阶导数;
r——绕Z轴运动的角速度,ψ——绕Z轴的姿态角;为ψ的一阶导数;
步骤二、建立气垫船在海平面上在海洋环境影响下主动控制的状态空间模型:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>M</mi>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<mi>D</mi>
<mi>x</mi>
<mo>=</mo>
<mi>&tau;</mi>
<mo>+</mo>
<mi>b</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mover>
<mi>&Omega;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>S</mi>
<mrow>
<mo>(</mo>
<mi>&Omega;</mi>
<mo>)</mo>
</mrow>
<mi>x</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
其中x=(u v w p q r)T,M=MT>0为带有附加质量的惯性矩阵,D>0为线性阻尼矩阵,S(Ω)为转换矩阵,τ为控制量,b为环境干扰,且环境干扰有界,具体形式为:
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>b</mi>
<mo>|</mo>
<msub>
<mo>|</mo>
<mn>2</mn>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msubsup>
<mo>&Integral;</mo>
<mn>0</mn>
<mi>&infin;</mi>
</msubsup>
<mi>b</mi>
<msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mi>b</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</msqrt>
<mo><</mo>
<mi>&infin;</mi>
</mrow>
将横摇和纵摇的姿态角的和作为控制的输出:
y(t)=Cx(t) (3)
其中C=(0,0,0,1,1,0)T
得到气垫船的静止状态下的近似的状态空间模型:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>A</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>B</mi>
<mn>1</mn>
</msub>
<mi>&tau;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>B</mi>
<mn>2</mn>
</msub>
<mi>b</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>C</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
其中
步骤三、将控制率设计为:
τ(t)=Kx(t-d) (5)
其中d为大于0的数;K为控制器增益;得到闭环系统:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>A</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>B</mi>
<mn>1</mn>
</msub>
<mi>K</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>-</mo>
<mi>d</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>B</mi>
<mn>2</mn>
</msub>
<mi>b</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>C</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
构造Lyapunov-Krasovskii函数:
<mrow>
<mi>V</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mi>x</mi>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>P</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>d</mi>
<msubsup>
<mo>&Integral;</mo>
<mrow>
<mo>-</mo>
<mi>d</mi>
</mrow>
<mn>0</mn>
</msubsup>
<msubsup>
<mo>&Integral;</mo>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mi>s</mi>
</mrow>
<mi>t</mi>
</msubsup>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mi>Q</mi>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>s</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
其中P>0,Q>0;
令b(t)=0,将公式(7)沿公式(6)微分可得:
<mrow>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<mi>A</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>B</mi>
<mn>1</mn>
</msub>
<mi>K</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<mi>d</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mi>T</mi>
</msup>
<mi>P</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>x</mi>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>P</mi>
<mo>&lsqb;</mo>
<mi>A</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>B</mi>
<mn>1</mn>
</msub>
<mi>K</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<mi>d</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>+</mo>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>Q</mi>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>d</mi>
<msubsup>
<mo>&Integral;</mo>
<mrow>
<mo>-</mo>
<mi>d</mi>
</mrow>
<mn>0</mn>
</msubsup>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>+</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mi>Q</mi>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>+</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>s</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
式(8)中存在不等式关系:
<mrow>
<mo>-</mo>
<mi>d</mi>
<msubsup>
<mo>&Integral;</mo>
<mrow>
<mo>-</mo>
<mi>d</mi>
</mrow>
<mn>0</mn>
</msubsup>
<msup>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>+</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mi>Q</mi>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>+</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>s</mi>
<mo>&le;</mo>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<mi>x</mi>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<msup>
<mi>x</mi>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mi>d</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>Q</mi>
</mrow>
</mtd>
<mtd>
<mi>Q</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>Q</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mi>x</mi>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>x</mi>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<mi>d</mi>
<mo>)</mo>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
其中*表示矩阵中对称元素的转置,令x(t)=(x(t)xT(t-d))T,则有记(A B1K)=Δ,将公式(8)简化为:
<mrow>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>&le;</mo>
<msup>
<mi>&chi;</mi>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>&lsqb;</mo>
<mi>&Pi;</mi>
<mo>+</mo>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
<msup>
<mi>&Delta;</mi>
<mi>T</mi>
</msup>
<mi>Q</mi>
<mi>&Delta;</mi>
<mo>&rsqb;</mo>
<mi>&chi;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
其中
再建立能够保证H-infinity性能的条件,并取消b(t)=0的限制,则得到
其中Υ=(A B1K D),Λ=(C 0 0);
<mrow>
<mi>&Theta;</mi>
<mo>=</mo>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<mi>A</mi>
<mi>T</mi>
</msup>
<mi>P</mi>
<mo>+</mo>
<mi>P</mi>
<mi>A</mi>
<mo>-</mo>
<mi>Q</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>PB</mi>
<mn>1</mn>
</msub>
<mi>K</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>P</mi>
<mi>D</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>Q</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msup>
<mi>&gamma;</mi>
<mn>2</mn>
</msup>
<mi>I</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
根据Lyapunov-Krasovskii稳定性理论,保证闭环系统渐近稳定的条件是
Θ+d2ΥTQΥ+ΛTΛ<0
即成立,进而可以得到
<mrow>
<msubsup>
<mo>&Integral;</mo>
<mn>0</mn>
<mi>&infin;</mi>
</msubsup>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>y</mi>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msup>
<mi>&gamma;</mi>
<mn>2</mn>
</msup>
<msup>
<mi>b</mi>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>b</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>t</mi>
<mo>&le;</mo>
<mn>0</mn>
</mrow>
再根据Schur补引理得到
<mrow>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<mi>A</mi>
<mi>T</mi>
</msup>
<mi>P</mi>
<mo>+</mo>
<mi>P</mi>
<mi>A</mi>
<mo>-</mo>
<mi>Q</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>PB</mi>
<mn>1</mn>
</msub>
<mi>K</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>P</mi>
<mi>D</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msup>
<mi>dA</mi>
<mi>T</mi>
</msup>
<mi>Q</mi>
</mrow>
</mtd>
<mtd>
<msup>
<mi>C</mi>
<mi>T</mi>
</msup>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mi>Q</mi>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msup>
<mi>dK</mi>
<mi>T</mi>
</msup>
<msup>
<msub>
<mi>B</mi>
<mn>1</mn>
</msub>
<mi>T</mi>
</msup>
<mi>Q</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msup>
<mi>&gamma;</mi>
<mn>2</mn>
</msup>
<mi>I</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msup>
<mi>dD</mi>
<mi>T</mi>
</msup>
<mi>Q</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>Q</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>I</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo><</mo>
<mn>0</mn>
</mrow>
利用线性矩阵不等式的求解工具LMI工具箱,对以上矩阵不等式进行求解,得到控制器增益K;
步骤四、构造转换逻辑,具体为:根据控制器所得到的信号,对于控制信号进行计算,从而获得所应该提供的动力大小;
步骤五、在气垫船的四周加入水枪,水枪的发生方向垂直于海平面,从步骤四中得到的水枪动力分配信号进入执行器结构,使得水枪工作,从而产生调节气垫船姿态的控制力,从而实现静止状态下气垫船的姿态调节。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510616596.2A CN105204339B (zh) | 2015-09-24 | 2015-09-24 | 气垫船姿态调节的主动时滞反馈控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510616596.2A CN105204339B (zh) | 2015-09-24 | 2015-09-24 | 气垫船姿态调节的主动时滞反馈控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105204339A CN105204339A (zh) | 2015-12-30 |
CN105204339B true CN105204339B (zh) | 2018-04-17 |
Family
ID=54952086
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510616596.2A Expired - Fee Related CN105204339B (zh) | 2015-09-24 | 2015-09-24 | 气垫船姿态调节的主动时滞反馈控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105204339B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109343353A (zh) * | 2018-12-17 | 2019-02-15 | 珠海萨博思海洋工程有限公司 | 一种用于动力定位船舶推力分配的智能优化方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3633210B2 (ja) * | 1997-06-16 | 2005-03-30 | 株式会社明電舎 | Svc装置の制御方式 |
CN100377943C (zh) * | 2001-03-20 | 2008-04-02 | 林德全 | 喷水悬浮高速船 |
JP2014030295A (ja) * | 2012-07-31 | 2014-02-13 | Toshiba Fuel Cell Power Systems Corp | コジェネレーションシステム、コジェネレーションシステムの運転制御装置、およびコジェネレーションシステムの運転方法 |
JP5696171B2 (ja) * | 2013-03-14 | 2015-04-08 | 株式会社東芝 | 制御パラメータ調整方法、制御パラメータ調整システム及び制御パラメータ設定装置 |
CN103279035A (zh) * | 2013-05-20 | 2013-09-04 | 武汉大学 | 考虑wams信号时延的电力系统广域输出反馈控制方法 |
CN103407443B (zh) * | 2013-07-11 | 2015-12-02 | 哈尔滨工程大学 | 一种气垫船航行安全性的协调控制方法 |
CN103499920B (zh) * | 2013-09-03 | 2017-04-19 | 北京工业大学 | 向量时间序列预测专家模糊变比控制参数优化方法和系统 |
CN103955136B (zh) * | 2014-04-29 | 2016-09-07 | 上海交通大学 | 电磁致驱动定位控制方法及其应用 |
-
2015
- 2015-09-24 CN CN201510616596.2A patent/CN105204339B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN105204339A (zh) | 2015-12-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Yang et al. | Robust nonlinear model predictive control for reference tracking of dynamic positioning ships based on nonlinear disturbance observer | |
Kim et al. | Adaptive sliding-mode control of an offshore container crane with unknown disturbances | |
Serrano et al. | Trajectory tracking of underactuated surface vessels: A linear algebra approach | |
Yu et al. | Sliding mode tracking control of an underactuated surface vessel | |
CN106444806B (zh) | 基于生物速度调节的欠驱动auv三维轨迹跟踪控制方法 | |
Lekkas et al. | Minimization of cross-track and along-track errors for path tracking of marine underactuated vehicles | |
Wang et al. | AUV near-wall-following control based on adaptive disturbance observer | |
von Ellenrieder | Stable backstepping control of marine vehicles with actuator rate limits and saturation | |
Zhao et al. | Integrated guidance and control with L2 disturbance attenuation for hypersonic vehicles | |
Li et al. | Double-loop structure integral sliding mode control for UUV trajectory tracking | |
Liu et al. | A hierarchical disturbance rejection depth tracking control of underactuated AUV with experimental verification | |
Kong et al. | Trajectory tracking control for under-actuated hovercraft using differential flatness and reinforcement learning-based active disturbance rejection control | |
CN105204339B (zh) | 气垫船姿态调节的主动时滞反馈控制方法 | |
Peymani et al. | Leader-follower formation of marine craft using constraint forces and lagrange multipliers | |
CN111538242B (zh) | 一种不确定性估计和饱和补偿的动力定位t-s模糊抗饱和控制方法 | |
Zhang et al. | High-gain observer-based model predictive control for cross tracking of underactuated autonomous underwater vehicles | |
Han et al. | Higher-order sliding mode control for trajectory tracking of air cushion vehicle | |
Wei et al. | Back-stepping control of underactuated AUV's depth based on nonlinear disturbance observer | |
Aschemann et al. | Nonlinear control and disturbance compensation for underactuated ships using extended linearisation techniques | |
Santhakumar et al. | Coupled, non-linear control system design for autonomous underwater vehicle (AUV) | |
Park et al. | Adaptive depth controller design for a submerged body moving near free surface | |
Sahoo et al. | Adaptive fuzzy pid controller for a compact autonomous underwater vehicle | |
Li et al. | Underactuated Autonomous Underwater Vehicle Trajectory Tracking Control in Three Dimensions Based on Fractional Order Sliding Mode | |
Wang et al. | Weather optimal area-keeping control for underactuated autonomous surface vehicle with input time-delay | |
Desai et al. | Sliding mode controller based on a delayed output observer for yaw channel of an auv |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180417 |