CN107121928A - 一种无人水面艇的扰动补偿控制方法 - Google Patents

一种无人水面艇的扰动补偿控制方法 Download PDF

Info

Publication number
CN107121928A
CN107121928A CN201710364373.0A CN201710364373A CN107121928A CN 107121928 A CN107121928 A CN 107121928A CN 201710364373 A CN201710364373 A CN 201710364373A CN 107121928 A CN107121928 A CN 107121928A
Authority
CN
China
Prior art keywords
mover
mrow
msub
water surface
eta
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.)
Granted
Application number
CN201710364373.0A
Other languages
English (en)
Other versions
CN107121928B (zh
Inventor
戴诗陆
彭云根
王敏
李烈军
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
South China University of Technology SCUT
Original Assignee
South China University of Technology SCUT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by South China University of Technology SCUT filed Critical South China University of Technology SCUT
Priority to CN201710364373.0A priority Critical patent/CN107121928B/zh
Publication of CN107121928A publication Critical patent/CN107121928A/zh
Application granted granted Critical
Publication of CN107121928B publication Critical patent/CN107121928B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/0206Control of position or course in two dimensions specially adapted to water vehicles
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种基于误差符号鲁棒积分的无人水面艇扰动补偿控制方法,包括以下步骤:建立无人水面艇系统的动态模型,并考虑该系统具有模型不确定性且受到风浪流外界时变干扰的影响;对系统的动态模型进行等价转换;建立跟踪误差方程和辅助误差方程;基于误差符号鲁棒积分方法设计跟踪控制器。所述方法既能补偿系统的动态模型不确定性,又能补偿外界时变扰动,解决了具有模型不确定性和外界扰动的无人水面艇系统的渐近跟踪控制问题,使无人水面艇在存在模型不确定性和风浪流外界干扰情况下系统的输出仍能渐近跟踪所期望的参考轨迹。

Description

一种无人水面艇的扰动补偿控制方法
技术领域
本发明涉及无人水面艇的轨迹跟踪控制领域,具体涉及一种基于误差符号鲁棒积分的无人水面艇扰动补偿控制方法。
背景技术
无人水面艇是一种能够在实际海洋环境下安全自主航行,并能够完成各种任务的海面航行器。无人水面艇可以为我们日常生活、生产带来很大的应用空间与便利。海洋资源的开发是最近时期的一个热点话题,人们逐步将获取石油、天然气、矿物质等陆地上已逐渐匮乏的资源的视线投入海洋当中,占据地球表面积70%的海洋是未来人类赖以生存的第二空间,无人水面艇在海洋资源的研究、勘探、开采和运输方面都具有巨大的应用前景。在恶劣海况(如海上大风、巨浪、热带风暴等)的探测研究和预警预报方面,无人水面艇也将发挥其重要作用。此外,在海洋生物多样性的研究、海洋地质环境的勘探与监控、海洋水文的观测以及海洋气象研究等领域,无人水面艇均具有广阔的应用前景。
在不可预测的海洋动态环境里,为了达到高度自主性,无人水面艇需要灵活可靠的操纵性能、准确的控制能力来确保其他无人艇与自身的安全并完成复杂的工作任务。无人水面艇的运动控制技术是实现无人自主航行的关键技术之一。无人水面艇的运动控制问题是一个典型的复杂非线性系统在复杂环境下的控制问题。随着经典控制理论应用的越来越成熟,以应用PID控制方法提出了自动舵的设计,实现了船舰的自动控制,提高了系统的自动化控制程度。然而PID自动舵对外界变化应变能力较差、操舵频繁、幅度大、能耗高,航行跟踪精度较低。在实际海洋环境中,无人水面艇的自动控制系统中的被控对象(无人艇)的数学模型参数是随着风浪流、船速、转舵角、载重、吃水等的变化而变化的,且在不同航速下艇体的吃水和浸湿面积会发生很大变化,其艇体的各种水动力系数也将随航速的变化而变化。因此要建立精确的无人水面艇动力学模型通常极其困难,实际无人水面艇通常存在着系统动态模型不确定性。此外,考虑到海洋环境下无人水面艇在航行中几乎不可避免受到海风、海浪和海流等外界环境的干扰,这些干扰可能会降低无人水面艇的轨迹跟踪精度,严重时可能会导致系统的不稳定,影响无人水面艇的航行安全。因此,解决未知海洋动态环境下无人水面艇的准确跟踪控制问题具有重要的实际价值。
发明内容
本发明的目的是针对无人水面艇在风浪流外界干扰和动态模型不确性情况下高精度跟踪控制设计的难点,提出了一种基于误差符号鲁棒积分(Robust Integral of theSign of the Error,简称RISE)的无人水面艇扰动补偿控制方法,该方法既能补偿系统的动态模型不确定性,又能补偿外界时变扰动,确保无人水面艇的位置误差和偏航角误差均渐近收敛于原点,实现了系统的输出精确地跟踪所期望的参考轨迹。
本发明的目的可以通过如下技术方案实现:
一种基于误差符号鲁棒积分的无人水面艇扰动补偿控制方法,所述方法包括以下步骤:
步骤(1)、建立无人水面艇的动态模型,并考虑该模型具有动态模型不确定性且受到风浪流外界时变干扰的影响;
步骤(2)、通过运动学方程转换,得到以大地为直角坐标系的系统动力学方程;
步骤(3)、建立跟踪误差方程和辅助误差方程,具体设计为:
其中,ηd为无人水面艇的参考轨迹,η为无人水面艇的位置和偏航角的输出,e1为轨迹跟踪误差,e2为滤波跟踪误差,e3为辅助误差,为e1的导数,为e2的导数,α1为滤波跟踪误差的设计参数,α2为辅助误差的设计参数;
步骤(4)、基于误差符号鲁棒积分方法设计跟踪控制器。
进一步地,步骤(1)中无人水面艇的动态模型为:
其中,η=[x,y,ψ]T为无人水面艇位置和偏航角的输出,为η的导数,(x,y)为无人水面艇的位置输出,x表示大地坐标的横坐标,y表示大地坐标的纵坐标,ψ为偏航角的输出,ν=[u,υ,r]T为无人水面艇的速度,为无人水面艇的加速度,u为无人水面艇的前进速度,υ为无人水面艇的横荡速度,r为无人水面艇对应于ψ的偏航角速度,J(η)是旋转矩阵,M是惯性矩阵,C(ν)是总科氏力和向心力矩阵,D(ν)是阻尼矩阵,g(η)是艇体受到的引力和浮力影响的向量,J(η)、M、C(ν)、D(ν)、g(η)模型已知,τ为控制输入量,τd(η,υ,t)代表模型不确定性及风浪流外界时变干扰项,t表示时间。
进一步地,步骤(2)中得到的以大地为直角坐标系的系统动力学方程为:
其中,η为无人水面艇的位置和偏航角的输出,为η的导数,为η的二阶导数,ν为无人水面艇的速度,为转换惯性矩阵,为转换后的总科氏力和向心力矩阵,为转换后的阻尼矩阵,为转换后的艇体受到的引力和浮力影响的向量,代表转换后的模型不确定性及风浪流外界时变干扰项,为转换后的控制输入量。
进一步地,在步骤(3)中,由于无人水面艇的加速度在实际操作中通常不可直接测量获得,因而不能作为反馈控制的输入信号,将两边同时乘以得到如下开环误差系统:
其中,为辅助函数,e1为轨迹跟踪误差,e2为滤波跟踪误差,e3为辅助误差,为e1的导数,为e2的导数,α1为滤波跟踪误差的设计参数,α2为辅助误差的设计参数,η为无人水面艇的位置和偏航角的输出,为η的导数,表示参考轨迹的二阶导数,ν为无人水面艇的速度,为转换惯性矩阵,为转换后的总科氏力和向心力矩阵,为转换后的阻尼矩阵,为转换后的艇体受到的引力和浮力影响的向量,代表转换后的模型不确定性及风浪流外界时变干扰项,为转换后的控制输入量。
进一步地,步骤(4)中设计的跟踪控制器为:
其中,η为无人水面艇的位置和偏航角的输出,为η的导数,表示参考轨迹的二阶导数,ν为无人水面艇的速度,为转换惯性矩阵,为转换后的总科氏力和向心力矩阵,为转换后的阻尼矩阵,为转换后的艇体受到的引力和浮力影响的向量,为转换后的控制输入量,误差符号鲁棒积分项μ为:
其中,ks为误差积分控制增益,β为误差符号积分控制增益,e2为滤波跟踪误差,α2为辅助误差的设计参数,将所设计的跟踪控制器代入开环误差系统得:
其中,为转换惯性矩阵,e3为辅助误差,fe为辅助函数,代表转换后的模型不确定性及风浪流外界时变干扰项,μ为误差符号鲁棒积分项,对上式两边求导并进行适当地分解得到:
利用中值定理得:
其中,ρ是一个正的、可逆的非减函数,z为误差向量,η为无人水面艇的位置和偏航角的输出,为转换惯性矩阵,为转换惯性矩阵的导数,e1为轨迹跟踪误差,e2为滤波跟踪误差,e3为辅助误差,为e3的导数,为辅助项,为辅助函数fe的导数,为误差符号鲁棒积分项μ的导数,为转换后的模型不确定性及风浪流外界时变干扰项的导数,Nd的等价项。
基于Lyapunov稳定性理论,所设计的跟踪控制器可以确保所有的信号都有界,且无人水面艇的位置误差和偏航角误差均渐近收敛于原点,实现了系统的输出精确地跟踪所期望的参考轨迹。
本发明与现有技术相比,具有如下优点和有益效果:
本发明通过设计滤波跟踪误差和辅助误差,利用对误差及误差符号函数的积分来补偿系统动态模型的不确定性以及风浪流等外界时变扰动,与目前存在的无人水面艇轨迹跟踪控制方法相比,本发明提出的控制方法使得无人水面艇即使同时存在模型不确定性和风浪流外界干扰情况下系统的输出仍然能够实现精确地跟踪所期望的参考轨迹。
附图说明
图1为本发明实施例无人水面艇系统的示意图。
图2为本发明实施例无人水面艇扰动补偿控制方法的整体控制框图。
图3为本发明实施例无人水面艇位置输出在x轴方向的跟踪误差e11的波形图。
图4为本发明实施例无人水面艇位置输出在y轴方向的跟踪误差e12的波形图。
图5为本发明实施例无人水面艇的偏航角误差e13的波形图。
图6为本发明实施例无人水面艇在前进速度u上的控制输入波形图。
图7为本发明实施例无人水面艇在横荡速度υ上的控制输入波形图。
图8为本发明实施例无人水面艇在偏航角速度r上的控制输入波形图。
具体实施方式
下面结合实施例及附图对本发明作进一步详细的描述,但本发明的实施方式不限于此。
实施例:
本实施例针对如图1所示的无人水面艇系统提供了一种基于误差符号鲁棒积分的无人水面艇扰动补偿控制方法,所述方法的流程图如图2所示,包括以下步骤:
步骤(1)、建立无人水面艇的动态模型,并考虑该模型具有动态模型不确定性且受到风浪流外界时变干扰的影响;所述无人水面艇的动态模型为:
其中,η=[x,y,ψ]T为无人水面艇位置和偏航角的输出,为η的导数,(x,y)为无人水面艇的位置输出,x表示大地坐标的横坐标,y表示大地坐标的纵坐标,ψ为偏航角的输出,ν=[u,υ,r]T为无人水面艇的速度,为无人水面艇的加速度,u为无人水面艇的前进速度,υ为无人水面艇的横荡速度,r为无人水面艇对应于ψ的偏航角速度,J(η)是旋转矩阵,M是惯性矩阵,C(ν)是总科氏力和向心力矩阵,D(ν)是阻尼矩阵,g(η)是艇体受到的引力和浮力影响的向量,J(η)、M、C(ν)、D(ν)、g(η)模型已知,τ为控制输入量,本实施例中在前进速度u上的控制输入波形图如图6所示,在横荡速度υ上的控制输入波形图如图7所示,在偏航角速度r上的控制输入波形图如图8所示,τd(η,υ,t)代表模型不确定性及风浪流外界时变干扰项,t表示时间。
在本实施例中,选取无人水面艇的系统参数分别为:
m11=25.8,m22=24.6612,m23=1.0948,m33=2.76,
c13(v)=-24.6612*υ-1.0948*r,c23(v)=25.8*u,
d11=0.7225+1.3274*|u|+5.8664*u2
d22=0.8612+36.2823*|υ|+0.805*|r|,
d23=-0.1079+0.845*|υ|+3.45*|r|,
d32=-0.1052-5.0437*|υ|-0.13*|r|,
d33=1.9-0.08*|υ|+0.75*|r|。
其中,系统的各物理量单位均采用国际单位制。
步骤(2)、通过运动学方程转换,得到以大地为直角坐标系的系统动力学方程;系统动力学方程如下:
其中,η为无人水面艇的位置和偏航角的输出,为η的导数,为η的二阶导数,ν为无人水面艇的速度,为转换惯性矩阵,为转换后的总科氏力和向心力矩阵,为转换后的阻尼矩阵,为转换后的艇体受到的引力和浮力影响的向量,代表转换后的模型不确定性及风浪流外界时变干扰项,为转换后的控制输入量。
步骤(3)、建立跟踪误差方程和辅助误差方程,具体设计为:
其中,ηd为无人水面艇的参考轨迹,η为无人水面艇的位置和偏航角的输出,e1为轨迹跟踪误差,e2为滤波跟踪误差,e3为辅助误差,为e1的导数,为e2的导数,α1为滤波跟踪误差的设计参数,α2为辅助误差的设计参数;取α1=1,α2=10,选择如下期望的参考轨迹:
由于无人水面艇的加速度在实际操作中通常不可直接测量获得,因而不能作为反馈控制的输入信号,将两边同时乘以得到如下开环误差系统:
其中,为辅助函数,e1为轨迹跟踪误差,e2为滤波跟踪误差,e3为辅助误差,为e1的导数,为e2的导数,α1为滤波跟踪误差的设计参数,α2为辅助误差的设计参数,η为无人水面艇的位置和偏航角的输出,为η的导数,表示参考轨迹的二阶导数,ν为无人水面艇的速度,为转换惯性矩阵,为转换后的总科氏力和向心力矩阵,为转换后的阻尼矩阵,为转换后的艇体受到的引力和浮力影响的向量,代表转换后的模型不确定性及风浪流外界时变干扰项,为转换后的控制输入量。
步骤(4)、基于误差符号鲁棒积分方法设计跟踪控制器,设计的跟踪控制器为:
其中,η为无人水面艇的位置和偏航角的输出,为η的导数,表示参考轨迹的二阶导数,ν为无人水面艇的速度,为转换惯性矩阵,为转换后的总科氏力和向心力矩阵,为转换后的阻尼矩阵,为转换后的艇体受到的引力和浮力影响的向量,为转换后的控制输入量,误差符号鲁棒积分项μ为:
其中,ks为误差积分控制增益,β为误差符号积分控制增益,e2为滤波跟踪误差,α2为辅助误差的设计参数,设计跟踪控制器参数为:ks=30,β=10,α2=10,系统的初始条件为:[ηT νT]T=[3 0.1 3 1 0 3]T
本实施例中无人水面艇位置输出在x轴方向的跟踪误差e11如图3所示,在y轴方向的跟踪误差e12如图4所示,偏航角误差e13如图5所示,图3至图5表明了即使在模型不确定性和风浪流外界干扰同时出现的情况下,无人水面艇的位置误差和偏航角误差均渐近地收敛于原点,实现了系统的输出精确地跟踪所期望的参考轨迹,获得了满意的跟踪控制性能。
仿真结果说明,本发明所设计的控制方法既能补偿系统的动态模型不确定性,又能补偿外界时变扰动,并且可以实现无人艇位置及偏航角的输出精确地跟踪所期望的参考轨迹。
以上所述,仅为本发明专利较佳的实施例,但本发明专利的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明专利所公开的范围内,根据本发明专利的技术方案及其发明专利构思加以等同替换或改变,都属于本发明专利的保护范围。

Claims (5)

1.一种基于误差符号鲁棒积分的无人水面艇扰动补偿控制方法,其特征在于,所述方法包括以下步骤:
步骤(1)、建立无人水面艇的动态模型,并考虑该模型具有动态模型不确定性且受到风浪流外界时变干扰的影响;
步骤(2)、通过运动学方程转换,得到以大地为直角坐标系的系统动力学方程;
步骤(3)、建立跟踪误差方程和辅助误差方程,具体设计为:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>e</mi> <mn>1</mn> </msub> <mo>=</mo> <msub> <mi>&amp;eta;</mi> <mi>d</mi> </msub> <mo>-</mo> <mi>&amp;eta;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>e</mi> <mn>2</mn> </msub> <mo>=</mo> <msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>&amp;alpha;</mi> <mn>1</mn> </msub> <msub> <mi>e</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>e</mi> <mn>3</mn> </msub> <mo>=</mo> <msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>&amp;alpha;</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced>
其中,ηd为无人水面艇的参考轨迹,η为无人水面艇的位置和偏航角的输出,e1为轨迹跟踪误差,e2为滤波跟踪误差,e3为辅助误差,为e1的导数,为e2的导数,α1为滤波跟踪误差的设计参数,α2为辅助误差的设计参数;
步骤(4)、基于误差符号鲁棒积分方法设计跟踪控制器。
2.根据权利要求1所述的一种基于误差符号鲁棒积分的无人水面艇扰动补偿控制方法,其特征在于,步骤(1)中无人水面艇的动态模型为:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mi>J</mi> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mi>&amp;nu;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>M</mi> <mover> <mi>&amp;nu;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mi>C</mi> <mrow> <mo>(</mo> <mi>&amp;nu;</mi> <mo>)</mo> </mrow> <mi>&amp;nu;</mi> <mo>+</mo> <mi>D</mi> <mrow> <mo>(</mo> <mi>&amp;nu;</mi> <mo>)</mo> </mrow> <mi>&amp;nu;</mi> <mo>+</mo> <mi>g</mi> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>&amp;tau;</mi> <mi>d</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>,</mo> <mi>&amp;upsi;</mi> <mo>,</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>&amp;tau;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced>
其中,η=[x,y,ψ]T为无人水面艇位置和偏航角的输出,为η的导数,(x,y)为无人水面艇的位置输出,x表示大地坐标的横坐标,y表示大地坐标的纵坐标,ψ为偏航角的输出,ν=[u,υ,r]T为无人水面艇的速度,ν为无人水面艇的加速度,u为无人水面艇的前进速度,υ为无人水面艇的横荡速度,r为无人水面艇对应于ψ的偏航角速度,J(η)是旋转矩阵,M是惯性矩阵,C(ν)是总科氏力和向心力矩阵,D(ν)是阻尼矩阵,g(η)是艇体受到的引力和浮力影响的向量,J(η)、M、C(ν)、D(ν)、g(η)模型已知,τ为控制输入量,τd(η,υ,t)代表模型不确定性及风浪流外界时变干扰项,t表示时间。
3.根据权利要求1所述的一种基于误差符号鲁棒积分的无人水面艇扰动补偿控制方法,其特征在于,步骤(2)中得到的以大地为直角坐标系的系统动力学方程为:
<mrow> <mover> <mi>M</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mo>+</mo> <mover> <mi>C</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>,</mo> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>,</mo> <mi>&amp;nu;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mover> <mi>D</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>,</mo> <mi>&amp;nu;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mover> <mi>g</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mover> <mi>&amp;tau;</mi> <mo>&amp;OverBar;</mo> </mover> <mi>d</mi> </msub> <mo>=</mo> <mover> <mi>&amp;tau;</mi> <mo>&amp;OverBar;</mo> </mover> </mrow>
其中,η为无人水面艇的位置和偏航角的输出,为η的导数,为η的二阶导数,ν为无人水面艇的速度,为转换惯性矩阵,为转换后的总科氏力和向心力矩阵,为转换后的阻尼矩阵,为转换后的艇体受到的引力和浮力影响的向量,代表转换后的模型不确定性及风浪流外界时变干扰项,为转换后的控制输入量。
4.根据权利要求1所述的一种基于误差符号鲁棒积分的无人水面艇扰动补偿控制方法,其特征在于:在步骤(3)中,由于无人水面艇的加速度在实际操作中通常不可直接测量获得,因而不能作为反馈控制的输入信号,将两边同时乘以得到如下开环误差系统:
<mrow> <mover> <mi>M</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <msub> <mi>e</mi> <mn>3</mn> </msub> <mo>=</mo> <mover> <mi>M</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <msub> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>d</mi> </msub> <mo>+</mo> <mover> <mi>C</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>,</mo> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>,</mo> <mi>&amp;nu;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mover> <mi>D</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>,</mo> <mi>&amp;nu;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mover> <mi>g</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>f</mi> <mi>e</mi> </msub> <mo>+</mo> <msub> <mover> <mi>&amp;tau;</mi> <mo>&amp;OverBar;</mo> </mover> <mi>d</mi> </msub> <mo>-</mo> <mover> <mi>&amp;tau;</mi> <mo>&amp;OverBar;</mo> </mover> </mrow>
其中,为辅助函数,e1为轨迹跟踪误差,e2为滤波跟踪误差,e3为辅助误差,为e1的导数,为e2的导数,α1为滤波跟踪误差的设计参数,α2为辅助误差的设计参数,η为无人水面艇的位置和偏航角的输出,为η的导数,表示参考轨迹的二阶导数,ν为无人水面艇的速度,为转换惯性矩阵,为转换后的总科氏力和向心力矩阵,为转换后的阻尼矩阵,为转换后的艇体受到的引力和浮力影响的向量,代表转换后的模型不确定性及风浪流外界时变干扰项,为转换后的控制输入量。
5.根据权利要求1或4所述的一种基于误差符号鲁棒积分的无人水面艇扰动补偿控制方法,其特征在于,步骤(4)中设计的跟踪控制器为:
<mrow> <mover> <mi>&amp;tau;</mi> <mo>&amp;OverBar;</mo> </mover> <mo>=</mo> <mi>&amp;mu;</mi> <mo>+</mo> <mover> <mi>M</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <msub> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>d</mi> </msub> <mo>+</mo> <mover> <mi>C</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>,</mo> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>,</mo> <mi>&amp;nu;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mover> <mi>D</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>,</mo> <mi>&amp;nu;</mi> <mo>)</mo> </mrow> <mover> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mover> <mi>g</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> </mrow>
其中,η为无人水面艇的位置和偏航角的输出,为η的导数,表示参考轨迹的二阶导数,ν为无人水面艇的速度,为转换惯性矩阵,为转换后的总科氏力和向心力矩阵,为转换后的阻尼矩阵,为转换后的艇体受到的引力和浮力影响的向量,为转换后的控制输入量,误差符号鲁棒积分项μ为:
<mrow> <mi>&amp;mu;</mi> <mo>=</mo> <mrow> <mo>(</mo> <msub> <mi>k</mi> <mi>s</mi> </msub> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>e</mi> <mn>2</mn> </msub> <mo>(</mo> <mn>0</mn> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <munderover> <mo>&amp;Integral;</mo> <mn>0</mn> <mi>t</mi> </munderover> <mo>&amp;lsqb;</mo> <mrow> <mo>(</mo> <msub> <mi>k</mi> <mi>s</mi> </msub> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> <msub> <mi>&amp;alpha;</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>&amp;sigma;</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>&amp;beta;</mi> <mi>sgn</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mn>2</mn> </msub> <mo>(</mo> <mi>&amp;sigma;</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> <mi>d</mi> <mi>&amp;sigma;</mi> </mrow>
其中,ks为误差积分控制增益,β为误差符号积分控制增益,e2为滤波跟踪误差,α2为辅助误差的设计参数,将所设计的跟踪控制器代入开环误差系统得:
<mrow> <mover> <mi>M</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <msub> <mi>e</mi> <mn>3</mn> </msub> <mo>=</mo> <msub> <mi>f</mi> <mi>e</mi> </msub> <mo>+</mo> <msub> <mover> <mi>&amp;tau;</mi> <mo>&amp;OverBar;</mo> </mover> <mi>d</mi> </msub> <mo>-</mo> <mi>&amp;mu;</mi> </mrow>
其中,为转换惯性矩阵,e3为辅助误差,fe为辅助函数,代表转换后的模型不确定性及风浪流外界时变干扰项,μ为误差符号鲁棒积分项,对上式两边求导并进行适当地分解得到:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mover> <mi>M</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>3</mn> </msub> <mo>=</mo> <mover> <mi>N</mi> <mo>~</mo> </mover> <mo>+</mo> <msub> <mi>N</mi> <mi>d</mi> </msub> <mo>-</mo> <mover> <mi>&amp;mu;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <mover> <mover> <mi>M</mi> <mo>&amp;OverBar;</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <msub> <mi>e</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>e</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mover> <mi>N</mi> <mo>~</mo> </mover> <mo>=</mo> <msub> <mi>e</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mover> <mi>f</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>e</mi> </msub> <mo>-</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <mover> <mover> <mi>M</mi> <mo>&amp;OverBar;</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>&amp;eta;</mi> <mo>)</mo> </mrow> <msub> <mi>e</mi> <mn>3</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>N</mi> <mi>d</mi> </msub> <mo>=</mo> <msub> <mover> <mover> <mi>&amp;tau;</mi> <mo>&amp;OverBar;</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mi>d</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced>
利用中值定理得:
<mrow> <mover> <mi>N</mi> <mo>~</mo> </mover> <mo>&amp;le;</mo> <mi>&amp;rho;</mi> <mrow> <mo>(</mo> <mo>|</mo> <mo>|</mo> <mi>z</mi> <mo>|</mo> <mo>|</mo> <mo>)</mo> </mrow> <mo>|</mo> <mo>|</mo> <mi>z</mi> <mo>|</mo> <mo>|</mo> <mo>,</mo> <mi>z</mi> <mo>=</mo> <msup> <mrow> <mo>&amp;lsqb;</mo> <msubsup> <mi>e</mi> <mn>1</mn> <mi>T</mi> </msubsup> <mo>,</mo> <msubsup> <mi>e</mi> <mn>2</mn> <mi>T</mi> </msubsup> <mo>,</mo> <msubsup> <mi>e</mi> <mn>3</mn> <mi>T</mi> </msubsup> <mo>&amp;rsqb;</mo> </mrow> <mi>T</mi> </msup> </mrow>
其中,ρ是一个正的、可逆的非减函数,z为误差向量,η为无人水面艇的位置和偏航角的输出,为转换惯性矩阵,为转换惯性矩阵的导数,e1为轨迹跟踪误差,e2为滤波跟踪误差,e3为辅助误差,为e3的导数,为辅助项,为辅助函数fe的导数,为误差符号鲁棒积分项μ的导数,为转换后的模型不确定性及风浪流外界时变干扰项的导数,Nd的等价项。
CN201710364373.0A 2017-05-22 2017-05-22 一种无人水面艇的扰动补偿控制方法 Active CN107121928B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710364373.0A CN107121928B (zh) 2017-05-22 2017-05-22 一种无人水面艇的扰动补偿控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710364373.0A CN107121928B (zh) 2017-05-22 2017-05-22 一种无人水面艇的扰动补偿控制方法

Publications (2)

Publication Number Publication Date
CN107121928A true CN107121928A (zh) 2017-09-01
CN107121928B CN107121928B (zh) 2019-08-20

Family

ID=59727530

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710364373.0A Active CN107121928B (zh) 2017-05-22 2017-05-22 一种无人水面艇的扰动补偿控制方法

Country Status (1)

Country Link
CN (1) CN107121928B (zh)

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108008628A (zh) * 2017-11-17 2018-05-08 华南理工大学 一种不确定欠驱动无人艇系统的预设性能控制方法
CN108267953A (zh) * 2017-12-11 2018-07-10 西北工业大学 一种基于领航者-跟踪者水下机器人位置跟踪方法
CN109245743A (zh) * 2018-08-23 2019-01-18 广东电网有限责任公司 一种低通滤波方法和装置
CN109634307A (zh) * 2019-01-15 2019-04-16 大连海事大学 一种无人水下航行器复合航迹跟踪控制方法
CN109839934A (zh) * 2019-02-26 2019-06-04 华南理工大学 基于rise技术的无人水面艇预设性能跟踪控制方法
CN109977587A (zh) * 2019-04-04 2019-07-05 大连海事大学 一种直流电机推进无人水面艇速度控制器设计方法
CN110032075A (zh) * 2019-05-28 2019-07-19 哈尔滨工程大学 一种动力定位船饱和补偿控制系统设计方法
CN110109355A (zh) * 2019-04-29 2019-08-09 山东科技大学 一种基于强化学习的无人艇异常工况自愈控制方法
CN110263400A (zh) * 2019-06-12 2019-09-20 哈尔滨工程大学 一种无人艇非线性动力学模型的积分辨识方法
CN111045332A (zh) * 2019-12-27 2020-04-21 哈尔滨工程大学 一种无人艇路径跟踪导引策略和扰动补偿方法
CN112379685A (zh) * 2020-11-30 2021-02-19 中国科学院沈阳自动化研究所 一种基于风速风向传感器的旋翼无人机控制系统及方法
CN113093735A (zh) * 2021-03-18 2021-07-09 华南理工大学 随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系统及介质
CN113835338A (zh) * 2021-09-08 2021-12-24 哈尔滨工程大学 基于积分滑模的欠驱动无人艇的有限时间跟踪控制方法及装置
CN114692520A (zh) * 2022-03-03 2022-07-01 华南理工大学 一种面向多场景的无人艇虚拟仿真测试平台及测试方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103529842A (zh) * 2013-10-17 2014-01-22 哈尔滨工程大学 一种基于渐近导引的船舶定位控制方法
CN104076821A (zh) * 2014-06-19 2014-10-01 哈尔滨工程大学 基于模糊自适应观测器的欠驱动水面艇轨迹跟踪控制系统
CN104850122A (zh) * 2015-05-13 2015-08-19 上海海事大学 基于可变船长比的抵抗侧风无人水面艇直线路径跟踪方法
CN104932517A (zh) * 2015-05-15 2015-09-23 哈尔滨工业大学 环境干扰下的水下无人航行器航迹跟踪动态面控制优化方法
CN105700352A (zh) * 2016-01-26 2016-06-22 南京理工大学 一种电液负载模拟器误差符号积分鲁棒控制方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103529842A (zh) * 2013-10-17 2014-01-22 哈尔滨工程大学 一种基于渐近导引的船舶定位控制方法
CN104076821A (zh) * 2014-06-19 2014-10-01 哈尔滨工程大学 基于模糊自适应观测器的欠驱动水面艇轨迹跟踪控制系统
CN104850122A (zh) * 2015-05-13 2015-08-19 上海海事大学 基于可变船长比的抵抗侧风无人水面艇直线路径跟踪方法
CN104932517A (zh) * 2015-05-15 2015-09-23 哈尔滨工业大学 环境干扰下的水下无人航行器航迹跟踪动态面控制优化方法
CN105700352A (zh) * 2016-01-26 2016-06-22 南京理工大学 一种电液负载模拟器误差符号积分鲁棒控制方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
王常顺 等: "基于自抗扰控制的水面无人艇", 《山东大学学报(工学版)》 *
邓文翔等: "机电伺服系统鲁棒自适应重复控制", 《上海交通大学学报》 *

Cited By (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108008628B (zh) * 2017-11-17 2020-02-18 华南理工大学 一种不确定欠驱动无人艇系统的预设性能控制方法
CN108008628A (zh) * 2017-11-17 2018-05-08 华南理工大学 一种不确定欠驱动无人艇系统的预设性能控制方法
CN108267953A (zh) * 2017-12-11 2018-07-10 西北工业大学 一种基于领航者-跟踪者水下机器人位置跟踪方法
CN109245743A (zh) * 2018-08-23 2019-01-18 广东电网有限责任公司 一种低通滤波方法和装置
CN109245743B (zh) * 2018-08-23 2021-01-26 广东电网有限责任公司 一种低通滤波方法和装置
CN109634307A (zh) * 2019-01-15 2019-04-16 大连海事大学 一种无人水下航行器复合航迹跟踪控制方法
CN109634307B (zh) * 2019-01-15 2021-08-03 大连海事大学 一种无人水下航行器复合航迹跟踪控制方法
CN109839934A (zh) * 2019-02-26 2019-06-04 华南理工大学 基于rise技术的无人水面艇预设性能跟踪控制方法
CN109977587A (zh) * 2019-04-04 2019-07-05 大连海事大学 一种直流电机推进无人水面艇速度控制器设计方法
CN109977587B (zh) * 2019-04-04 2022-12-13 大连海事大学 一种直流电机推进无人水面艇速度控制器设计方法
CN110109355A (zh) * 2019-04-29 2019-08-09 山东科技大学 一种基于强化学习的无人艇异常工况自愈控制方法
CN110032075A (zh) * 2019-05-28 2019-07-19 哈尔滨工程大学 一种动力定位船饱和补偿控制系统设计方法
CN110032075B (zh) * 2019-05-28 2022-04-05 哈尔滨工程大学 一种动力定位船饱和补偿控制系统设计方法
CN110263400A (zh) * 2019-06-12 2019-09-20 哈尔滨工程大学 一种无人艇非线性动力学模型的积分辨识方法
CN110263400B (zh) * 2019-06-12 2022-08-02 哈尔滨工程大学 一种无人艇非线性动力学模型的积分辨识方法
CN111045332A (zh) * 2019-12-27 2020-04-21 哈尔滨工程大学 一种无人艇路径跟踪导引策略和扰动补偿方法
CN112379685A (zh) * 2020-11-30 2021-02-19 中国科学院沈阳自动化研究所 一种基于风速风向传感器的旋翼无人机控制系统及方法
CN113093735B (zh) * 2021-03-18 2022-07-26 华南理工大学 随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系统及介质
CN113093735A (zh) * 2021-03-18 2021-07-09 华南理工大学 随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系统及介质
CN113835338A (zh) * 2021-09-08 2021-12-24 哈尔滨工程大学 基于积分滑模的欠驱动无人艇的有限时间跟踪控制方法及装置
CN113835338B (zh) * 2021-09-08 2024-03-01 哈尔滨工程大学 积分滑模的欠驱动无人艇的有限时间跟踪控制方法及装置
CN114692520A (zh) * 2022-03-03 2022-07-01 华南理工大学 一种面向多场景的无人艇虚拟仿真测试平台及测试方法
CN114692520B (zh) * 2022-03-03 2024-03-19 华南理工大学 一种面向多场景的无人艇虚拟仿真测试平台及测试方法

Also Published As

Publication number Publication date
CN107121928B (zh) 2019-08-20

Similar Documents

Publication Publication Date Title
CN107121928A (zh) 一种无人水面艇的扰动补偿控制方法
CN108445892B (zh) 一种欠驱动无人船编队控制器结构及设计方法
Do et al. Underactuated ships follow smooth paths with integral actions and without velocity measurements for feedback: theory and experiments
Nguyen et al. Design of hybrid controller for dynamic positioning from calm to extreme sea conditions
Fossen et al. Nonlinear output feedback control of dynamically positioned ships using vectorial observer backstepping
Bui et al. A ship berthing system design with four tug boats
CN106227223A (zh) 一种基于动态滑模控制的uuv轨迹跟踪方法
CN107168312A (zh) 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法
CN109814392A (zh) 一种欠驱动水下机器人执行器故障鲁棒容错控制方法
CN102589552B (zh) 低成本组合导航系统的数据融合方法和装置
CN103955218A (zh) 一种基于非线性控制理论的无人艇轨迹跟踪控制装置及方法
CN103970021A (zh) 一种基于模型预测控制的松弛动力定位控制系统
CN103217160A (zh) 一种船舶动力定位卡尔曼滤波方法
Liu et al. Filtering based multi-sensor data fusion algorithm for a reliable unmanned surface vehicle navigation
Candeloro et al. Observers for dynamic positioning of ROVs with experimental results
CN103699007B (zh) 一种船舶动力定位系统的设计方法
Koschorrek et al. Dynamic positioning with active roll reduction using Voith Schneider propeller
Ji et al. Nonlinear observer and sliding mode control design for dynamic positioning of a surface vessel
Lawrance et al. Ocean deployment and testing of a semi-autonomous underwater vehicle
CN114610046A (zh) 一种考虑动态水深的无人艇动态安全轨迹规划方法
Cahyadi et al. Performance of GPS and IMU sensor fusion using unscented Kalman filter for precise i-Boat navigation in infinite wide waters
CN107063300A (zh) 一种基于反演的水下导航系统动力学模型中扰动估计方法
von Ellenrieder Control of marine vehicles
Do et al. Design and simulate a Fuzzy autopilot for an Unmanned Surface Vessel
Thomas et al. Efficient simulation of wave glider dynamics and validation with trans-Pacific voyages

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant