CN106444806A - 基于生物速度调节的欠驱动auv三维轨迹跟踪控制方法 - Google Patents
基于生物速度调节的欠驱动auv三维轨迹跟踪控制方法 Download PDFInfo
- Publication number
- CN106444806A CN106444806A CN201610854361.1A CN201610854361A CN106444806A CN 106444806 A CN106444806 A CN 106444806A CN 201610854361 A CN201610854361 A CN 201610854361A CN 106444806 A CN106444806 A CN 106444806A
- Authority
- CN
- China
- Prior art keywords
- centerdot
- error
- theta
- auv
- speed
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 41
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 10
- 238000009795 derivation Methods 0.000 claims description 8
- 230000003044 adaptive effect Effects 0.000 claims description 5
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000001105 regulatory effect Effects 0.000 abstract description 2
- 238000013178 mathematical model Methods 0.000 abstract 1
- 230000001276 controlling effect Effects 0.000 description 19
- 238000013461 design Methods 0.000 description 11
- 230000008859 change Effects 0.000 description 6
- 230000008569 process Effects 0.000 description 5
- 238000004088 simulation Methods 0.000 description 5
- 230000033001 locomotion Effects 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000035772 mutation Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
- 230000036962 time dependent Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0875—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted to water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提供的是一种基于生物速度调节的欠驱动AUV三维轨迹跟踪控制方法。包括以下步骤:步骤1:AUV根据当前任务给定期望轨迹位置信息并获取当前的位置、姿态信息;步骤2:利用欠驱动UUV的数学模型得出位置、姿态误差变量;步骤3:采用定义虚拟速度误差变量的方法,计算出虚拟控制律;步骤4:通过生物启发模型完成对速度误差进行动态调节;步骤5:推导动态速度调节控制器。本发明方法能够对欠驱动AUV的速度误差进行动态调节,同时在避免传统反步法中艏向角误差等于90°时奇异值的同时,提高了控制器的性能,实现了在外界常值扰动下对时变三维轨迹的精确跟踪。
Description
技术领域
本发明涉及的是一种水下无人航行器的运动控制方法,具体地说是一种欠驱动水下无人航行器的运动控制方法。
背景技术
水下无人航行器(Autonomous underwater vehicle,AUV)的三维空间轨迹跟踪能力是实现海洋资源开发、海底地形勘测等领域重要技术前提。欠驱动AUV只具有纵向推进器,在垂向和横向上缺少推进器,AUV在水下三维空间的六自由度运动形式使得模型具有高度耦合性和非线性特性,加之外界的干扰导致模型参数的不确定性,且还需满足时间与空间上的要求,使得欠驱动AUV的三维轨迹跟踪控制更加难以实现。
目前对于AUV的轨迹和路径跟踪控制的研究方法大多采用反步法设计控制器,反步法在解决不确定非线性系统的控制设计中具有明显优势。反步法采用基于系统分层递推的设计思想,通过分步构造李雅普诺夫能量函数,通过设计中间虚拟控制函数并逐步计算出中间虚拟控制量的导数,然后逐级的引入后续的子系统,实现对前级子系统的镇定,利用这种迭代的思想获得最终的实际控制输入。可直接对虚拟控制量解析求导会导致“计算膨胀”,并且虚拟速度控制都和误差相关,当误差增大时,速度会产生较大的跳变,可能会超出控制力矩的输出范围,导致控制失效。为此本发明将生物启发模型和定义虚拟速度误差变量反步控制方法相结合,利用生物启发模型来调节所设计的速度误差,实现了对速度误差进行一定范围内动态调节的目的。从动力学角度设计了欠驱动AUV三维生物速度调节轨迹跟踪控制器,克服了反步法跟踪控制中拐点处跳变的问题,在保证避免奇异值的同时,增加了系统对拐点跳变的鲁棒性。为了克服传统反步法中的计算量大的缺点,文献《Position-tracking control of underactuated autonomous underwater vehicles in thepresence of unknown ocean currents》(IET Control Theory and Applications.2010,第4卷第11期)通过定义虚拟速度误差变量简化了传统反步法中的中间计算过程;文献《欠驱动无人水下航行器三维轨迹跟踪的反步控制》(控制理论与应用.2014,第31卷第11期)提出了定义虚拟速度误差变量的方法,并实现了欠驱动UUV三维轨迹跟踪控制,但该方法为了避免虚拟控制律中分母可能出现的奇异值,降低了系统的控制性能,且文中未对轨迹的直角拐点进行研究处理;文献《An efficient neural network approach to trackingcontrol of an autonomous surface vehicle with unknown dynamics》(ExpertSystems with Applications.2013,第40卷第5期)将一种生物启发模型和反步法应用在移动机器人和水面艇中,然而平面移动机器人和水面艇的结构相对简单,控制器的设计较容易;文献《A Bioinspired Filtered Backstepping Tracking Control of 7000-m MannedSubmarine Vehicle》(IEEE Transactions on Industrial Electronics.2014,第61卷第7期)将这种生物启发模型应用在全驱动水下航行器中,且该方法只是从运动学的角度起到了平滑与滤波的作用,并未考虑动力学模型的设计;目前还没有相关文献讨论基于生物速度调节的欠驱动AUV三维轨迹跟踪控制设计。
申请人提出的申请号为201610247753.1的专利文件中,公开了《一种基于动态速度调节的欠驱动UUV平面轨迹跟踪控制方法》,改进定义虚拟速度误差变量反步法的控制律,提出利用生物启发模型对速度误差进行动态调节的方法,但该方法只停留在研究平面轨迹跟踪控制上,且只能对光滑的轨迹进行跟踪,实际应用价值有限。
发明内容
本发明的目的在于提供一种速度可调的、避免出现奇异值的基于生物速度调节的基于生物速度调节的欠驱动AUV三维轨迹跟踪控制方法。
本发明的目的是这样实现的:
步骤1、AUV根据当前任务,给定一个期望状态Xd(t)=[xd(t),yd(t),zd(t),θd(t),ψd(t)]T,并通过所搭载的导航设备和传感器获取AUV的实际状态X(t)=[x(t),y(t),z(t),θ(t),ψ(t)]T和速度V(t)=[u(t),v(t),ω(t),q(t),r(t)]T信息,其中xd(t),yd(t),zd(t)和θd(t),ψd(t)为地面坐标下AUV的期望位置与姿态,x(t),y(t),z(t)和θ(t),ψ(t)为地面坐标下AUV的实际位置和姿态,u(t),v(t),ω(t)和q(t),r(t)为船体坐标系下的线速度和角速度;
步骤2、利用步骤1中的得到的AUV实际状态,通过欠驱动AUV的数学模型和轨迹跟踪位置误差模型,计算出实际轨迹与期望轨迹之间的位置误差和姿态误差,将地面坐标信息转换为船体坐标信息;
步骤3、基于步骤2中计算出的位置和姿态误差,采用定义虚拟速度误差变量的方法,将姿态跟踪控制转化为速度控制,计算出纵向速度虚拟控制律ud、纵倾角速度虚拟控制律qd和艏摇角速度虚拟控制律rd;
步骤4、计算得出纵向速度误差eu,纵倾角速度误差eq和艏摇角速度误差er,并将这三个误差分别通入生物启发模型,通过设置生物启发模型中的参数,完成对速度误差的动态调节;
步骤5、根据给定的数学模型和步骤4中经动态调节后得到的输出量,推导欠驱动AUV三维轨迹跟踪的动态速度调节控制器,包括纵向控制力矩τu的控制信号、纵倾控制力矩τq和艏摇控制力矩τr的控制信号,并对当前环境扰动进行估计设计了自适应控制律,实现在外界常值扰动下对欠驱动AUV三维轨迹跟踪控制。
本发明还可以包括:
1、所述欠驱动AUV的数学模型包括运动学模型、动力学模型、轨迹跟踪误差模型、位置误差以及期望姿态,表达式分别为:
运动学模型:
动力学模型:
其中: d22=Yv+Yv|v||v|;d33=Zw+Zw|w||w|;d55=Mq+Mq|q||q|;d66=Nr+Nr|r||r|;Xu,Xu|u|,Yv,Yv|v|,Zw,Zw|w|,Mq,Mq|q|,Nr,Nr|r|为水动力参数;ρ,g,▽,分别为水密度、重力加速度、水容积和纵向稳心高;ωu、ωv、ωw、ωq、ωr为外界干扰在AUV运动系各自由度的分量;
位置误差:
轨迹跟踪位置误差模型:
其中,
期望姿态:
2、定义虚拟速度误差变量:
α=vt sineψ,β=vp sineθ;
步骤3中所涉及的纵向速度虚拟控制律ud,纵倾角速度虚拟控制律qd和艏摇角速度虚拟控制律rd的表达式分别为:
纵向速度虚拟控制律:
ud=-k1ex/e+vpsinθdsinθ+vtcosθcoseψ,
其中,k1为正常数,
艏向角、纵倾角速度虚拟控制律:
3、所述的纵向速度误差eu角速,度误差er、eq,生物启发模型的表达式分别为:
纵向速度误差:
eu=u-ud;
角速度误差:
生物启发模型:
其中i=u,q,r;j=1,2,3,Su、Sq和Sr分别为纵向速度误差、纵倾角速度误差和首向角速度误差动态模型的输出;参数Aj是正常数,为动态速度误差输出的衰减率;正常数Bj和Dj分别为动态速度误差输出的上限和下限;eu、eq和er的值通过分别设置Aj、Bj和Dj以及生物模型本身的特性来完成对速度误差的动态调节,函数f(ei)=max{ei,0},g(ei)=max{-ei,0}。
4、所述的纵向控制力矩τu的控制信号、纵倾控制力矩τq和艏摇控制力矩τr的控制信号的表达式分别为:
其中,为对当前环境扰动的估计值;
所述的界扰动自适应控制律为:
其中,c1,c2,c3均是正常数。
本发明方法针对欠驱动无人水下航行器三维轨迹跟踪控制中的位置、速度、姿态等随时间变化的要求,定义了虚拟速度误差控制变量的反步控制设计方法,有别于传统定义虚拟速度误差变量的方法,有效的避免了控制律中出现奇异值的问题,并利用生物启发模型来调节所设计的速度误差,实现了对速度进行一定范围内的动态调节的目的,该设计在保证避免奇异值的同时,提高了控制器的性能。同时设计了欠驱动AUV平面动态速度调节轨迹跟踪控制器,并基于李雅普诺夫理论证明了该控制系统误差在外界常值扰动下最终一致有界。仿真研究中考虑到了艏向角误差为±90°的情况,仿真结果表明,本发明所提出的控制方法收敛、有效,可以实现欠驱动AUV三维轨迹的精确跟踪控制。
相比已有平面动态速度调节轨迹跟踪方法,本发明方法不仅将其扩展到三维空间中,而且还能针对不光滑轨迹进行精确的跟踪,对拐点以及突变轨迹有较强的跟踪能力,这些对于欠驱动水下无人航行器不仅具有科学的研究意义,而且还具有工程应用价值,其更接近实际 使用,有利于加快本发明的技术转化。
本发明方法的有益效果主要体现在:
1、定义了虚拟速度误差变量,将姿态跟踪控制转化为速度控制,简化了计算过程;
2、设计了虚拟控制律,避免了基于虚拟速度误差变量反步法设计虚拟控制量时,艏向角误差为±90°时的奇异值问题;
3、将纵向速度误差、艏向角速度误差和纵倾角速度误差分别通入到生物启发模型,完成了对速度的动态调节增加了系统的控制性能;
4、在外界常值扰动下可以实现对欠驱动AUV不光滑的三维轨迹精确跟踪控制。
附图说明
图1欠驱动水下无人航行器三维轨迹跟踪控制结算流程图;
图2 AUV大地坐标系与船体坐标系;
图3欠驱动AUV三维轨迹跟踪控制系统结构图;
图4三维轨迹跟踪控制效果图;
图5三维轨迹跟踪XY平面投影;
图6三维轨迹跟踪XZ平面投影;
图7 AUV总位置误差和姿态角误差;
图8 AUV三维轨迹跟踪位置误差;
图9 AUV线速度响应曲线;
图10 AUV角速度响应曲线;
图11 AUV实际控制输入;
图12 AUV纵向速度误差与其调节输出;
图13 AUV纵倾角速度误差与其调节输出;
图14 AUV艏向角速度误差与其调节输出。
具体实施方式
下面举例对本发明做更详细的描述。
步骤1中AUV根据当前任务,将期望轨迹位置信息给定AUV,并通过所搭载的导航设备和传感器采集数据,获得当前的位置X(t)=[x(t),y(t),z(t)]T信息、姿态[θ(t),ψ(t)]T信息、速 度V(t)=[u(t),v(t),ω(t),q(t),r(t)]T信息。
然后AUV获取在地面坐标系下的初始位置X(t)=[x(t),y(t),z(t)]T,AUV初始的艏向角ψ(t),纵倾角θ(t),AUV的初始纵向速度ur(t)、横向速度vr(t)和艏摇角速度r(t),并给定期望轨迹位置Xd(t)=[xd(t),yd(t),zd(t)]T。
步骤2中利用步骤1中的信息,通过欠驱动AUV的数学模型和轨迹跟踪位置误差模型,计算出实际轨迹与期望轨迹之间的位置误差,和期望姿态,将地面坐标信息转换为船体坐标信息。
所涉及的欠驱动AUV的数学模型包括运动学模型和动力学模型表达式为:
运动学模型:
动力学模型:
其中: d11=Xu+Xu|u||u|;d22=Yv+Yv|v||v|;d33=Zw+Zw|w||w|;d55=Mq+Mq|q||q|;d66=Nr+Nr|r||r|;Xu,Xu|u|,Yv,Yv|v|,Zw,Zw|w|,Mq,Mq|q|,Nr,Nr|r|为水动力参数;ρ,g,▽,分别为水密度、重力加速度、水下全排水容积和初稳心高;ωu、ωv、ωw、ωq、ωr为外界干扰在AUV运动系各自由度的分量。
根据给定的期望轨迹位置信息可以得到AUV的期望姿态:
姿态误差方程为:
所述的将地面坐标信息转换为船体坐标的过程如下:
首先根据期望轨迹获得地面坐标系下的位置误差为:
再经过坐标转换后得到新的船体坐标系下的位置误差为:
轨迹跟踪位置误差模型:
其中定义至此完成了欠驱动AUV的初始化设置。
欠驱动AUV满足如下的假设:
假设1.1欠驱动AUV的速度和控制输入均有界,即其中,均为已知的上界。
假设1.2当t>0时,期望轨迹的变量ud,qd,rd均有界,且它们的导数也有界。
假设1.3对欠驱动AUV的纵倾角|θ(t)|≤π/2。
步骤3中按下式分别给出或计算出所定义的虚拟速度误差变量、纵向速度虚拟控制律ud、纵倾角速度虚拟控制律qd和艏向角速度虚拟控制律rd。
对于位置误差(6)构造李雅普诺夫能量函数:
定义虚拟速度误差变量:
α=vt sineψ,β=vp sineθ (9)
所设计的虚拟控制律αd、βd:
纵向速度虚拟控制律:
ud=-k1ex/e+vpsinθdsinθ+vtcosθcoseψ (11)
其中k1,k2,k3都是正常数,
给出误差变量分别为:
结合式(9)-(12)对(8)式求导可得出:
然后对虚拟控制量eα、eβ构造李雅普诺夫能量函数:
所设计的艏向角和纵倾角速度虚拟控制律为:
给出误差变量为:
结合式(15),(16)对(14)式求导可得出:
其中
步骤4中将步骤3中计算得出的纵向速度和纵倾角、艏向角角速度误差通入生物模型对其进行动态调节,可得到如下的方程:
其中(i=u,q,r;j=1,2,3),Su、Sq和Sr分别为纵向速度误差、纵倾角速度误差和艏向角速度误差动态模型的输出;参数Aj是正常数,为动态速度误差输出的衰减率;正常数Bj和Dj分别为动态速度误差输出的上限和下限;从Su、Sq和Sr的输出可以看出,eu、eq和er的值可以通过分别设置Aj、Bj和Dj以及生物模型本身的特性来完成对速度误差的动态调节,这也是本发明的最大创新之处,函数f(ei)=max{ei,0},g(ei)=max{-ei,0}。
步骤5中推导的欠驱动AUV三维轨迹跟踪的生物速度调节控制器,具体的计算和推到过程如下:
对于速度误差eu、eq和er,构造李雅普诺夫能量函数:
结合(17)式,对(19)式求导可得:
其中δ=eαvtδ1cos-1θ+eβvpδ2.
控制输入τu,τq,τr选取为:
其中,
结合(20)-(22)式,可得到:
其中为对当前环境扰动的估计值。
对于模型输出量Su、Sq和Sr,构造李雅普诺夫能量函数:
结合(18)和(23)式,对(24)式求导可得:
其中(i=u,q,r;j=1,2,3)。
最终得到系统的误差方程
令Bj=Dj(j=1,2,3),当ei>0时,f(ei)=ei,g(ei)=0,因此:
f(ei)-g(ei)-ei=0 (27)
当ei<0时,f(ei)=0,g(ei)=ei,因此:
f(ei)-g(ei)-ei=0 (28)
其中(i=u,q,r).因此Bu=0,Bq=0,Br=0。
将式(27)、(28)代入(25)得到:
由函数f(ei)、g(ei)定义可知f(ei)≥0,g(ei)≥0,另外参数Aj,Bj,Dj(j=1,2,3)均是正常数,因此Ai≥0(i=u,q,r).其中
对于外界干扰量,构造李雅普诺夫能量函数:
其中c1,c2,c3都是正常数,对式(30)两边求导得:
根据式(31)分别设计外界常值干扰的自适应控制律为:
将式(32)代入式(31),得:
且参数k1,k2,k3,k4,k5,c1,c2,c3均是正常数,且Ai≥0(i=u,q,r).所以在假设1.1和假设1.2条件下δ=eαvtδ1cos-1θ+eβvpδ2存在最大值即δ有界。
定义结合式(33)有
2V5=||z||2 (34)
再结合(30)有
其中γ=min{k1,k2,k3,k4,Au,Aq,Ar,c1,c2,c3},由于δ有界,根据参考文献[8]中的比较原理,有:
因此:
式(37)表明,Lyapunov函数V5被界定在(0-δ/2γ)范围内,即控制误差均是有界的,且收敛在半径为δ/2γ的邻域内,且可以通过增大增益k1,k2,k3,k4,Au,Aq,Ar,c1,c2,c3,获得较大的γ值,以使收敛半径变的足够小.即系统误差最终一致有界。
仿真实验验证与分析
下面举例说明并验证本发明方法的有效性:
为了验证所提控制方法的优点和有效性,及动态速度调节的效果,并从实际工程的角度考虑设计了一种螺旋下潜并结合平面搜索的三维时变轨迹曲线.为了证明所设计控制器能够有效的解决当艏向角误差ψe=±π/2时控制律中存在奇异值的情况,在设计平面跟踪时考虑到了此种情况.其中螺旋下潜部分选取轨迹为
起始点为(x,y,z)=(10,90,10),即选取的初始位置误差为(xe,ye,ze)=(10,-10,10),螺旋下潜与平面轨迹的切换a点选取为(x,y,z)=(-54.4,-84.0,100),几个轨迹直角拐点分别选取为b:(x,y,z)=(-104.4,-84.0,100),c:(x,y,z)=(-104.4,66.0,100),d:(x,y,z)=(-154.4,66,100),e:(x,y,z)=(-154.4,-84.0,100),f:(x,y,z)=(-204.4,-84.0,100)。初始姿态和航速均为零,控制增益为:k1=2,k2=0.5,k3=1,k4=0.5,c1=0.5,c2=0.1,c3=0.1,三个生物模型参数分别选取为:
模型参数如下:仿真中所用到的模型参数为:m=165kg,Iz=50kgm2,Xu=70kg/s,Xu|u|=100kg/s,Yv=100kg/m,Yv|v|=200kg/m,Zw=100kg/s,Zw|w|=200kg/s,Nr=50kgm2/s,Nr|r|=100kgm2,Mq=50kgm2/s,Mq|q|=100kgm2。外界常值环境扰动为:ωu=0.5N,ωv=0N,ωw=0N,ωr=0.1Nm,ωr=0.1Nm。Simulink仿真实验结果如图4-图14所示。
图4为欠驱动AUV对期望轨迹的三维空间螺旋与平面跟踪;
图5、图6,分别为三维轨迹跟踪XY平面投影和三维轨迹跟踪XZ平面投影,控制器在juyou一定初始位置念头下较平滑的实现对三维路径的跟踪控制,且保证了跟踪精度;
图7、图8表示出各项跟踪的误差都足够小,且最终趋于零,图7中我们定义的表示的是期望轨和实际轨迹的总体误差值,其中五个艏向角误差ψe=±π/2也清晰可见,在拐点处跳变大的问题得到解决,艏向角的超调振荡小,调节时间短,控制效果好,说明本发明所提控制方法的有效性和鲁棒性;从图8可以看出各项位置误差的变化,且较快的趋于零;
图9为欠驱动AUV线速度响应曲线,从中可以看出即使在角度突变的情况下,速度变化依然较缓,说明所提方法很好的抑制了速度突变的问题;
图10为欠驱动AUV角速度响应曲线,虽然在角度突变时有较大的变化,但依然能实现对跟踪误差的控制;
图11为AUV的实际控制输入相应的变化情况;
图12、图13、图14分别为纵向速度误差、纵倾角速度误差、艏向角速度误差分别与其通入生物启发模型后的输出,可以看出其动态速度调节的效果很明显,图12中纵向速度误差在拐点突变出缩小超调约25%;图13中纵倾角速度误差在螺旋曲线向平面过度时缩小超调约28%;图14艏向角速度误差在每个拐点处缩小超调最大约26%;调节后的各项速度误差输出明显小于调节前;
从图4-图14可以看出本发明所设计的欠驱动AUV生物速度调节轨迹跟踪控制器能够实现在外界常值扰动下对时变三维轨迹的精确跟踪。
Claims (5)
1.一种基于生物速度调节的欠驱动AUV三维轨迹跟踪控制方法,其特征是:
步骤1、AUV根据当前任务,给定一个期望状态Xd(t)=[xd(t),yd(t),zd(t),θd(t),ψd(t)]T,并通过所搭载的导航设备和传感器获取AUV的实际状态X(t)=[x(t),y(t),z(t),θ(t),ψ(t)]T和速度V(t)=[u(t),v(t),ω(t),q(t),r(t)]T信息,其中xd(t),yd(t),zd(t)和θd(t),ψd(t)为地面坐标下AUV的期望位置与姿态,x(t),y(t),z(t)和θ(t),ψ(t)为地面坐标下AUV的实际位置和姿态,u(t),v(t),ω(t)和q(t),r(t)为船体坐标系下的线速度和角速度;
步骤2、利用步骤1中的得到的AUV实际状态,通过欠驱动AUV的数学模型和轨迹跟踪位置误差模型,计算出实际轨迹与期望轨迹之间的位置误差和姿态误差,将地面坐标信息转换为船体坐标信息;
步骤3、基于步骤2中计算出的位置和姿态误差,采用定义虚拟速度误差变量的方法,将姿态跟踪控制转化为速度控制,计算出纵向速度虚拟控制律ud、纵倾角速度虚拟控制律qd和艏摇角速度虚拟控制律rd;
步骤4、计算得出纵向速度误差eu,纵倾角速度误差eq和艏摇角速度误差er,并将这三个误差分别通入生物启发模型,通过设置生物启发模型中的参数,完成对速度误差的动态调节;
步骤5、根据给定的数学模型和步骤4中经动态调节后得到的输出量,推导欠驱动AUV三维轨迹跟踪的动态速度调节控制器,包括纵向控制力矩τu的控制信号、纵倾控制力矩τq和艏摇控制力矩τr的控制信号,并对当前环境振动进行估计设计了自适应控制律,实现在外界常值扰动下对欠驱动AUV三维轨迹跟踪控制。
2.根据权利要求1所述的基于生物速度调节的欠驱动AUV三维轨迹跟踪控制方法,其特征是所述欠驱动AUV的数学模型包括运动学模型、动力学模型、轨迹跟踪误差模型、位置误差以及期望姿态,表达式分别为:
运动学模型:
动力学模型:
其中: d11=Xu+Xu|u||u|;d22=Yv+Yv|v||v|;d33=Zw+Zw|w||w|;d55=Mq+Mq|q||q|;d66=Nr+Nr|r||r|;Xu,Xu|u|,Yv,Yv|v|,Zw,Zw|w|,Mq,Mq|q|,Nr,Nr|r|为水动力参数;ρ,g,▽,分别为水密度、重力加速度、水容积和纵向稳心高;ωu、ωv、ωw、ωq、ωr为外界干扰在AUV运动系各自由度的分量;
位置误差:
轨迹跟踪位置误差模型:
其中,
期望姿态:
3.根据权利要求1所述的基于生物速度调节的欠驱动AUV三维轨迹跟踪控制方法,其特征是步骤3中所涉及的纵向速度虚拟控制律ud,纵倾角速度虚拟控制律qd和艏摇角速度虚拟控制律rd,以及定义虚拟速度误差变量的表达式分别为:
虚拟速度误差变量:
α=vtsineψ,β=vpsineθ;
纵向速度虚拟控制律:
ud=-k1ex/e+vpsinθdsinθ+vtcosθcoseψ,
其中,k1为正常数,
艏向角、纵倾角速度虚拟控制律:
4.根据权利要求1所述的基于生物速度调节的欠驱动AUV三维轨迹跟踪控制方法,其特征是所述的纵向速度误差eu角速,度误差er、eq,生物启发模型的表达式分别为:
纵向速度误差:
eu=u-ud;
角速度误差:
生物启发模型:
其中i=u,q,r;j=1,2,3,Su、Sq和Sr分别为纵向速度误差、纵倾角速度误差和首向角速度误差动态模型的输出;参数Aj是正常数,为动态速度误差输出的衰减率;正常数Bj和Dj分别为动态速度误差输出的上限和下限;eu、eq和er的值通过分别设置Aj、Bj和Dj以及生物模型本身的特性来完成对速度误差的动态调节,函数f(ei)=max{ei,0},g(ei)=max{-ei,0}。
5.根据权利要求1所述的基于生物速度调节的欠驱动AUV三维轨迹跟踪控制方法,其特征是所述的纵向控制力矩τu的控制信号、纵倾控制力矩τq和艏摇控制力矩τr的控制信号的表达式分别为:
其中, 为对当前环境扰动的估计值;
所述的界扰动自适应控制律为:
其中,c1,c2,c3均是正常数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610854361.1A CN106444806B (zh) | 2016-09-27 | 2016-09-27 | 基于生物速度调节的欠驱动auv三维轨迹跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610854361.1A CN106444806B (zh) | 2016-09-27 | 2016-09-27 | 基于生物速度调节的欠驱动auv三维轨迹跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106444806A true CN106444806A (zh) | 2017-02-22 |
CN106444806B CN106444806B (zh) | 2019-03-05 |
Family
ID=58170535
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610854361.1A Active CN106444806B (zh) | 2016-09-27 | 2016-09-27 | 基于生物速度调节的欠驱动auv三维轨迹跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106444806B (zh) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106950974A (zh) * | 2017-04-19 | 2017-07-14 | 哈尔滨工程大学 | 欠驱动自主水下航行器的对三维路径进行理解及跟踪控制方法 |
CN107024863A (zh) * | 2017-03-24 | 2017-08-08 | 哈尔滨工程大学 | 一种避免微分爆炸的uuv轨迹跟踪控制方法 |
CN107544258A (zh) * | 2017-10-17 | 2018-01-05 | 西北工业大学 | 自主型水下航行器自适应反演控制方法 |
CN108363400A (zh) * | 2018-01-29 | 2018-08-03 | 哈尔滨工程大学 | 一种基于虚拟锚泊的欠驱动auv三维控制区域镇定控制方法 |
CN108897217A (zh) * | 2018-07-04 | 2018-11-27 | 西北工业大学 | 一种基于模型预测控制的欠驱动水面船轨迹跟踪控制方法 |
CN109693774A (zh) * | 2018-12-29 | 2019-04-30 | 中国科学院声学研究所 | 一种水下航行器轨迹的控制方法和系统 |
CN109901402A (zh) * | 2019-04-08 | 2019-06-18 | 哈尔滨工程大学 | 一种基于航向平滑技术的自主水下机器人路径跟踪方法 |
CN109976384A (zh) * | 2019-03-13 | 2019-07-05 | 厦门理工学院 | 一种自治水下机器人及路径跟随控制方法、装置 |
CN110308735A (zh) * | 2019-03-08 | 2019-10-08 | 哈尔滨工程大学 | 一种针对输入时滞的欠驱动uuv轨迹跟踪滑模控制方法 |
CN110618606A (zh) * | 2019-09-30 | 2019-12-27 | 哈尔滨工程大学 | 一种复合干扰下的欠驱动auv反步自适应模糊滑模控制方法 |
CN110647161A (zh) * | 2019-10-15 | 2020-01-03 | 哈尔滨工程大学 | 基于状态预测补偿的欠驱动uuv水平面轨迹跟踪控制方法 |
CN111045432A (zh) * | 2019-12-31 | 2020-04-21 | 哈尔滨工程大学 | 一种欠驱动水面船非线性路径跟踪控制系统及方法 |
CN111830832A (zh) * | 2020-07-27 | 2020-10-27 | 中国科学院自动化研究所 | 仿生滑翔机器海豚平面路径跟踪方法及系统 |
CN113132905A (zh) * | 2021-04-21 | 2021-07-16 | 湖南国天电子科技有限公司 | 一种具有动态节点的自主水下机器人无线传感器网络 |
CN114019805A (zh) * | 2021-11-17 | 2022-02-08 | 九江职业技术学院 | 一种欠驱动auv的模型预测对接控制方法 |
CN117472084A (zh) * | 2023-10-19 | 2024-01-30 | 哈尔滨工程大学 | 一种欠驱动水下机器人对接过程中的对接控制方法及装置 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104501815A (zh) * | 2014-12-18 | 2015-04-08 | 西北工业大学 | 一种水下自主航行器导航远程导航方法 |
CN105786012A (zh) * | 2016-03-24 | 2016-07-20 | 哈尔滨工程大学 | 基于生物激励模型的uuv虚拟速度控制方法 |
CN105929842A (zh) * | 2016-04-20 | 2016-09-07 | 哈尔滨工程大学 | 一种基于动态速度调节的欠驱动uuv平面轨迹跟踪控制方法 |
-
2016
- 2016-09-27 CN CN201610854361.1A patent/CN106444806B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104501815A (zh) * | 2014-12-18 | 2015-04-08 | 西北工业大学 | 一种水下自主航行器导航远程导航方法 |
CN105786012A (zh) * | 2016-03-24 | 2016-07-20 | 哈尔滨工程大学 | 基于生物激励模型的uuv虚拟速度控制方法 |
CN105929842A (zh) * | 2016-04-20 | 2016-09-07 | 哈尔滨工程大学 | 一种基于动态速度调节的欠驱动uuv平面轨迹跟踪控制方法 |
Cited By (30)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107024863A (zh) * | 2017-03-24 | 2017-08-08 | 哈尔滨工程大学 | 一种避免微分爆炸的uuv轨迹跟踪控制方法 |
CN107024863B (zh) * | 2017-03-24 | 2020-01-17 | 哈尔滨工程大学 | 一种避免微分爆炸的uuv轨迹跟踪控制方法 |
CN106950974A (zh) * | 2017-04-19 | 2017-07-14 | 哈尔滨工程大学 | 欠驱动自主水下航行器的对三维路径进行理解及跟踪控制方法 |
CN106950974B (zh) * | 2017-04-19 | 2020-07-28 | 哈尔滨工程大学 | 欠驱动自主水下航行器的对三维路径进行理解及跟踪控制方法 |
CN107544258A (zh) * | 2017-10-17 | 2018-01-05 | 西北工业大学 | 自主型水下航行器自适应反演控制方法 |
CN107544258B (zh) * | 2017-10-17 | 2020-04-03 | 西北工业大学 | 自主型水下航行器自适应反演控制方法 |
CN108363400B (zh) * | 2018-01-29 | 2020-12-22 | 哈尔滨工程大学 | 一种基于虚拟锚泊的欠驱动auv三维控制区域镇定控制方法 |
CN108363400A (zh) * | 2018-01-29 | 2018-08-03 | 哈尔滨工程大学 | 一种基于虚拟锚泊的欠驱动auv三维控制区域镇定控制方法 |
CN108897217A (zh) * | 2018-07-04 | 2018-11-27 | 西北工业大学 | 一种基于模型预测控制的欠驱动水面船轨迹跟踪控制方法 |
CN109693774A (zh) * | 2018-12-29 | 2019-04-30 | 中国科学院声学研究所 | 一种水下航行器轨迹的控制方法和系统 |
CN109693774B (zh) * | 2018-12-29 | 2020-11-03 | 中国科学院声学研究所 | 一种水下航行器轨迹的控制方法和系统 |
CN110308735B (zh) * | 2019-03-08 | 2022-07-15 | 哈尔滨工程大学 | 一种针对输入时滞的欠驱动uuv轨迹跟踪滑模控制方法 |
CN110308735A (zh) * | 2019-03-08 | 2019-10-08 | 哈尔滨工程大学 | 一种针对输入时滞的欠驱动uuv轨迹跟踪滑模控制方法 |
CN109976384A (zh) * | 2019-03-13 | 2019-07-05 | 厦门理工学院 | 一种自治水下机器人及路径跟随控制方法、装置 |
CN109976384B (zh) * | 2019-03-13 | 2022-02-08 | 厦门理工学院 | 一种自治水下机器人及路径跟随控制方法、装置 |
CN109901402A (zh) * | 2019-04-08 | 2019-06-18 | 哈尔滨工程大学 | 一种基于航向平滑技术的自主水下机器人路径跟踪方法 |
CN109901402B (zh) * | 2019-04-08 | 2021-10-29 | 哈尔滨工程大学 | 一种基于航向平滑技术的自主水下机器人路径跟踪方法 |
CN110618606A (zh) * | 2019-09-30 | 2019-12-27 | 哈尔滨工程大学 | 一种复合干扰下的欠驱动auv反步自适应模糊滑模控制方法 |
CN110618606B (zh) * | 2019-09-30 | 2022-06-17 | 哈尔滨工程大学 | 一种复合干扰下的欠驱动auv反步自适应模糊滑模控制方法 |
CN110647161A (zh) * | 2019-10-15 | 2020-01-03 | 哈尔滨工程大学 | 基于状态预测补偿的欠驱动uuv水平面轨迹跟踪控制方法 |
CN110647161B (zh) * | 2019-10-15 | 2022-07-15 | 哈尔滨工程大学 | 基于状态预测补偿的欠驱动uuv水平面轨迹跟踪控制方法 |
CN111045432A (zh) * | 2019-12-31 | 2020-04-21 | 哈尔滨工程大学 | 一种欠驱动水面船非线性路径跟踪控制系统及方法 |
CN111045432B (zh) * | 2019-12-31 | 2022-07-15 | 哈尔滨工程大学 | 一种欠驱动水面船非线性路径跟踪控制系统及方法 |
CN111830832A (zh) * | 2020-07-27 | 2020-10-27 | 中国科学院自动化研究所 | 仿生滑翔机器海豚平面路径跟踪方法及系统 |
CN111830832B (zh) * | 2020-07-27 | 2021-08-31 | 中国科学院自动化研究所 | 仿生滑翔机器海豚平面路径跟踪方法及系统 |
CN113132905A (zh) * | 2021-04-21 | 2021-07-16 | 湖南国天电子科技有限公司 | 一种具有动态节点的自主水下机器人无线传感器网络 |
CN113132905B (zh) * | 2021-04-21 | 2022-05-31 | 湖南国天电子科技有限公司 | 一种具有动态节点的自主水下机器人无线传感器网络 |
CN114019805A (zh) * | 2021-11-17 | 2022-02-08 | 九江职业技术学院 | 一种欠驱动auv的模型预测对接控制方法 |
CN114019805B (zh) * | 2021-11-17 | 2023-05-23 | 九江职业技术学院 | 一种欠驱动auv的模型预测对接控制方法 |
CN117472084A (zh) * | 2023-10-19 | 2024-01-30 | 哈尔滨工程大学 | 一种欠驱动水下机器人对接过程中的对接控制方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN106444806B (zh) | 2019-03-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106444806B (zh) | 基于生物速度调节的欠驱动auv三维轨迹跟踪控制方法 | |
CN107168312B (zh) | 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法 | |
CN107024863B (zh) | 一种避免微分爆炸的uuv轨迹跟踪控制方法 | |
CN102722177B (zh) | 具有pid反馈增益的自主水下航行器三维直线路径跟踪控制方法 | |
CN102768539B (zh) | 基于迭代的自主水下航行器三维曲线路径跟踪控制方法 | |
Wang et al. | Roboat II: A novel autonomous surface vessel for urban environments | |
Li et al. | Robust adaptive motion control for underwater remotely operated vehicles with velocity constraints | |
CN105929842B (zh) | 一种基于动态速度调节的欠驱动uuv平面轨迹跟踪控制方法 | |
CN101833338B (zh) | 无人潜航器垂直面欠驱动运动控制方法 | |
CN111650948B (zh) | 一种可底栖式auv的水平面轨迹快速跟踪控制方法 | |
CN109634307A (zh) | 一种无人水下航行器复合航迹跟踪控制方法 | |
CN110618606B (zh) | 一种复合干扰下的欠驱动auv反步自适应模糊滑模控制方法 | |
CN106338919A (zh) | 基于增强学习型智能算法的无人艇航迹跟踪控制方法 | |
CN114115262B (zh) | 基于方位角信息的多auv执行器饱和协同编队控制系统和方法 | |
CN113093804B (zh) | 基于反演滑模控制的无人艇编队控制方法和控制系统 | |
CN113485389A (zh) | 一种基于自适应预测的水下机器人三维轨迹跟踪控制方法 | |
CN114967714A (zh) | 一种自主式水下机器人抗扰运动控制方法及系统 | |
CN117389312A (zh) | 一种基于模型的水下航行器抗衡滚三维跟踪控制方法 | |
de Cerqueira Gava et al. | AUV cruising auto pilot for a long straight confined underwater tunnel | |
Wu et al. | Homing tracking control of autonomous underwater vehicle based on adaptive integral event-triggered nonlinear model predictive control | |
CN115480580A (zh) | 一种基于nmpc的水下机器人路径跟踪与避障的控制方法 | |
Emrani et al. | An adaptive leader-follower formation controller for multiple AUVs in spatial motions | |
Lionel | Underwater robots part II: Existing solutions and open issues | |
CN112904719A (zh) | 一种适用于水下机器人位置环形区域跟踪控制方法 | |
CN114019805B (zh) | 一种欠驱动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 |