CN114815888B - 一种仿射形式的制导控制一体化控制方法 - Google Patents
一种仿射形式的制导控制一体化控制方法 Download PDFInfo
- Publication number
- CN114815888B CN114815888B CN202210459911.5A CN202210459911A CN114815888B CN 114815888 B CN114815888 B CN 114815888B CN 202210459911 A CN202210459911 A CN 202210459911A CN 114815888 B CN114815888 B CN 114815888B
- Authority
- CN
- China
- Prior art keywords
- missile
- equation
- derivative
- lyapunov
- model
- 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 79
- PXFBZOLANLWPMH-UHFFFAOYSA-N 16-Epiaffinine Natural products C1C(C2=CC=CC=C2N2)=C2C(=O)CC2C(=CC)CN(C)C1C2CO PXFBZOLANLWPMH-UHFFFAOYSA-N 0.000 title claims abstract description 67
- 238000009434 installation Methods 0.000 claims abstract description 11
- 238000005259 measurement Methods 0.000 claims abstract description 11
- 230000010354 integration Effects 0.000 claims abstract description 5
- 230000001133 acceleration Effects 0.000 claims description 21
- 230000008569 process Effects 0.000 claims description 17
- 238000013461 design Methods 0.000 claims description 13
- 230000003044 adaptive effect Effects 0.000 claims description 5
- 238000001914 filtration Methods 0.000 claims description 5
- 230000005484 gravity Effects 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000002360 preparation method Methods 0.000 claims description 2
- 230000007704 transition Effects 0.000 claims description 2
- 238000004088 simulation Methods 0.000 abstract description 10
- 230000001360 synchronised effect Effects 0.000 abstract description 4
- 238000004458 analytical method Methods 0.000 description 7
- 230000008878 coupling Effects 0.000 description 7
- 238000010168 coupling process Methods 0.000 description 7
- 238000005859 coupling reaction Methods 0.000 description 7
- 230000008859 change Effects 0.000 description 4
- 230000006641 stabilisation Effects 0.000 description 4
- 238000011105 stabilization Methods 0.000 description 4
- 238000009795 derivation Methods 0.000 description 3
- 230000004044 response Effects 0.000 description 3
- 238000006467 substitution reaction Methods 0.000 description 2
- 239000000758 substrate Substances 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 230000009286 beneficial effect Effects 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
- 230000001808 coupling effect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 210000001503 joint Anatomy 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000005437 stratosphere Substances 0.000 description 1
Images
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/10—Simultaneous control of position or course in three dimensions
- G05D1/107—Simultaneous control of position or course in three dimensions specially adapted for missiles
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种仿射形式的制导控制一体化控制方法,属于导弹模型自动化控制领域。为了解决现有制导控制一体化是非仿射模型,制导回路与控制回路无法在一个仿真步长内实现同步控制,控制精度低的问题。根据导弹目标相对运动学模型、导弹目标相对运动学模型、导弹的姿态动力学模型、由气动参数偏差引起的***干扰、由舵机安装偏差引起的***干扰和由导弹惯导设备测量误差引起的***干扰,建立仿射形式的制导控制一体化模型;通过控制仿射形式的制导控制一体化模型中的u、d′1、d2和d3,得到仿射形式的制导控制一体化模型中的x1、x2和x3的界限,利用x1、x2和x3的界限控制真实的导弹。它用于作用在真实导弹上,实现较小的脱靶量。
Description
技术领域
本发明涉及对模型的控制方法,属于导弹模型自动化控制领域。
背景技术
近年来,随着高超声速飞行器的飞速发展,国内外针对高超声速飞行器控制的研究也层出不穷。传统的制导武器为了降低模型构建的复杂性以及满足控制算法的设计需求,通常将制导回路与控制回路分开设计。其中内回路是自动驾驶仪控制回路,通过改变舵偏指令产生期望的飞行程序角;外回路是制导回路产生加速度指令。然而,高超声速武器通常飞行速度在5马赫以上,尤其是在末制导阶段具有快时变、强耦合、强非线性和强不确定性的特点,这些因素导致传统的设计方法无法实现其快速响应脱靶量的要求甚至造成导弹的失稳。
制导控制一体化(Integrated guidance and control,IGC)设计思想最早是由Williams提出。通过将制导回路与控制回路看成一个整体进行控制器设计,考虑两个回路之间的耦合影响和飞行器质心运动与绕质心运动间的交互影响,大大提高了整体的响应速度以及控制性能。在末制导阶段,IGC方法通过弹-目相对信息可以直接解算出导弹的舵偏控制指令,不需要将制导回路输出过载指令传输到控制回路,可以大大减少***响应时间并能够消除两个回路之间的耦合不确定性造成的影响。
针对高超声速飞行器的强耦合特性,国内外很多学者将飞行器看作是刚体,建立包含制导和控制回路中所有状态的全状态耦合模型,将质心运动方程式与绕质心运动学方程式构建成一个级联***,通过使用视线角、视线角速度、飞行姿态角等信息运用滑模控制、自适应控制、最优控制等方法直接得到舵偏控制指令。然而,上述研究无法完全消除两个***之间的耦合影响,且基于最优控制的方法都存在这计算负担较重、难以再现应用等缺陷。此外由于基于BTT导弹的IGC方法研究并不多,很少考虑BTT导弹的偏航回路和滚转回路之间的耦合影响。
滑模控制(SMC)方法作为一种强鲁棒性的非线性方法,由于其对扰动的不敏感、收敛速度快等特性被广泛应用到机械臂控制、航天器交会对接等问题,然而SMC方法的切换特性导致其存在“抖振问题”,严重损害了执行器的输出性能。
发明内容
本发明的目的是为了解决现有制导控制一体化是非仿射模型,制导回路与控制回路无法在一个仿真步长内实现同步控制,控制精度低的问题,提出了一种仿射形式的制导控制一体化控制方法。
一种仿射形式的制导控制一体化控制方法,所述方法包括以下步骤:
步骤1、根据导弹攻击目标模型和将导弹在速度系上的气动加速度投影到视线坐标系下的投影方程,得到导弹目标相对运动学模型、弹道倾角和弹道偏角的运动学方程和导弹的姿态动力学模型;
步骤2、根据导弹目标相对运动学模型、导弹目标相对运动学模型、导弹的姿态动力学模型、由气动参数偏差引起的***干扰、由舵机安装偏差引起的***干扰和由导弹惯导设备测量误差引起的***干扰,建立仿射形式的制导控制一体化模型;
仿射形式的制导控制一体化模型,表示为:
式中,θL为视线倾角,φL为实现偏角,x2=[α β γv]T,γV为导弹的倾侧角,α为攻角,β为侧滑角,x3=[ωx ωy ωz]T,ωxωyωz表示导弹的弹体坐标系相对与地面坐标系的角速度,u=[δx δy δz]T,u为期望舵偏角,δz为偏航舵偏角,δy为俯仰舵偏角,δx为滚转舵偏角,d1、d2和d3分别为由气动参数偏差引起的***干扰、由舵机安装偏差引起的***干扰、由导弹惯导设备测量误差引起的***干扰,
c1=cosθLcosθ+sinθsinθLcos(φL-φV),c2=sinθLsin(φL-φV),c3=sinθsin(φV-φL),c4=cos(φL-φV),m为导弹的质量,g为重力加速度,θ表示弹道倾角,φV表示弹道偏角,q为动压,S为导弹的参考面积,L为升力,l为需要设计的协调常量,Jy Jx Jz表示导弹三轴的转动惯量,mx,my,mz分别表示导弹三轴的操纵力矩,为升力系数cy对攻角α的偏导,R为导弹和目标之间的相对距离;
步骤3、通过控制仿射形式的制导控制一体化模型中的u、d′1、d2和d3,得到仿射形式的制导控制一体化模型中的x1、x2和x3的界限,利用x1、x2和x3的界限控制真实的导弹。
本发明的有益效果是:
本申请针对BTT导弹IGC模型,提出一种新的建模方法:不需要构建状态变量的微分同胚,直接将其转化为仿射***模型。此外,针对执行器饱和现象,设计一种辅助***在保证处理输入饱和现象的同时能够使辅助***状态在不奇异的情况下进入一个很小的界,并应用自适应技术估计出作用于BTT导弹的各类未知干扰(由气动参数偏差引起的***干扰、由舵机安装偏差引起的***干扰和由导弹惯导设备测量误差引起的***干扰),运用Lyapunov稳定性理论严格地证明了终端视线角跟踪误差与视线角速率的收敛性,以及***的一致最终有界性。
因此,本申请相当于通过设计控制器,用控制器控制控制仿射形式的制导控制一体化模型中的u、d1、d2和d3,得到仿射形式的制导控制一体化模型中的x1、x2和x3的界限,经过证明当x1、x2和x3在趋近于0的界限时,此时的x1、x2和x3作用在真实导弹上,更容易打中目标,实现较小的脱靶量。
附图说明
图1为一种仿射形式的制导控制一体化控制方法的流程图;
图2为一体化制导律滑翔体攻击弹道的三维图;
图3(1)为弹道倾角变化曲线图,其中theta表示弹道倾角,图3(2)为弹道偏角变化曲线图,其中fai表示弹道偏角;
图4(1)为视线倾角变化曲线图,图4(2)为视线偏角变化曲线图;
图5(1)为弹道倾角导数变化曲线图,其中dthetal表示弹道倾角导数,图5(2)为弹道偏角导数变化曲线图,其中dfail表示弹道偏角导数;
图6(1)为ωx的变化曲线图,图6(2)为ωy的变化曲线图,图6(3)为ωz的变化曲线图;
图7(1)为S1,1变化曲线图,图7(2)为S1,2变化曲线图;
图8(1)、图8(2)和图8(3)分别为S2的三个分量的变化曲线图;
图9(1)、图9(2)和图9(3)分别为S3的三个分量的变化曲线图;
图10(1)为x轴的舵偏角变化图,其中detax表示x轴的舵偏角;图10(2)为y轴的舵偏角变化图,其中detay表示y轴的舵偏角;图10(3)为z轴的舵偏角变化图,其中detaz表示z轴的舵偏角。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。
下面结合附图和具体实施例对本发明作进一步说明,但不作为本发明的限定。
具体实施方式一:结合图1说明本实施方式,本实施方式所述的一种仿射形式的制导控制一体化控制方法,所述方法包括以下步骤:
步骤1、根据导弹攻击目标模型和将导弹在速度系上的气动加速度投影到视线坐标系下的投影方程,得到导弹目标相对运动学模型、弹道倾角和弹道偏角的运动学方程和导弹的姿态动力学模型;
步骤2、根据导弹目标相对运动学模型、导弹目标相对运动学模型、导弹的姿态动力学模型、由气动参数偏差引起的***干扰、由舵机安装偏差引起的***干扰和由导弹惯导设备测量误差引起的***干扰,建立仿射形式的制导控制一体化模型;
仿射形式的制导控制一体化模型,表示为:
式中,θL为视线倾角,φL为实现偏角,x2=[α β γv]T,γV为导弹的倾侧角,α为攻角,β为侧滑角,x3=[ωx ωy ωz]T,ωxωyωz表示导弹的弹体坐标系相对与地面坐标系的角速度,u=[δx δy δz]T,u为期望舵偏角,δz为偏航舵偏角,δy为俯仰舵偏角,δx为滚转舵偏角,d1、d2和d3分别为由气动参数偏差引起的***干扰、由舵机安装偏差引起的***干扰、由导弹惯导设备测量误差引起的***干扰,
c1=cosθLcosθ+sinθsinθLcos(φL-φV),c2=sinθLsin(φL-φV),c3=sinθsin(φV-φL),c4=cos(φL-φV),m为导弹的质量,g为重力加速度,θ表示弹道倾角,φV表示弹道偏角,q为动压,S为导弹的参考面积,L为升力,l为需要设计的协调常量,Jy Jx Jz表示导弹三轴的转动惯量,mx,my,mz分别表示导弹三轴的操纵力矩,为升力系数cy对攻角α的偏导,R为导弹和目标之间的相对距离;
步骤3、通过控制仿射形式的制导控制一体化模型中的u、d′1、d2和d3,得到仿射形式的制导控制一体化模型中的x1、x2和x3的界限,利用x1、x2和x3的界限控制真实的导弹。
本实施方式中,
1、坐标系建立
为了便于分析,这里给出以下坐标系定义:
(1)地心惯性坐标系(oIxIyIzI):坐标系原点oI是地心,oIzI轴垂直于地球赤道平面,指向北极,oIxI轴与oIyI轴在赤道面内,oIxI是沿着赤道平面与子午面的相交线,oIyI轴则是由右手法则决定。
(5)弹体坐标系(ox1y1z1):坐标系原点是飞行器的质心,ox1轴与飞行器体纵轴重合,指向头部为正,oy1位于飞行器体纵向对称面内与ox1轴垂直,指向上为正,并且oz1是由右手法则决定的
(7)速度坐标系(oxvyvzv):坐标原点o为飞行器质心,oxv轴沿飞行器速度方向,oyv轴位于飞行器主对称面内,垂直于oxv轴指向上方,ozv轴与oxvyv面相垂直并构成右手坐标系。
(8)弹道坐标系(ox2y2z2):坐标原点o为飞行器质心,ox2轴沿飞行器速度方向,oz2轴位于包含速度矢量的铅锤面内垂直于ox2轴,指向下;oy2轴与ox2y2面相垂直并构成右手坐标系。
2.模型建立
给出制导一体化的导弹目标相对运动学以及动力学模型。制导控制一体化实质上是将导弹的跟踪控制***与弹体稳定控制***联合设计,首先,不失一般性的,在视线坐标系下建立导弹攻击目标的模型如下:
其中,R为导弹和目标之间的相对距离,θL和φL是视线角,ami(i=R,θ,φ)是导弹在速度坐标系上的加速度分量,相似地,ati(i=R,θ,φ)是目标在速度坐标系上的加速度分量。对导弹攻击地面固定目标场景来说,ati=0。
在末制导段,导弹的气动加速度由空气动力所提供,因此,考虑导弹气动加速度与气动力之间的关系,建立导弹气动加速度与气动力之间的关系如下:
其中,m为导弹的质量,ρ为空气密度,Vm为导弹速度,q为动压,S为导弹的参考面积,α,β,δz,δy分别为攻角、侧滑角、偏航舵偏角和俯仰舵偏角。
对导弹进行受力分析,在弹道系下投影可得:
Y′=Y cosγV-Z sinγV-mg cosθ
Z′=Y sinγV+Z cosγV
由前述坐标系定义,将导弹在速度系上的气动加速度投影到视线坐标系下,可得如下关系:
其中,
c1=cosθL cosθ+sinθsinθL cos(φL-φV)
c2=sinθL sin(φL-φV)
c3=sinθsin(φV-φL)
c4=cos(φL-φV)
对公式3和4进行整理可得新的导弹目标相对运动学方程:
弹道倾角和弹道偏角的运动学方程如下所示:
同样的,通过对导弹进行受力分析及坐标转换,可得导弹的姿态动力学方程:
对BTT导弹来说,其通过倾侧机身产生的升力在侧向分量来转弯,可通过姿态控制实现侧滑角为0,则三维制导控制一体化模型可以写为:
其中,x2=[α β γv]T,x3=[ωx ωy ωz]T,/>u=[δx δy δz]T为三维制导和控制一体化模型的控制输入。d1、d2和d3为由气动参数偏差、舵机安装偏差、导弹惯导设备测量误差等引起的***总的干扰,具体如下:
由于d1、d2和d3均为***中相关状态误差引起的干扰,因此可以假设其总干扰是有界的,即满足:
|d11|≤d11m,|d12|≤d12m
|d21|≤d21m,|d22|≤d22m,|d23|≤d23m
|d31|≤d31m,|d32|≤d32m,|d33|≤d33m
其中,
***方程中各个函数为:
然而上述制导回路公式45中,其控制量是x2的非仿射形式,导致之后的控制回路的设计中需要提前通过控制回路状态量α,β,γv计算/>制导回路与控制回路无法在一个仿真步长内是实现同步控制,对控制精度以及动态性能造成一定的影响。
为了处理这一问题,将制导控制一体化模型转化为仿射***模型,并将制导回路与控制回路进行统一证明。将公式45、公式46和公式47转化为如下形式:
则***方程中各个函数为:
其中l为需要设计的协调常量。
控制器设计:
本申请设计一种基于反步法的自适应滑模制导率实现对模型的镇定,并保证***状态x1,x2,x3在未知的扰动和输入饱和情况下实现实际稳定。
为了解决扰动上界未知的问题,先对模型(公式1)中的扰动项d′1,d2,d3进行一个假设:
假设1在模型(1)中所有的扰动集合d′1,d2,d3是有界的,且上届是未知的。令||d′1||≤dm1,||d2||≤dm2,||d3||≤dm3。
首先设计一个关于状态量θL和φL的滑模面S1:
S1=[S1,1 S1,2]T
求导得:
其中,ρ1=min{2k11,2k12}。之后为了保证滑模面S1收敛,设计如下的虚拟控制量:
求导可得:
其中kc1>0。将公式20代入虚拟控制量得到:
为了保证虚拟状态量有界,设计二阶反步控制率对S2进行稳定:
求导可得:
其中,kc2,kξ>0,Δu=[Δu1 Δu2 Δu3]T表示由输入饱和引起的控制器输出偏差
Δui=ui-uc,i(i=1,2,3)
将公式22、公式23和二阶反步虚拟控制量代入公式31中得到
则可以设计如下的制导率和自适应率保证所有状态在存在位置外界扰动的情况下稳定
其中k4为一个正常数。
之后给出如下的定理;
定理1:在假设1成立的情况下,利用改进的仿射形式的BTT导弹制导控制一体化模型(公式1),通过应用所设计的制导率,辅助***,一号滤波器,二号滤波器,自适应率,可以保证S1,S2,S3都实际稳定,且x1,x2,x3也能实现实际稳定
证明:
设计李雅普诺夫函数:
对上式求导并代入控制器(公式24)后得:
注:通过所设计的辅助***,在上式的推导中可以看出:由于输入饱和造成的表示执行器输出差异项可以被辅助***进行补偿,因此能够实现在输入饱和存在的情况下对***模型(公式1)的状态x1,x2,x3进行稳定。
应用杨氏不等式可得:
代入式35可得:
在此假设它们的上界为:
公式38可以被转化为
2.当S2有界时,则根据其定义(S2=x2-x2c-y1)可得:
||x2||≤||S2+y1+x2c||≤φs+||y1||+||x2c||
因此,||x2||也是有界的。
3.当S3有界时,则根据其定义(S3=x3-x3c-y2-ξ)可得:
||x3||≤||S3+y2+x3c+ξ||≤φs+||y1||+||x2c||+||ξ||
由于期望的的控制器输出u以及实际的控制器输出uc都是有界的,可以直接得出辅助***状态ξ是有界的。
则可以得到||x3||也是有界的。
基于上述的分析可以得到:所有的状态x1,x2,x3都是有界的。
仿真分析
对所设计的一体化制导律进行仿真分析,同样的,以末制导开始时刻导弹在地面投影作为原点,建立坐标系,设定末制导仿真初始条件如下:
导弹和目标的初始位置为:xm0=0km,ym0=20km,zm0=0km,xt0=16km,yt0=0km,zt0=0km;
导弹末制导开始时刻速度为:vm0=1200m/s,弹道倾角θ=-6°,弹道偏角ψ=5°;初始姿态角为:α0=5°,β0=0°,γ0=10°;期望末端攻击角度为:θf=-72°,ψf=-2°。末制导弹道仿真结果如图2至图10。最终的脱靶量为1.16m。可以从上述仿真结果中看出:滑模面S1以及虚拟误差S2,S3都能保证收敛到零附近的小界,且在输入饱和外界扰动存在的情况下,***的状态量x1,x2,x3均能收敛到零附近的小界。最终视线倾角和视线偏角均能收敛到期望的视线倾角和视线偏角。
因此,本申请对助推滑翔火箭弹攻击低速移动目标的场景进行了末端攻击制导律设计,首先给出了考虑制导***与控制***之间的耦合因素时设计的仿射形式制导控制一体化模型;然后基于滑模控制理论,设计了具有末端视线角约束的制导律;以及根据自适应理论设计了关于模型中存在的扰动上届,此外,设计一种辅助***可以保证在存在输入饱和时仍可以证明***的稳定性。最后,仿真分析验证了所设计的制导律的有效性。
具体实施方式二:本实施方式是对具体实施方式一所述的一种仿射形式的制导控制一体化控制方法进一步限定,在本实施方式中,步骤1中,导弹攻击目标模型表示为:
将导弹在速度系上的气动加速度投影到视线坐标系下的投影方程表示为:
式中,amy,amz为导弹在速度系上的气动加速度,Z′=Y sinγV+ZcosγV,Y′=Y cosγV-Z sinγV-mg cosθ,/> 为升力系数cy对攻角α的偏导,/>为升力系数cy对侧滑角β的偏导,/>为侧向力系数cz对攻角α的偏导,/>为侧向力系数cz对侧滑角β的偏导,/>为侧向力系数cz对俯仰舵偏角δy的偏导;
导弹目标相对运动学模型表示为:
弹道倾角和弹道偏角的运动学方程表示为:
式中,Vm为导弹速度;
导弹的姿态动力学模型表示为:
具体实施方式三:本实施方式是对具体实施方式二所述的一种仿射形式的制导控制一体化控制方法进一步限定,在本实施方式中,步骤3中,控制仿射形式的制导控制一体化模型中的u、d′1、d2和d3,得到仿射形式的制导控制一体化模型中的x1、x2和x3的界限,具体过程为:
步骤31、根据滑膜面、仿射形式的制导控制一体化模型和第一个李雅普诺夫方程,得到第一个李雅普诺夫方程的导数;
根据滑膜面、仿射形式的制导控制一体化模型、设定的一阶虚拟误差S2和第二个李雅普诺夫方程,得到第二个李雅普诺夫方程的导数;
根据滑膜面、仿射形式的制导控制一体化模型、一阶虚拟误差S2、二阶虚拟误差S3和第三个李雅普诺夫方程,得到第三个李雅普诺夫方程的导数,
步骤32、根据虚拟控制量和第二个李雅普诺夫方程的导数,得到新的第二个李雅普诺夫方程的导数,
根据第一个滤波器、第二个滤波器、辅助***、二阶反步控制率和第三个李雅普诺夫方程的导数,得到新的第三个李雅普诺夫方程的导数;
步骤33、根据设计的李雅普诺夫函数、第一个李雅普诺夫方程的导数、新的第二个李雅普诺夫方程的导数、新的第三个李雅普诺夫方程的导数、关于u的制导率和关于d′1、d2和d3的自适应率,得到李雅普诺夫函数的导数;
步骤34、根据李雅普诺夫函数的导数和杨氏不等式,得到新的李雅普诺夫函数的导数,结合滑膜面,得到仿射形式的制导控制一体化模型中x1、x2和x3的界限。
具体实施方式四:本实施方式是对具体实施方式三所述的一种仿射形式的制导控制一体化控制方法进一步限定,在本实施方式中,步骤32中,虚拟控制量x2c为:
假设d′1,d2,d3是有界的,且上届是未知的,满足:
|d11|≤d11m,|d12|≤d12m
|d21|≤d21m,|d22|≤d22m,|d23|≤d23m,
|d31|≤d31m,|d32|≤d32m,|d33|≤d33m
d1m为气动参数偏差引起的***干扰的上届,d2m为舵机安装偏差引起的***干扰的上届,d3m为导弹惯导设备测量误差引起的***干扰的上届,d11和d12为d′1的2个分量,d21、d22和d23为d2的3个分量,d31、d32和d33为d3的3个分量,d11m和d12m为d1m的2个分量,d21m、d22m和d23m为d2m的3个分量,d31m、d32m和d33m为d3m的3个分量,
令||d′1||≤d1m,||d2||≤d2m,||d3||≤d3m;
x2c表示为:
设计的第一个滤波器为:
设计的二阶反步控制率为:
设计的第二个滤波器为:
设计的辅助***为:
式中,kξ>0,Δu=[Δu1 Δu2 Δu3]T,Δui=ui-uc,i(i=1,2,3),ui为期望舵偏角u的第i个分量,uc,i为实际舵偏角uc的第i个分量,umax为输出的舵偏角最大值,ξ为辅助***的状态;/>
设计的制导率为:
设计的自适应率为:
式中,kθ1、kθ2、kθ3、kθ4、kθ5、kθ6均为正常,S2和S3表示2个虚拟误差。
具体实施方式五:本实施方式是对具体实施方式四所述的一种仿射形式的制导控制一体化控制方法进一步限定,在本实施方式中,步骤31中,得到第一个李雅普诺夫方程的导数,具体过程为:
首先设计一个关于θL和φL的滑模面S1:
式中,S1,1和S1,2表示滑模面S1的分量,k11 k12均为正常数,
当滑模面S1收敛到零时,公式27转变为:
其中,ρ1=min{2k11,2k12}。
具体实施方式六:本实施方式是对具体实施方式五所述的一种仿射形式的制导控制一体化控制方法进一步限定,在本实施方式中,步骤31中,得到第二个李雅普诺夫方程的导数,具体过程为:
具体实施方式七:本实施方式是对具体实施方式六所述的一种仿射形式的制导控制一体化控制方法进一步限定,在本实施方式中,步骤32中,得到新的第二个李雅普诺夫方程的导数,具体为:
将虚拟控制量的公式带入公式29中,得到新的第二个李雅普诺夫方程的导数为:
具体实施方式八:本实施方式是对具体实施方式七所述的一种仿射形式的制导控制一体化控制方法进一步限定,在本实施方式中,步骤31中,得到第三个李雅普诺夫方程的导数,具体为:
步骤33中,得到新的第三个李雅普诺夫方程的导数,具体为:
将公式20、公式21、公式22和公式23带入公式31中,得到新的第三个李雅普诺夫方程的导数:
具体实施方式九:本实施方式是对具体实施方式八所述的一种仿射形式的制导控制一体化控制方法进一步限定,在本实施方式中,步骤33中,得到李雅普诺夫函数的导数,具体过程为:
设计李雅普诺夫函数为:
根据制导率、第一个李雅普诺夫方程的导数、新的第二个李雅普诺夫方程的导数、新的第三个李雅普诺夫方程的导数,对公式33求导,得:
具体实施方式十:本实施方式是对具体实施方式九所述的一种仿射形式的制导控制一体化控制方法进一步限定,在本实施方式中,步骤34中,得到仿射形式的制导控制一体化模型中x1、x2和x3的界限,具体过程为:
杨氏不等式为:
将公式36和公式37带入公式35中,得到:
根据第一个滤波器和第二个滤波器的性质可知:y1,y2都是有界的,且根据b1和b2的定义得出||b1y1||和||b2y2||是有界的,在此假设它们的上界为:
根据公式39,将公式38转化为:
式中,i=1,2,3,t为时间,
当S1有界时,则根据S1的定义,得到:
当S2有界时,根据S2的定义,得到:
||x2||≤||S2+y1+x2c||≤φs+||y1||+||x2c||, 公式43
因此,||x2||也是有界的,
当S3有界时,根据S3的定义,得到:
||x3||≤||S3+y2+x3c+ξ||≤φs+||y1||+||x2c||+||ξ||, 公式44
由于ξ是有界的,得到||x3||也是有界的;
因此,得到仿射形式的制导控制一体化模型中x1、x2和x3的界限。
虽然在本文中参照了特定的实施方式来描述本发明,但是应该理解的是,这些实施例仅仅是本发明的原理和应用的示例。因此应该理解的是,可以对示例性的实施例进行许多修改,并且可以设计出其他的布置,只要不偏离所附权利要求所限定的本发明的精神和范围。应该理解的是,可以通过不同于原始权利要求所描述的方式来结合不同的从属权利要求和本文中所述的特征。还可以理解的是,结合单独实施例所描述的特征可以使用在其他所述实施例中。
Claims (10)
1.一种仿射形式的制导控制一体化控制方法,其特征在于,所述方法包括以下步骤:
步骤1、根据导弹攻击目标模型和将导弹在速度系上的气动加速度投影到视线坐标系下的投影方程,得到导弹目标相对运动学模型、弹道倾角和弹道偏角的运动学方程和导弹的姿态动力学模型;
步骤2、根据导弹目标相对运动学模型、导弹的姿态动力学模型、由气动参数偏差引起的***干扰、由舵机安装偏差引起的***干扰和由导弹惯导设备测量误差引起的***干扰,建立仿射形式的制导控制一体化模型;
仿射形式的制导控制一体化模型,表示为:
式中,θL为视线倾角,φL为实现偏角,x2=[α β γv]T,γV为导弹的倾侧角,α为攻角,β为侧滑角,x3=[ωx ωy ωz]T,ωxωyωz表示导弹的弹体坐标系相对于地面坐标系的角速度,u=[δx δy δz]T,u为期望舵偏角,δz为偏航舵偏角,δy为俯仰舵偏角,δx为滚转舵偏角,d1、d2和d3分别为由气动参数偏差引起的***干扰、由舵机安装偏差引起的***干扰、由导弹惯导设备测量误差引起的***干扰,
c1=cosθLcosθ+sinθsinθLcos(φL-φV),c2=sinθLsin(φL-φV),c3=sinθsin(φV-φL),c4=cos(φL-φV),m为导弹的质量,g为重力加速度,θ表示弹道倾角,φV表示弹道偏角,q为动压,S为导弹的参考面积,L为升力,l为需要设计的协调常量,JyJxJz表示导弹三轴的转动惯量,mx,my,mz分别表示导弹三轴的操纵力矩,为升力系数cy对攻角α的偏导,R为导弹和目标之间的相对距离,Vm为导弹速度,/>为升力系数cy对攻角α的偏导,/>为侧向力系数cz对侧滑角β的偏导;
步骤3、通过控制仿射形式的制导控制一体化模型中的u、d1′、d2和d3,得到仿射形式的制导控制一体化模型中的x1、x2和x3的界限,利用x1、x2和x3的界限控制真实的导弹。
2.根据权利要求1所述的一种仿射形式的制导控制一体化控制方法,其特征在于,步骤1中,导弹攻击目标模型表示为:
将导弹在速度系上的气动加速度投影到视线坐标系下的投影方程表示为:
式中,amy,amz为导弹在速度系上的气动加速度,Z′=YsinγV+ZcosγV,Y′=YcosγV-ZsinγV-mgcosθ,/> 为升力系数cy对攻角α的偏导,/>为升力系数cy对偏航舵偏角δz的偏导,/>为侧向力系数cz对攻角α的偏导,/>为侧向力系数cz对侧滑角β的偏导,/>为侧向力系数cz对俯仰舵偏角δy的偏导;
导弹目标相对运动学模型表示为:
弹道倾角和弹道偏角的运动学方程表示为:
式中,Vm为导弹速度;
导弹的姿态动力学模型表示为:
3.根据权利要求2所述的一种仿射形式的制导控制一体化控制方法,其特征在于,步骤3中,控制仿射形式的制导控制一体化模型中的u、d1′、d2和d3,得到仿射形式的制导控制一体化模型中的x1、x2和x3的界限,具体过程为:
步骤31、根据滑膜面、仿射形式的制导控制一体化模型和第一个李雅普诺夫方程,得到第一个李雅普诺夫方程的导数;
根据滑膜面、仿射形式的制导控制一体化模型、设定的一阶虚拟误差S2和第二个李雅普诺夫方程,得到第二个李雅普诺夫方程的导数;
根据滑膜面、仿射形式的制导控制一体化模型、一阶虚拟误差S2、二阶虚拟误差S3和第三个李雅普诺夫方程,得到第三个李雅普诺夫方程的导数,
步骤32、根据虚拟控制量和第二个李雅普诺夫方程的导数,得到新的第二个李雅普诺夫方程的导数,
根据第一个滤波器、第二个滤波器、辅助***、二阶反步控制率和第三个李雅普诺夫方程的导数,得到新的第三个李雅普诺夫方程的导数;
步骤33、根据设计的李雅普诺夫函数、第一个李雅普诺夫方程的导数、新的第二个李雅普诺夫方程的导数、新的第三个李雅普诺夫方程的导数、关于u的制导率和关于d1′、d2和d3的自适应率,得到李雅普诺夫函数的导数;
步骤34、根据李雅普诺夫函数的导数和杨氏不等式,得到新的李雅普诺夫函数的导数,结合滑膜面,得到仿射形式的制导控制一体化模型中x1、x2和x3的界限。
4.根据权利要求3所述的一种仿射形式的制导控制一体化控制方法,其特征在于,步骤32中,虚拟控制量x2c为:
假设d1′,d2,d3是有界的,且上届是未知的,满足:
d1m为气动参数偏差引起的***干扰的上届,d2m为舵机安装偏差引起的***干扰的上届,d3m为导弹惯导设备测量误差引起的***干扰的上届,d11和d12为d′1的2个分量,d21、d22和d23为d2的3个分量,d31、d32和d33为d3的3个分量,d11m和d12m为d1m的2个分量,d21m、d22m和d23m为d2m的3个分量,d31m、d32m和d33m为d3m的3个分量,
令||d′||≤d1m,||d2||≤d2m,||d3||≤d3m;
x2c表示为:
设计的第一个滤波器为:
设计的二阶反步控制率为:
设计的第二个滤波器为:
设计的辅助***为:
式中,kξ>0,Δu=[Δu1 Δu2 Δu3]T,Δui=ui-uc,i(i=1,2,3),ui为期望舵偏角u的第i个分量,uc,i为实际舵偏角uc的第i个分量,umax为输出的舵偏角最大值,ξ为辅助***的状态;
设计的制导率为:
设计的自适应率为:
式中,kθ1、kθ2、kθ3、kθ4、kθ5、kθ6均为正常数,S2和S3表示2个虚拟误差。
10.根据权利要求9所述的一种仿射形式的制导控制一体化控制方法,其特征在于,步骤34中,得到仿射形式的制导控制一体化模型中x1、x2和x3的界限,具体过程为:杨氏不等式为:
将公式36和公式37带入公式35中,得到:
根据第一个滤波器和第二个滤波器的性质可知:y1,y2都是有界的,且根据b1和b2的定义得出b1y1和b2y2是有界的,在此假设它们的上界为:
根据公式39,将公式38转化为:
式中,i=1,2,3,t为时间,
当S1有界时,则根据S1的定义,得到:
当S2有界时,根据S2的定义,得到:
x2≤S2+y1+x2c≤φs+y1+x2c,公式43
因此,x2也是有界的,
当S3有界时,根据S3的定义,得到:
x3≤S3+y2+x3c+ξ≤φs+y1+x2c+ξ,公式44
由于ξ是有界的,得到x3也是有界的;
因此,得到仿射形式的制导控制一体化模型中x1、x2和x3的界限。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210459911.5A CN114815888B (zh) | 2022-04-28 | 2022-04-28 | 一种仿射形式的制导控制一体化控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210459911.5A CN114815888B (zh) | 2022-04-28 | 2022-04-28 | 一种仿射形式的制导控制一体化控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114815888A CN114815888A (zh) | 2022-07-29 |
CN114815888B true CN114815888B (zh) | 2023-05-19 |
Family
ID=82508564
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210459911.5A Active CN114815888B (zh) | 2022-04-28 | 2022-04-28 | 一种仿射形式的制导控制一体化控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114815888B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115755838B (zh) * | 2022-11-08 | 2024-05-28 | 湖南航天有限责任公司 | 一种导弹制导控制***的精度分析方法 |
CN117130277B (zh) * | 2023-09-13 | 2024-05-10 | 中国矿业大学 | 基于安全强化学习的高超声速飞行器零和博弈方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2298835C1 (ru) * | 2005-10-28 | 2007-05-10 | Открытое акционерное общество "Государственное машиностроительное конструкторское бюро "Вымпел" им. И.И. Торопова" | Система управляемых авиационных средств поражений для функционально-моделирующего комплекса |
CN105865272A (zh) * | 2016-05-27 | 2016-08-17 | 北京航空航天大学 | 一种用于半捷联制导导弹的一体化控制方法 |
CN110008502A (zh) * | 2019-01-29 | 2019-07-12 | 西北工业大学 | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 |
CN111399531A (zh) * | 2020-04-23 | 2020-07-10 | 中国人民解放军国防科技大学 | 一种高超声速飞行器滑翔段制导与姿态控制一体化设计方法 |
CN111983921A (zh) * | 2019-05-23 | 2020-11-24 | 中国科学院沈阳自动化研究所 | 一种基于观测器技术的飞行器制导控制一体化方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9394050B2 (en) * | 2012-11-15 | 2016-07-19 | The Board Of Trustees Of The University Of Illinois | Controlled transitory or sustained gliding flight with dihedral angle and trailing flaps |
-
2022
- 2022-04-28 CN CN202210459911.5A patent/CN114815888B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2298835C1 (ru) * | 2005-10-28 | 2007-05-10 | Открытое акционерное общество "Государственное машиностроительное конструкторское бюро "Вымпел" им. И.И. Торопова" | Система управляемых авиационных средств поражений для функционально-моделирующего комплекса |
CN105865272A (zh) * | 2016-05-27 | 2016-08-17 | 北京航空航天大学 | 一种用于半捷联制导导弹的一体化控制方法 |
CN110008502A (zh) * | 2019-01-29 | 2019-07-12 | 西北工业大学 | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 |
CN111983921A (zh) * | 2019-05-23 | 2020-11-24 | 中国科学院沈阳自动化研究所 | 一种基于观测器技术的飞行器制导控制一体化方法 |
CN111399531A (zh) * | 2020-04-23 | 2020-07-10 | 中国人民解放军国防科技大学 | 一种高超声速飞行器滑翔段制导与姿态控制一体化设计方法 |
Non-Patent Citations (1)
Title |
---|
聂文明 ; 李惠峰 ; .固体导弹助推段自抗扰制导控制一体化设计方法.宇航学报.2017,(11),第1177-1185页. * |
Also Published As
Publication number | Publication date |
---|---|
CN114815888A (zh) | 2022-07-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107608367B (zh) | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 | |
CN105786024B (zh) | 一种基于模型误差补偿的机载光电平台高精度跟踪控制器及其跟踪控制方法 | |
CN114815888B (zh) | 一种仿射形式的制导控制一体化控制方法 | |
CN111591470B (zh) | 一种适应推力可调模式的飞行器精确软着陆闭环制导方法 | |
CN107491088B (zh) | 一种输入饱和的飞艇航迹控制方法 | |
CN109703768B (zh) | 一种基于姿态/轨迹复合控制的软式空中加油对接方法 | |
CN114509946B (zh) | 一种基于预设时间滑模的飞行器制导控制一体化设计方法 | |
Zhou et al. | Impact angle constrained three-dimensional integrated guidance and control based on fractional integral terminal sliding mode control | |
CN114020019B (zh) | 飞行器的制导方法与装置 | |
CN115639830B (zh) | 一种空地智能体协同编队控制***及其编队控制方法 | |
CN109703769B (zh) | 一种基于预瞄策略的空中加油对接控制方法 | |
CN115406312B (zh) | 考虑视场角和舵机延时约束的导弹制导控制一体化方法 | |
CN113778129A (zh) | 一种干扰补偿的高超声速变后掠翼飞行器跟踪控制方法 | |
Choi et al. | Adaptive control for feedback-linearized missiles with uncertainties | |
CN111240204B (zh) | 一种基于模型参考滑模变结构控制的巡飞弹控制方法 | |
CN112149234B (zh) | 一种基于俯仰角速率输入的飞行器质点运动模型设计方法 | |
CN117289598B (zh) | 一种飞行器的反步滑模控制方法及*** | |
Su et al. | A novel biased proportional navigation guidance law for close approach phase | |
CN117471952A (zh) | 一种飞行器反步超螺旋滑模制导控制一体化方法 | |
CN116382332B (zh) | 一种基于ude的战斗机大机动鲁棒飞行控制方法 | |
CN107450319A (zh) | 一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法 | |
Xiaojian et al. | Impact angle control over composite guidance law based on feedback linearization and finite time control | |
CN116360258A (zh) | 基于固定时间收敛的高超声速变形飞行器抗干扰控制方法 | |
CN116203981A (zh) | 一种基于扰动观测的四旋翼无人机的轨迹跟踪控制方法 | |
CN114265420B (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 | ||
CB03 | Change of inventor or designer information |
Inventor after: Song Shenmin Inventor after: Zhang Yuchen Inventor after: Yang Xiaoyan Inventor before: Zhang Yuchen Inventor before: Song Shenmin Inventor before: Yang Xiaoyan |
|
CB03 | Change of inventor or designer information | ||
GR01 | Patent grant | ||
GR01 | Patent grant |