CN115479507B - 一种水下航行器制导控制方法及系统 - Google Patents
一种水下航行器制导控制方法及系统 Download PDFInfo
- Publication number
- CN115479507B CN115479507B CN202211115521.2A CN202211115521A CN115479507B CN 115479507 B CN115479507 B CN 115479507B CN 202211115521 A CN202211115521 A CN 202211115521A CN 115479507 B CN115479507 B CN 115479507B
- Authority
- CN
- China
- Prior art keywords
- underwater vehicle
- target
- sliding mode
- constant
- guidance 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 47
- 238000013461 design Methods 0.000 claims abstract description 28
- 230000006870 function Effects 0.000 claims description 33
- 238000004590 computer program Methods 0.000 claims description 8
- 238000005259 measurement Methods 0.000 claims description 7
- 230000004044 response Effects 0.000 abstract description 5
- 238000004891 communication Methods 0.000 abstract description 3
- 230000001960 triggered effect Effects 0.000 description 7
- 238000004458 analytical method Methods 0.000 description 5
- 238000012545 processing Methods 0.000 description 5
- 230000008878 coupling Effects 0.000 description 4
- 238000010168 coupling process Methods 0.000 description 4
- 238000005859 coupling reaction Methods 0.000 description 4
- 238000009795 derivation Methods 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000006872 improvement Effects 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 238000011160 research Methods 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- KLDZYURQCUYZBL-UHFFFAOYSA-N 2-[3-[(2-hydroxyphenyl)methylideneamino]propyliminomethyl]phenol Chemical compound OC1=CC=CC=C1C=NCCCN=CC1=CC=CC=C1O KLDZYURQCUYZBL-UHFFFAOYSA-N 0.000 description 1
- 229940060587 alpha e Drugs 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000003491 array Methods 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 201000001098 delayed sleep phase syndrome Diseases 0.000 description 1
- 208000033921 delayed sleep phase type circadian rhythm sleep disease Diseases 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 208000011580 syndromic disease Diseases 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F42—AMMUNITION; BLASTING
- F42B—EXPLOSIVE CHARGES, e.g. FOR BLASTING, FIREWORKS, AMMUNITION
- F42B19/00—Marine torpedoes, e.g. launched by surface vessels or submarines; Sea mines having self-propulsion means
- F42B19/01—Steering control
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- General Engineering & Computer Science (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供了一种水下航行器制导控制方法及系统,所述方法包括:建立水下航行器制导控制一体化模型;构造全局滑模函数;建立事件触发控制器,利用所述全局滑模函数计算控制信号,判断事件触发控制器是否满足触发条件,若满足触发条件则更新直舵控制指令。本发明的优势在于:本发明的方法利用利用全局滑模函数对控制器进行设计,可以使视线角速度误差有限时间内收敛至零点附近,实现水下航行器对来袭目标的拦截,减小通信、执行器操纵的次数,节约系统资源,并提高控制精度。本发明能够使水下航行器事件触发制导控制一体化系统有限时间收敛,加快航行器响应速度,提高拦截概率。
Description
技术领域
本发明属于水下航行器控制领域,具体涉及一种水下航行器制导控制方法及系统。
背景技术
当进行水下目标打击、拦截任务时,水下航行器需要面临包括外界未知海浪/海流干扰、恶劣的水声条件在内复杂多变的海洋环境,为水下航行器实现对目标的精确命中带来了挑战,主要表现为如下方面:首先,水下航行器在复杂的水下环境中航行,严苛的海洋环境将会对系统的正常运行带来不确定干扰,使系统的稳定性受到影响;同时,由于来袭目标航速高、机动性强,可供拦截的时间很短,如果不考虑系统的滞后,将会导致脱靶量较大,造成拦截任务的失败。因此,为了实现对目标的成功拦截,需要水下航行器的制导控制系统具有较快的响应速度,且能够对外界干扰具有鲁棒性。
为了使水下航行器成功命中目标,经典的制导控制方法是将制导系统与控制系统视作两个独立的系统,制导系统根据水下航行器与目标的相对运动关系,计算出所需要的制导指令;控制系统产生实际的舵令使水下航行器跟踪制导指令。上述方法只利用了各自系统的信息,忽略了制导控制系统之间的耦合性。由于制导回路与控制回路之间存在很强的耦合和关联,当水下航行器与目标相对距离较近时姿态变化剧烈,会引起响应滞后的问题,导致脱靶量较大,命中精度变差,该问题在弹道末端尤为突出。为了提高命中精度,充分发挥水下航行器的目标打击能力,制导控制一体化设计方法近年来得到了广泛的关注。制导控制一体化方法的思路是将制导与控制系统作为一个整体,利用相对运动关系和模型动态特性直接产生控制指令。由于制导控制一体化方法考虑了制导系统和控制系统之间的耦合关系,使航行器对目标打击的命中精度以及快速性均能够得到提高并增加命中概率。
制导控制一体化设计方法充分考虑了制导系统和控制系统之间的耦合关系,得到了广泛研究与关注,已成功用于空间飞行器制导控制领域,并且在水下航行器领域也有了初步的研究结果。目前,制导控制一体化控制方法多集中于使系统渐近收敛于平衡点,理论上收敛时间无穷大,对实际问题没有意义,因此需要提高控制系统的实时性,加快收敛速度。
发明内容
本发明的目的在于克服现有技术计算水下航行器受外界干扰时收敛时间过长,无法满足实际航行所需计算时间的缺陷。
为了实现上述目的,本发明提出了一种水下航行器制导控制方法,所述方法包括:
步骤1:建立水下航行器制导控制一体化模型;
步骤2:构造全局滑模函数;
步骤3:建立事件触发控制器,利用所述全局滑模函数计算控制信号,判断事件触发控制器是否满足触发条件,若满足触发条件则更新直舵控制指令。
作为上述方法的一种改进,所述步骤1具体包括:
建立水下航行器制导控制一体化模型如下:
其中,定义大地坐标系下北向为x轴,东向为y轴;基准线xo平行于x轴且与x轴的正向同方向;
状态变量状态变量x2=β,状态变量x3=ωy;各参数定义为:
其中,r为水下航行器与目标的相对距离,为r的一阶时间导数;β为水下航行器侧滑角,ωy为水下航行器旋转角速度;vA为水下航行器的速度矢量;KJ为转动惯量;常数Kzβ,Kzδ,Kzω,Kmyβ,Kmyδ,Kmyω为各变量之间的相关系数;常数λ33、λ35为流体动力系数;常数T为水下航行器纵轴方向所受推力;δr为直舵控制指令;视线角q为目标的瞄准线与攻击平面内基准线xo的夹角;
常数其中,m为水下航行器质量;
Δq为水下航行器受到的干扰,定义为:
其中,σA与σT分别为水下航行器、目标速度矢量与基准线之间的夹角,为σA的一阶时间导数,/>为σT的一阶时间导数;vT为目标的速度矢量;
控制目标为设计直舵控制指令δr的事件触发器,使水下航行器制导控制一体化模型的状态变量x1收敛至一个关于零点的可调残集内。
作为上述方法的一种改进,所述步骤2具体包括:
建立全局滑模函数s(x,t):
其中,t为时间,误差信号常数ci>0,i=1,2;参数ci使特征方程P2+c2P+c1=0的所有解均具有负实部特征根,P为拉普拉斯算子;
非线性时间函数s0(t)通过下式构造:
其中,给定设计参数A1、B1、B2、B3(B2≠B3),对下式求解得到设计参数tf:
作为上述方法的一种改进,所述步骤3具体包括:
建立事件触发控制器为:
其中,为控制信号,t表示时间;/>在t=tk时刻的值为/>
其中,设计参数:常数kvs>0,ks>0,0<αs<1;常数/>max(|Δq|)表示|Δq|的最大值;sign(·)为变量·的符号函数;
事件触发条件设计为:
其中,Δ为测量误差,表示记录控制器触发时刻的下标,设计参数C,D,Γ>0为常数,0<δ<1为常数;inf表示下确界;
根据控制信号与tk时刻/>的差值,即测量误差的绝对值|Δ|,判断控制器是否满足所设计的触发条件;若满足触发条件,满足触发条件的时刻记录为tk+1,直舵控制指令更新为:
若不满足触发条件,直舵控制指令保持为
本发明还提供一种水下航行器制导控制系统,所述系统包括:
制导控制一体化模型模块,用于建立水下航行器制导控制一体化模型;
滑模函数模块,用于构造全局滑模函数;和
制导控制模块,用于建立事件触发控制器,利用所述全局滑模函数计算控制信号,判断事件触发控制器是否满足触发条件,若满足触发条件则更新直舵控制指令。
本发明还提供一种计算机设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如上述任一项所述的方法。
本发明还提供一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序当被处理器执行时使所述处理器执行如上述任一项所述的方法。
与现有技术相比,本发明的优势在于:
1、本发明的方法利用利用全局滑模函数对控制器进行设计,可以使视线角速度误差有限时间内收敛至零点附近,实现水下航行器对来袭目标的拦截,减小通信、执行器操纵的次数,节约系统资源,并提高控制精度。
2、本发明能够使水下航行器事件触发制导控制一体化系统有限时间收敛,加快航行器响应速度,提高拦截概率。
附图说明
图1所示为水下航行器制导控制方法流程图;
图2所示为水下航行器与目标的相对位置示意图;
图3所示为采用事件触发滑模控制器时水下航行器的状态曲线(水下航行器弹道倾角)图;
图4所示为采用事件触发滑模控制器时水下航行器的状态曲线(水下航行器侧滑角)图;
图5所示为采用事件触发滑模控制器时水下航行器的状态曲线(水下航行器偏航角速度)图;
图6所示为水下航行器(AOV)与目标(Target)运动轨迹示意图;
图7所示为目标航向角示意图;
图8(a),图8(b)所示为视线角与相对距离示意图;
图9所示为事件触发滑模控制器(事件触发间隔)示意图。
具体实施方式
下面结合附图对本发明的技术方案进行详细的说明。
本发明提出了水下航行器事件触发制导控制一体化设计方法,能够使系统有限时间收敛,加快航行器响应速度,提高拦截概率。
本发明的实施方法包括:
1)获取tk时刻欠驱动水下航行器与来袭目标的相对位置信息、速度信息、姿态信息和角速度信息;
2)计算tk时刻的视线角速度误差,并由此设计tk+1时刻的全局滑模函数;
3)利用全局滑模函数,计算连续信号并得到tk时刻的控制信号/>
4)根据控制信号与tk时刻/>的差值,即测量误差的绝对值|Δ|,判断控制器是否满足所设计的触发条件;
5)若不满足触发条件,直舵控制指令保持为
若满足触发条件,满足触发条件的时刻记录为tk+1,控制推力更新为
如图1所示,本发明的具体实施步骤如下:
步骤1:建立水下航行器制导控制一体化模型。
首先建立水下航行器与目标的相对运动关系方程。考虑到目标的深度范围变化不大,假定水下航行器与目标始终在同一平面内运动。在某一时刻,目标位于Tg点,水下航行器位于A点,在上述的假设条件下,可以建立水下航行器与目标的极坐标相对运动关系。为了便于描述相对运动关系,定义如下变量:
定义大地坐标系下北向为x轴,东向为y轴;基准线xo平行于x轴且与x轴的正向同方向;所有角度的起始边均为xo,且以从xo逆时针转至邻边(北偏西)为角度正方向;r为水下航行器与目标的相对距离,rmin>0为给定的最大脱靶量,|r|<rmin时,可以认为水下航行器实现了对目标的拦截;水下航行器所在的点A与目标所在的点Tg之间的连线称为目标的瞄准线;q为目标的瞄准线与攻击平面内基准线xo的夹角,称为目标的视线角;σA与σT分别为水下航行器、目标速度矢量与基准线之间的夹角,称为水下航行器弹道倾角和目标航向角;ηA为水下航行器的速度矢量与目标瞄准线之间的夹角,称为水下航行器速度矢量的提前角;ηT为目标的速度矢量与目标瞄准线之间的夹角,称为目标速度矢量的提前角;从水下航行器速度方向vA逆时针转向瞄准线r为ηA的正方向,从目标速度方向vT逆时针转向瞄准线r为ηT的正方向。
根据图2所示的水下航行器与目标的相对运动关系,可以建立二者的相对运动方程。将水下航行器的速度矢量vA与目标的速度矢量vT分别沿目标视线方向及其法线方向上分解,可以得到描述水下航行器与目标相对距离变化率和目标视线角变化率/>的相对运动方程如下:
将式(1)的最后两个方程代入式(1)的前两个方程可得:
根据式(2)的推导,可以得到水下航行器与目标的相对运动方程为:
将式(3)对时间求导,可得:
为σA的一阶时间导数,/>为σT的一阶时间导数;
通常情况下,水下航行器与目标的航行速度几乎不变,二者进行机动时只改变速度的方向,因此可以认为将式(3)代入式(4),化简得到:
由于目标的运动学特性往往是不精确的,而且当目标机动时其运动要素不能被水下航行器获取,定义干扰Δq为:
其中,式(6)等号右侧第一项为关于水下航行器视线角q与弹道倾角σA的误差项;第二项为无法精确测量的关于目标T机动信息的运动要素。
利用式(6),可将式(5)中第二个方程等价为:
水下航行器侧向通道动力学模型为:
σA=ψA-β (11)
式(8)-式(11)中,δr为待设计的直舵控制指令;变量ψ为偏航角,β为侧滑角,ωy为旋转角速度;常数m为水下航行器质量,KJ为转动惯量;常数Kzβ,Kzδ,Kzω,Kmyβ,Kmyδ,Kmyω为各变量之间的相关系数;常数λ33,λ35为流体动力系数;常数T为水下航行器纵轴方向所受推力。
将式(11)两侧对时间变量t求导易知:
将式(12)分别代入式(8)、式(9)的最后一项可得:
将式(14)代入式(13),可知弹道倾角与直舵控制指令的数学关系为:
定义常数式(15)等价为:
结合式(16)与式(12),可知侧滑角与直舵控制指令的数学关系为:
将式(16)代入式(14)最后一项,可知航向角速度与直舵控制指令的数学关系为:
为了得到视线角速度与直舵控制指令的数学关系,将式(16)代入式(7)可得:
其中,状态变量对x1求导并结合式(19)可得:
选取状态变量x2=β,x3=ωy,结合式(17)、(18)与(20),可以建立水下航行器制导控制一体化状态空间模型为:
其中,状态向量x=[x1,x2,x3]T,矩阵向量/>向量各参数定义为:
为了便于控制器的推导与分析,做出如下假设:
假设1.广义扰动Δq有界,存在已知常数满足/>其中max(|Δq|)表示|Δq|的最大值。
注释1:由于系统在建模时忽略的都是高阶小量,且目标机动能力有限,视线角与水下航行器弹道倾角相差不大,cos(q-σA)≈1,因此Δq可以满足假设1。
可将式(21)展开为:
经过上述推导,控制目标可以转化为设计关于直舵控制指令δr的事件触发控制器,使系统(22)的状态x1收敛至一个关于零点的可调残集内。
步骤2:构造全局滑模函数。
定义非线性时间函数:
其中,设计参数常数Aj,Bj>0,j=1,2,3;误差信号常数ci>0,i=1,2;需选取设计参数ci使特征方程
P2+c2P+c1=0 (24)
的所有解均具有负实部特征根,P为拉普拉斯(Laplace)算子。
利用式(23)构造全局滑模函数:
注意到s0(t)的引入是为了减少并尽可能地消除滑模控制器的趋近模态,使闭环系统从初始时刻就能够处于滑动模态运动阶段,能够增强系统鲁棒性。为了达到这一目的,设计参数选取必须满足以下两个条件:
1.全局滑模边界条件即:
A1+A2+A3=1 (26)
2.存在0<tf<∞,使s0(t)=0;从而系统能够在有限时间tf内到达滑模面,因此:
对于一组给定的设计参数A1、B1、B2、B3,可以通过式(27)求解A2和A3,再利用式(25)构造全局滑模函数。由式(26)与式(27)可知,在t=tf满足:
利用式(28)易得:
代入式(23)可得:
从而由式(30)定义的非线性时间函数可以满足上述全局滑模条件。
此外,为了保证s0(t)全局可导,即:
式(31)结合式(30)可知:
上式等价于:
以上分析表明,在给定设计参数A1、B1、B2、B3(B2≠B3)后,首先利用式(32)对tf求解,并通过式(30)构造非线性时间函数,最终将以上结果代入式(25)可构造系统全局滑模函数。
步骤3:根据事件触发控制信号,更新控制推力。
定义控制信号在tk时刻的值为/>测量误差为/>事件触发条件设计为:
其中,表示记录控制器触发时刻的下标,t0=0为初始时刻;设计参数C,D,Γ>0为常数,0<δ<1为常数;inf表示下确界。
分段连续的事件触发控制器设计为:
连续信号:
其中,sign(·)为变量·的符号函数;设计参数:/>kvs>0,ks>0,0<αs<1,/>常数/>max(|Δq|)表示|Δq|的最大值。
步骤四:闭环系统稳定性分析。
在后续的控制系统分析中将涉及到如下定义与引理:
引理1.如果存在常数a>1,b>1,使(a-1)(b-1)=1,那么对于任意的c>0,式(36)成立。
引理2.对于任意的ε>0,0<α<1,式(37)成立。
定义1(有限时间收敛)考虑系统
其中,f:为开区域U上对x的连续函数。对/>存在一个连续函数T(x):U0\{0}→(0,+∞),使式(38)的解x(t,x0)满足:当t∈[0,T(x0))时,有x(t,x0)∈U0\{0}和/>且当t>T(x0)时x(t,x0)=0,则x将在有限时间T(x0)内从状态x0收敛至0。
引理3.考虑由式(38)描述的系统,假设存在连续可微的正定函数V:正实数c1,c2>0和α∈(0,1),以及包含原点的开邻域/>使得下列条件成立:
则系统(38)有限时间稳定。若且V(x)是径向无界的,则系统(38)是全局有限时间稳定的,收敛时间满足:
此外,若存在0<η<∞,满足:
则系统是有限时间稳定的,且状态轨迹收敛于集合:
其中0<c0<1。收敛时间满足:
上述提出的输出反馈事件触发控制器闭环系统稳定性分析可总结为定理1。
定理1.考虑满足假设1和假设2的水下拦截器制导控制一体化模型式(22),结合式(33)-式(35)设计事件触发控制器,可保证闭环系统有限时间稳定,且状态误差能够在有限时间内收敛于包含原点的任意小可调邻域内。
证明:将s(x,t)简写为s,定义Lyapunov函数:
将式(44)沿式(25)求导,并将式(34)代入可得:
注意到测量误差为根据假设1可知/>
将式(35)代入式(45)可得:
利用引理1可知:
利用引理2可得:
由于设计参数因此/>
将式(47)和式(48)结合式(46)可得:
选取合适的设计参数kvs>0、ks>0,使常数结合式(44)可知/>则式(49)可改写为:
此外,根据式(33)和式(34)可知,全局有界,定义常数/>
将式(50)结合引理3可得:
因此,系统是有限时间稳定的,且状态轨迹收敛于集合:
其中0<c0<1。收敛时间满足:
将式(52)结合式(24)、式(25)和式(30)可知,系统状态x1最终收敛于一个关于原点的非零残集中,且通过调节设计参数kvs和ks可使该残集足够小,满足所需的控制性能。
由于r>0,因此可以有限时间收敛于关于原点的可调邻域内,即水下航行器能够在有限时间内实现对目标的拦截。证毕。
步骤5:仿真验证
该部分通过数字仿真验证算法有效性。
考虑水下航行器侧向通道模型,水下航行器的初始位置为(0,0)m,初始姿态为ψA(0)=σA(0)=20°,β(0)=0°,ωy(0)=0rad/s,航速为vA=15m/s;来袭目标初始位置为(1000,-1000)m,初始弹道倾角为σT(0)=232.6°,航速为vT=18m/s,不可测机动角速度为ωT=1.5cos(1+0.1t)°/s。
控制器设计参数为:c1=12,c2=2,A1=0.5、B1=150、B2=100、B3=10,tf=0.011,kvs=5,ks=2,αs=0.7;将舵角限幅为|δr|≤15°。事件触发控制器设计参数为:Γ=10,C=1,D=0.05,δ=0.1。
利用所设计的事件触发滑模控制器,仿真结果如图3-图9所示。由如图3可知,采用所设计的控制器,可以确保水下航行器的状态全局有界。图6为水下航行器与目标的运动轨迹,结合图7、8可知,水下航行器能以较小的脱靶量实现对目标的拦截。注意到水下航行器无法测量目标机动,因此导致了图6中水下航行器与目标距离变小时弹道的弯曲。根据图9中的事件触发间隔可知,所提出的事件触发控制器具有大于零的触发间隔,避免了Zeno现象的发生。
本发明还可提供的一种计算机设备,包括:至少一个处理器、存储器、至少一个网络接口和用户接口。该设备中的各个组件通过总线系统耦合在一起。可理解,总线系统用于实现这些组件之间的连接通信。总线系统除包括数据总线之外,还包括电源总线、控制总线和状态信号总线。
其中,用户接口可以包括显示器、键盘或者点击设备(例如,鼠标,轨迹球(trackball)、触感板或者触摸屏等。
可以理解,本申请公开实施例中的存储器可以是易失性存储器或非易失性存储器,或可包括易失性和非易失性存储器两者。其中,非易失性存储器可以是只读存储器(Read-Only Memory,ROM)、可编程只读存储器(Programmable ROM,PROM)、可擦除可编程只读存储器(Erasable PROM,EPROM)、电可擦除可编程只读存储器(Electrically EPROM,EEPROM)或闪存。易失性存储器可以是随机存取存储器(Random Access Memory,RAM),其用作外部高速缓存。通过示例性但不是限制性说明,许多形式的RAM可用,例如静态随机存取存储器(Static RAM,SRAM)、动态随机存取存储器(Dynamic RAM,DRAM)、同步动态随机存取存储器(Synchronous DRAM,SDRAM)、双倍数据速率同步动态随机存取存储器(Double DataRate SDRAM,DDRSDRAM)、增强型同步动态随机存取存储器(Enhanced SDRAM,ESDRAM)、同步连接动态随机存取存储器(Synchlink DRAM,SLDRAM)和直接内存总线随机存取存储器(Direct Rambus RAM,DRRAM)。本文描述的存储器旨在包括但不限于这些和任意其它适合类型的存储器。
在一些实施方式中,存储器存储了如下的元素,可执行模块或者数据结构,或者他们的子集,或者他们的扩展集:操作系统和应用程序。
其中,操作系统,包含各种系统程序,例如框架层、核心库层、驱动层等,用于实现各种基础业务以及处理基于硬件的任务。应用程序,包含各种应用程序,例如媒体播放器(Media Player)、浏览器(Browser)等,用于实现各种应用业务。实现本公开实施例方法的程序可以包含在应用程序中。
在本上述的实施例中,还可通过调用存储器存储的程序或指令,具体的,可以是应用程序中存储的程序或指令,处理器用于:
执行上述方法的步骤。
上述方法可以应用于处理器中,或者由处理器实现。处理器可能是一种集成电路芯片,具有信号的处理能力。在实现过程中,上述方法的各步骤可以通过处理器中的硬件的集成逻辑电路或者软件形式的指令完成。上述的处理器可以是通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific IntegratedCircuit,ASIC)、现场可编程门阵列(Field Programmable GateArray,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。可以实现或者执行上述公开的各方法、步骤及逻辑框图。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。结合上述公开的方法的步骤可以直接体现为硬件译码处理器执行完成,或者用译码处理器中的硬件及软件模块组合执行完成。软件模块可以位于随机存储器,闪存、只读存储器,可编程只读存储器或者电可擦写可编程存储器、寄存器等本领域成熟的存储介质中。该存储介质位于存储器,处理器读取存储器中的信息,结合其硬件完成上述方法的步骤。
可以理解的是,本发明描述的这些实施例可以用硬件、软件、固件、中间件、微码或其组合来实现。对于硬件实现,处理单元可以实现在一个或多个专用集成电路(Application Specific Integrated Circuits,ASIC)、数字信号处理器(Digital SignalProcessing,DSP)、数字信号处理设备(DSP Device,DSPD)、可编程逻辑设备(ProgrammableLogic Device,PLD)、现场可编程门阵列(Field-Programmable Gate Array,FPGA)、通用处理器、控制器、微控制器、微处理器、用于执行本申请所述功能的其它电子单元或其组合中。
对于软件实现,可通过执行本发明的功能模块(例如过程、函数等)来实现本发明技术。软件代码可存储在存储器中并通过处理器执行。存储器可以在处理器中或在处理器外部实现。
本发明还可提供一种非易失性存储介质,用于存储计算机程序。当该计算机程序被处理器执行时可以实现上述方法实施例中的各个步骤。
最后所应说明的是,以上实施例仅用以说明本发明的技术方案而非限制。尽管参照实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,对本发明的技术方案进行修改或者等同替换,都不脱离本发明技术方案的精神和范围,其均应涵盖在本发明的权利要求范围当中。
Claims (4)
1.一种水下航行器制导控制方法,所述方法包括:
步骤1:建立水下航行器制导控制一体化模型;
步骤2:构造全局滑模函数;
步骤3:建立事件触发控制器,利用所述全局滑模函数计算控制信号,判断事件触发控制器是否满足触发条件,若满足触发条件则更新直舵控制指令;
所述步骤1具体包括:
建立水下航行器制导控制一体化模型如下:
其中,定义大地坐标系下北向为x轴,东向为y轴;基准线xo平行于x轴且与x轴的正向同方向;
状态变量状态变量x2=β,状态变量x3=ωy;各参数定义为:
其中,r为水下航行器与目标的相对距离,为r的一阶时间导数;β为水下航行器侧滑角,ωy为水下航行器旋转角速度;vA为水下航行器的速度矢量;KJ为转动惯量;常数Kzβ,Kzδ,Kzω,Kmyβ,Kmyδ,Kmyω为各变量之间的相关系数;常数λ33、λ35为流体动力系数;常数T为水下航行器纵轴方向所受推力;δr为直舵控制指令;视线角q为目标的瞄准线与攻击平面内基准线xo的夹角;
常数其中,m为水下航行器质量;
Δq为水下航行器受到的干扰,定义为:
其中,σA与σT分别为水下航行器、目标速度矢量与基准线之间的夹角,为σA的一阶时间导数,/>为σT的一阶时间导数;vT为目标的速度矢量;
控制目标为使水下航行器制导控制一体化模型的状态变量x1收敛至一个关于零点的可调残集内;
所述步骤2具体包括:
建立全局滑模函数s(x,t):
其中,t为时间,误差信号常数ci>0,i=1,2;参数ci使特征方程P2+c2P+c1=0的所有解均具有负实部特征根,P为拉普拉斯算子;
非线性时间函数s0(t)通过下式构造:
其中,给定设计参数A1、B1、B2、B3,B2≠B3,对下式求解得到设计参数tf:
所述步骤3具体包括:
建立事件触发控制器为:
其中,为控制信号,t表示时间;/>在t=tk时刻的值为/>
其中,设计参数:常数kvs>0,ks>0,0<αs<1;常数/>max(|Δq|)表示|Δq|的最大值;sign(·)为变量·的符号函数;
事件触发条件设计为:
其中,Δ为测量误差, 表示记录控制器触发时刻的下标,设计参数C,D,Γ>0为常数,0<δ<1为常数;inf表示下确界;
根据控制信号与tk时刻/>的差值,即测量误差的绝对值|Δ|,判断事件触发控制器是否满足所设计的触发条件;若满足触发条件,满足触发条件的时刻记录为tk+1,直舵控制指令更新为:
若不满足触发条件,直舵控制指令保持为
2.一种水下航行器制导控制系统,基于权利要求1所述的方法实现,所述系统包括:
制导控制一体化模型模块,用于建立水下航行器制导控制一体化模型;
滑模函数模块,用于构造全局滑模函数;和
制导控制模块,用于建立事件触发控制器,利用所述全局滑模函数计算控制信号,判断事件触发控制器是否满足触发条件,若满足触发条件则更新直舵控制指令。
3.一种计算机设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1所述的方法。
4.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机程序,所述计算机程序当被处理器执行时使所述处理器执行如权利要求1所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211115521.2A CN115479507B (zh) | 2022-09-14 | 2022-09-14 | 一种水下航行器制导控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211115521.2A CN115479507B (zh) | 2022-09-14 | 2022-09-14 | 一种水下航行器制导控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115479507A CN115479507A (zh) | 2022-12-16 |
CN115479507B true CN115479507B (zh) | 2023-08-15 |
Family
ID=84424085
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211115521.2A Active CN115479507B (zh) | 2022-09-14 | 2022-09-14 | 一种水下航行器制导控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115479507B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5319556A (en) * | 1992-12-11 | 1994-06-07 | The United States Of America As Represented By The Secretary Of The Navy | Adaptive trajectory selection apparatus and method |
CN108444478A (zh) * | 2018-03-13 | 2018-08-24 | 西北工业大学 | 一种用于水下航行器的移动目标视觉位姿估计方法 |
CN110779518A (zh) * | 2019-11-18 | 2020-02-11 | 哈尔滨工程大学 | 一种具有全局收敛性的水下航行器单信标定位方法 |
CN111027206A (zh) * | 2019-12-05 | 2020-04-17 | 哈尔滨工业大学 | 具有规定性能的拦截机动目标自适应滑模控制方法 |
CN111781938A (zh) * | 2020-06-23 | 2020-10-16 | 中国科学院声学研究所 | 欠驱动水下航行器及其镇定方法与装置 |
CN114547980A (zh) * | 2022-02-24 | 2022-05-27 | 重庆大学 | 具有时变状态约束的多智能体有限时间事件触发控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7495999B2 (en) * | 2005-08-03 | 2009-02-24 | Nekton Research Llc | Underwater guidance systems, unmanned underwater vehicles and methods |
-
2022
- 2022-09-14 CN CN202211115521.2A patent/CN115479507B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5319556A (en) * | 1992-12-11 | 1994-06-07 | The United States Of America As Represented By The Secretary Of The Navy | Adaptive trajectory selection apparatus and method |
CN108444478A (zh) * | 2018-03-13 | 2018-08-24 | 西北工业大学 | 一种用于水下航行器的移动目标视觉位姿估计方法 |
CN110779518A (zh) * | 2019-11-18 | 2020-02-11 | 哈尔滨工程大学 | 一种具有全局收敛性的水下航行器单信标定位方法 |
CN111027206A (zh) * | 2019-12-05 | 2020-04-17 | 哈尔滨工业大学 | 具有规定性能的拦截机动目标自适应滑模控制方法 |
CN111781938A (zh) * | 2020-06-23 | 2020-10-16 | 中国科学院声学研究所 | 欠驱动水下航行器及其镇定方法与装置 |
CN114547980A (zh) * | 2022-02-24 | 2022-05-27 | 重庆大学 | 具有时变状态约束的多智能体有限时间事件触发控制方法 |
Non-Patent Citations (1)
Title |
---|
基于事件触发的航天器姿态自适应容错控制;张嘉芮等;飞控与探测;第3卷(第2期);第17-25页 * |
Also Published As
Publication number | Publication date |
---|---|
CN115479507A (zh) | 2022-12-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Cho et al. | Optimal impact angle control guidance law based on linearization about collision triangle | |
Tahk et al. | Recursive time-to-go estimation for homing guidance missiles | |
CN111752280B (zh) | 一种基于有限时间不确定观测器的多无人船编队固定时间控制方法 | |
Reisner et al. | Optimal guidance-to-collision law for an accelerating exoatmospheric interceptor missile | |
WO2020000127A1 (zh) | 一种导航路径跟踪控制方法、设备、移动机器人及系统 | |
CN115143954B (zh) | 一种基于多源信息融合的无人车导航方法 | |
CN115248038B (zh) | 一种发射系下的sins/bds组合导航工程算法 | |
CN108073742A (zh) | 基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法 | |
Liu et al. | Integrated guidance and control with input saturation and disturbance observer | |
Budiyono et al. | Proportional guidance and CDM control synthesis for a short-range homing surface-to-air missile | |
CN115755969A (zh) | 一种基于零控拦截流型的飞行器制导方法及装置 | |
Zhang et al. | A novel adaptive three-dimensional finite-time guidance law with terminal angle constraints for interception of maneuvering targets | |
CN112034869B (zh) | 一种无人机变参神经动力学控制器的设计方法及其应用 | |
CN115479507B (zh) | 一种水下航行器制导控制方法及系统 | |
CN113110527B (zh) | 一种自主水下航行器有限时间路径跟踪的级联控制方法 | |
Cao et al. | Robust flight control design using sensor-based backstepping control for unmanned aerial vehicles | |
CN110262237A (zh) | 基于双反馈模糊神经网络的微陀螺仪超扭曲滑模控制方法 | |
Xian et al. | Impact point prediction guidance of ballistic missile in high maneuver penetration condition | |
Tamhane et al. | Novel two-stage observer for line-of-sight rate estimation | |
JP2013019570A (ja) | 飛しょう体誘導制御装置 | |
CN109693774A (zh) | 一种水下航行器轨迹的控制方法和系统 | |
Yuqi et al. | Time-varying parameters estimation with adaptive neural network EKF for missile-dual control system | |
CN115268501A (zh) | 多飞行器协同再入轨迹规划方法、系统、电子设备及介质 | |
CN115421501B (zh) | 一种水下航行器有限时间信号估计方法及系统 | |
CN113689501A (zh) | 一种基于收敛点的双机协同目标机定位跟踪控制方法 |
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 |