CN110008502A - 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 - Google Patents
考虑全捷联导引头视场约束的三维制导控制一体化设计方法 Download PDFInfo
- Publication number
- CN110008502A CN110008502A CN201910083420.3A CN201910083420A CN110008502A CN 110008502 A CN110008502 A CN 110008502A CN 201910083420 A CN201910083420 A CN 201910083420A CN 110008502 A CN110008502 A CN 110008502A
- Authority
- CN
- China
- Prior art keywords
- missile
- angle
- state
- uncertainty
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 47
- 230000003044 adaptive effect Effects 0.000 claims abstract description 16
- 238000013178 mathematical model Methods 0.000 claims abstract description 5
- 230000004888 barrier function Effects 0.000 claims description 8
- 230000001133 acceleration Effects 0.000 claims description 6
- 230000015572 biosynthetic process Effects 0.000 claims description 4
- 238000003786 synthesis reaction Methods 0.000 claims description 4
- 230000006978 adaptation Effects 0.000 claims description 3
- 238000001514 detection method Methods 0.000 abstract description 2
- 230000007547 defect Effects 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- QIVUCLWGARAQIO-OLIXTKCUSA-N (3s)-n-[(3s,5s,6r)-6-methyl-2-oxo-1-(2,2,2-trifluoroethyl)-5-(2,3,6-trifluorophenyl)piperidin-3-yl]-2-oxospiro[1h-pyrrolo[2,3-b]pyridine-3,6'-5,7-dihydrocyclopenta[b]pyridine]-3'-carboxamide Chemical class C1([C@H]2[C@H](N(C(=O)[C@@H](NC(=O)C=3C=C4C[C@]5(CC4=NC=3)C3=CC=CN=C3NC5=O)C2)CC(F)(F)F)C)=C(F)C=CC(F)=C1F QIVUCLWGARAQIO-OLIXTKCUSA-N 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000001228 spectrum 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
- F42B15/00—Self-propelled projectiles or missiles, e.g. rockets; Guided missiles
- F42B15/01—Arrangements thereon for guidance or control
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2111/00—Details relating to CAD techniques
- G06F2111/04—Constraint-based CAD
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Geometry (AREA)
- General Physics & Mathematics (AREA)
- Chemical & Material Sciences (AREA)
- Aviation & Aerospace Engineering (AREA)
- Combustion & Propulsion (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种考虑全捷联导引头视场约束的三维制导控制一体化设计方法,该方法首先建立全捷联导引头视线解耦模型、三维空间内导弹‑目标的相对运动模型以及弹体姿态控制系统模型;再选择状态变量和系统输出变量,建立考虑视场角约束的三维制导控制一体化状态空间数学模型;采用障碍Lyapunov函数、自适应干扰观测器以及动态面控制相结合的控制方法。由于采用障碍Lyapunov函数、自适应干扰观测器以及动态面控制相结合的控制方法,同时满足了制导精度和全捷联导引头视场角约束条件,保证了导弹制导控制过程中全捷联导引头探测的体视线角满足导引头视场约束。
Description
技术领域
本发明属于航天技术领域,涉及一种三维场景下的制导控制一体化设计方法,特别涉及一种在考虑全捷联导引头视场约束的三维制导控制一体化设计方法。
背景技术
随着制导武器小型化、低成本化的发展,将探测器件与弹体固联安装的一类全捷联导引头受到越来越多的关注,这类导引头非常适合在空间有限的无人机载导弹或单兵便携式战术导弹上使用。然而,全捷联导引头也存在一定的固有缺陷,首先,此类导引头的探测器光轴不再与弹体运动隔离,这使得基于惯性视线角速率信息的传统比例导引方法无法直接使用,需要进行额外的捷联解耦,另外,全捷联导引头的视场有限,过大的姿态调整很容易导致目标逃逸导引头视场,从而引起导弹脱靶。
针对全捷联导弹制导控制系统,传统的设计方法主要包括以下几个步骤,首先进行捷联解耦,得到惯性系下的视线角速率信息,然后基于频谱分离的思想分别设计制导子系统和控制子系统,再将二者进行整合。这种设计方法并不总能实时地协调各个子系统之间的关系,对于射程较近的单兵武器很容易失稳,无法满足设计需要。为了提高制导控制系统的可靠性及总体性能,需要充分利用导弹制导系统与控制系统之间的相互作用进行导弹制导控制一体化设计。
文献1“带落角约束的BTT飞行器制导控制一体化方法研究.哈尔滨工业大学硕士学位论文,2011.”公开了一种满足落角约束的BTT飞行器制导控制一体化设计方法。该方法应用多滑模面滑模控制理论,满足了三维攻击过程的落角约束。然而,落角是属于制导范畴的物理量,满足落角约束并不能从根本上确保视场角度满足约束,因此该方法无法确保全捷联导引体制下的视场角限制。
文献2“考虑全捷联导引头视场约束的制导控制一体化设计方法.国家发明专利,201710023831.4,2017年.”公开了一种考虑导引头视场限制的导引与控制一体化设计方法。该方法将捷联解耦原理和状态约束控制方法相结合,满足了攻击过程导引头视场约束。然而,该方法假设导弹在二维纵向平面内对目标进行拦截,无法模拟真实战场环境中的三维拦截情景,因此该方法具有局限性。
综上所述,现有制导控制方法难以从理论上同时满足三维攻击场景下制导精度和全捷联导引头视场角约束条件,并且国内外针对全捷联视场约束下的三维制导控制一体化设计方法还未见公开文献。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种考虑全捷联导引头视场约束的三维制导控制一体化设计方法。
技术方案
一种考虑全捷联导引头视场约束的三维制导控制一体化设计方法,其特征在于步骤如下:
步骤1:建立全捷联导引头视线解耦模型、三维空间内导弹-目标的相对运动模型以及弹体姿态控制系统模型;
(a).建立全捷联导引头视线解耦模型
其中,ηBL,εBL分别表示体视线方位角和体视线高低角,分别表示体视线方位角速率和体视线高低角速率,η,ε分别表示惯性系下弹-目相对视线方位角和高低角,分别表示惯性系下的弹-目相对视线方位角速率和高低角速率,ψ,分别表示偏航角和俯仰角,分别表示偏航角速率和俯仰角速率,由下式给出:
其中,ωx,ωy,ωz分别是导弹的滚转角速率、偏航角速率和俯仰角速率,γ表示弹体的滚转角;
(b).建立三维空间内导弹-目标的相对运动模型
其中,分别是惯性系下的弹-目相对视线方位角加速度和高低角加速度,R,分别是弹-目相对距离和相对速度,r是弹-目相对距离在水平面上的投影;α,β分别是导弹的飞行攻角和飞行侧滑角,P是导弹的发动机推力,q是导弹的飞行动压,S是导弹的参考面积,L是导弹的参考长度,是升力系数对攻角的偏导数,是侧向力系数对偏航角的偏导数,dZ,dY分别是导弹侧向力和升力的不确定性;aty,atz分别是目标纵向平面和侧向平面的加速度分量;
(c).建立弹体姿态控制系统模型
其中,δx,δy,δz分别是导弹的滚转舵偏角、偏航舵偏角和俯仰舵偏角;P是导弹的发动机推力,m是导弹的质量,Jx,Jy,Jz是导弹的转动惯量,VM是导弹的飞行速度;q是导弹的飞行动压,S是导弹的参考面积,L是导弹的参考长度;是升力系数对攻角的偏导数,是侧向力系数对偏航角的偏导数;是俯仰力矩系数对攻角的偏导数,是偏航力矩系数对侧滑角的偏导数,是滚转力矩系数对滚转舵偏角的偏导数,是偏航力矩系数对偏航舵偏角的偏导数,是俯仰力矩系数对俯仰舵偏角的偏导数;d3,d4表示由导弹的空气动力学系数引起的不确定性;
步骤2:选择状态变量和系统输出变量,建立考虑视场角约束的三维制导控制一体化状态空间数学模型
选择状态变量为:x1=[ηBL εBL]T,x3=[γ β α],x4=[ωx ωy ωz],u=[δx δy δz];
得到系统的状态空间模型如下:
其中:
Δ3=d3
Δ4=d4
Δ1为第1个状态方程的综合不确定性,Δ2为第2个状态方程的综合不确定性,Δ3为第3个状态方程的综合不确定性,Δ4为第4个状态方程的综合不确定性;u是待设计的系统控制输入;
步骤3:给定视场角约束边界,设计x2的虚拟控制量
定义误差项s1=x1且x1=[x11x12]T,以x2d作为状态x2的虚拟控制量;定义Q为需要约束的视场角范围,为了确保纵向通道和侧向通道的体视线角同时满足约束条件|x11|≤Q,|x12|≤Q,设计x2d为:
其中, 是第一个状态方程的综合不确定性上界平方的估计量,λ1和k1=diag(k11,k12)为待设计的控制参数;
引入如下的自适应律对模型的不确定性进行估计和补偿:
其中,是第1个状态方程的综合不确定性上界平方的估计量的一阶导数,μ1为待设计的参数;
为了避免虚拟控制微分膨胀,引入一阶滤波器获取新的变量x2c:
其中,x2c是虚拟控制量x2d的近似量,是x2c的一阶导数,τ2=diag(τ21,τ22)为动态面的时间延迟参数;
步骤4:保证在飞行过程中弹体不发生滚转,设计的虚拟控制量
定义误差项s2=x2-x2d,以作为状态的虚拟控制量,设计为:
其中,是第2个状态方程的综合不确定性上界平方的估计量,λ2和k2=diag(k21,k22)为待设计的控制参数;
引入如下的自适应律对模型的不确定性进行估计和补偿:
其中,是第2个状态方程的综合不确定性上界平方的估计量的一阶导数,μ2为待设计的参数;
为了避免虚拟控制微分膨胀,引入一阶滤波器获取新的变量
其中,是虚拟控制量的近似量,是的一阶导数,τ3=diag(τ31,τ32)为动态面的时间延迟参数;
步骤5:设计x4的虚拟控制量
定义误差项以x4d作为状态x4的虚拟控制量,设计x4d为:
其中,是第3个状态方程的综合不确定性上界平方的估计量,λ3和k3=diag(k31,k32,k33)为待设计的控制参数;
引入如下的自适应律对模型的不确定性进行估计和补偿:
其中,是第3个状态方程综合不确定性上界平方的估计量的一阶导数,μ3为待设计的参数;
为了避免虚拟控制微分膨胀,引入一阶滤波器获取新的变量x4c:
其中,x4c是虚拟控制量x4d的近似量,是x4c的一阶导数,τ4=diag(τ41,τ42,τ43)为动态面的时间延迟参数;
步骤6:设计制导控制一体化的理想舵偏角指令
定义误差项s4=x4-x4c,u为理想的舵偏角指令,设计u为:
其中,是第4个状态方程的综合不确定性上界平方的估计量,λ4和k4=diag(k41,k42,k43)为待设计的控制参数;
引入如下的自适应律对模型的不确定性进行估计和补偿:
其中,是第4个状态方程综合不确定性上界平方的估计量的一阶导数,μ4为待设计的参数;
步骤7:结合步骤3~6综合得到最终考虑全捷联导引头视场角约束的三维制导控制一体化设计结果;给出最终的控制器表达式如下:
步骤8:设计带有障碍积分形式的Lyapunov函数证明闭环系统的有界稳定性
将滤波器引起的边界层误差向量定义为:
自适应律的估计误差可以表示为:
设计带有障碍积分形式的Lyapunov函数为:
根据上述定义,基于Lyapunov稳定性定义可知闭环系统渐进收敛。
有益效果
本发明提出的一种考虑全捷联导引头视场约束的三维制导控制一体化设计方法,该方法首先建立全捷联导引头视线解耦模型、三维空间内导弹-目标的相对运动模型以及弹体姿态控制系统模型;再选择状态变量和系统输出变量,建立考虑视场角约束的三维制导控制一体化状态空间数学模型;采用障碍积分Lyapunov函数、自适应干扰观测器以及动态面控制相结合的控制方法。由于采用障碍积分Lyapunov函数、自适应干扰观测器以及动态面控制相结合的控制方法,同时满足了制导精度和全捷联导引头视场角约束条件,保证了导弹在三维空间的制导控制过程中全捷联导引头探测的体视线角满足导引头视场约束。
附图说明
图1是本发明考虑全捷联导引头视场约束的三维制导控制一体化设计方法的流程图;
图2是导弹攻击目标过程中各个物理量信息的示意图;
图3是导弹攻击典型运动目标的弹道轨迹;
图4是导弹攻击典型运动目标过程捷联导引头测量的体视线角曲线;
图5是导弹攻击典型运动目标过程弹体滚转角变化曲线;
图6是导弹攻击典型空中运动目标过程中的舵偏角曲线。
具体实施方式
下面选择不同视场范围的导引头(以5°,6°,7°为例),结合附图和具体实施方式对本发明作详细说明。
以下实施例参照图1-6。
本发明考虑全捷联导引头视场约束的三维制导控制一体化设计方法具体步骤如下:
步骤一、建立全捷联导引头视线解耦模型、三维空间内导弹-目标的相对运动模型以及弹体姿态控制系统模型;
(a).建立全捷联导引头视线解耦模型。
其中,ηBL,εBL是分别表示体视线方位角和体视线高低角,ψ,分别表示方位角和高低角,分别表示方位角速率和高低角速率,由下式给出:
(b).建立三维空间内导弹-目标的相对运动模型。
其中,η,ε分别是弹-目相对视线方位角和高低角,分别是惯性系下的弹-目相对视线方位角速度和高低角速度,分别是惯性系下的弹-目相对视线方位角加速度和高低角加速度,R是弹-目相对距离,r是弹-目相对距离在水平面上的投影,是弹-目相对速度;α,β分别是导弹的飞行攻角和飞行侧滑角,q是导弹的飞行动压,S是导弹的参考面积,L是导弹的参考长度,是升力系数对攻角的偏导数,是侧向力系数对偏航角的偏导数;aty,atz分别是目标纵向平面和侧向平面的加速度分量,dZ,dY分别是导弹侧向力和升力的不确定性。
(c).建立弹体姿态控制系统模型。
其中,α,β,γ,分别是是导弹的飞行攻角、飞行侧滑角、滚转角和俯仰角,ωx,ωy,ωz分别是导弹的滚转角速度、偏航角速度和俯仰角速度,δx,δy,δz分别是导弹的滚转舵偏角、偏航舵偏角和俯仰舵偏角;P是导弹的发动机推力,m是导弹的质量,Jx,Jy,Jz是导弹的转动惯量,VM是导弹的飞行速度;q是导弹的飞行动压,S是导弹的参考面积,L是导弹的参考长度;是升力系数对攻角的偏导数,是侧向力系数对偏航角的偏导数;是俯仰力矩系数对攻角的偏导数,是偏航力矩系数对侧滑角的偏导数,是滚转力矩系数对滚转舵偏角的偏导数,是偏航力矩系数对偏航舵偏角的偏导数,是俯仰力矩系数对俯仰舵偏角的偏导数;Δ3,Δ4表示不确定性。
步骤二、选择状态变量和系统输出变量,建立考虑视场角约束的三维制导控制一体化状态空间数学模型;
选择状态变量为:x1=[ηBL εBL]T,x3=[γ β α],x4=[ωx ωy ωz],u=[δx δy δz]。
得到系统的状态空间模型如下:
其中:
Δ3=d3
Δ4=d4
Δ1为第1个状态方程的综合不确定性,Δ2为第2个状态方程的综合不确定性,Δ3为第3个状态方程的综合不确定性,Δ4为第4个状态方程的综合不确定性;u是待设计的系统控制输入。
步骤三、给定视场角约束边界,设计x2的虚拟控制量;
定义误差项s1=x1且x1=[x11x12]T,以x2d作为状态x2的虚拟控制量。定义Q为需要约束的视场角范围,为了确保体视线角同时满足|x11|≤Q,|x12|≤Q,设计x2d为:
其中,k1=diag(k11,k12)和λ1为待设计的控制参数。
引入如下的自适应律对模型的不确定性进行估计和补偿:
为了避免虚拟控制微分膨胀,引入一阶滤波器获取新的变量x2c:
其中,τ2=diag(τ21,τ22)为动态面的时间延迟参数。
步骤四、保证在飞行过程中弹体不发生滚转,设计的虚拟控制量;
定义误差项s2=x2-x2d,以作为状态的虚拟控制量,设计为:
其中,k2=diag(k21,k22)、λ2为待设计的控制参数。
引入如下的自适应律对模型的不确定性进行估计和补偿:
为了避免虚拟控制微分膨胀,引入一阶滤波器获取新的变量
其中τ3=diag(τ31,τ32)为动态面的时间延迟参数。
步骤五、设计x4的虚拟控制量;
定义误差项以x4d作为状态x4的虚拟控制量,设计x4d为:
其中,k3=diag(k31,k32,k33)、λ3为待设计的控制参数。
引入如下的自适应律对模型的不确定性进行估计和补偿:
为了避免虚拟控制微分膨胀,引入一阶滤波器获取新的变量x4c:
动态面的时间延迟参数
其中,τ4=diag(τ41,τ42,τ43)为。
步骤六、设计制导控制一体化的理想舵偏角指令;
定义误差项s4=x4-x4c,u为理想的舵偏角指令,设计u为:
其中,k4=diag(k41,k42,k43)、λ4为待设计的控制参数。
引入如下的自适应律对模型的不确定性进行估计和补偿:
步骤七、结合步骤三~步骤六综合得到最终考虑全捷联导引头视场角约束的三维制导控制一体化设计结果。给出最终的控制器表达式如下:
步骤八、设计带有障碍积分形式的Lyapunov函数证明闭环系统的有界稳定性;
将滤波器引起的边界层误差向量定义为:
自适应律的估计误差可以表示为:
设计带有障碍积分形式的Lyapunov函数为:
可以证明该Lyapunov函数满足渐进收敛条件。
按照一体化制导控制律(37)即可对系统施加控制。
本实施例步骤三中的k1=diag(0.1,0.1),Q=5/57.3,τ2=diag(0.1,0.1,0.1),λ1=0.1,μ1=0.1。
本实施例步骤四中的k2=diag(3,3),τ3=diag(0.1,0.1,0.1),λ2=0.1,μ2=0.1。
本实施例步骤五中的k3=diag(60,3,3),τ4=diag(0.05,0.05,0.05),λ3=0.1,μ3=0.1。
本实施例步骤六中的k4=diag(60,20,20),λ4=0.1,μ4=0.1。
应用实施例:
参照图2,以全捷联导弹攻击无人机为例进行方法的实施说明。其中,O-XIYIZI表示地面惯性系,O-XbYbZb表示弹体坐标系,M,T分别代表导弹和目标位置,Oxb表征弹体轴向,MT表征弹-目矢量;ηBL,εBL分别为全捷联导引头测量的体视线方位角和体视线高低角。
给定目标的初始位置xt,速度Vt,加速度at分别为:
导弹的初始位置xm,初始速度Vm,俯仰角偏航角ψ,滚转角γ,弹道倾角θ,弹道偏角ψV,俯仰角速度ωx,滚转角速度ωy,偏航角速度ωz分别为:
xm(0)=[0 200 0]T,Vm(0)=400m/s,
ψ(0)=0rad,γ(0)=0rad,θ(0)=0.01rad,
ψV(0)=-0.01rad,ωx(0)=0.1rad/s,ωy(0)=0.1rad/s,
ωz(0)=0.1rad/s
参考文献“Adaptive block dynamic surface control for integratedmissile guidance and control,Chinese Journal of Aerospace,航空学报英文版,2013,Vol.26(3),p741-751”所公开的导弹参数如表1所示:
表1导弹的相关参数
选择全捷联导引头的视场角范围为5°,仿真结束条件为弹目相对距离小于0.5m。
图3给出了导弹攻击典型空中运动目标的弹道轨迹,可以看出整个攻击过程弹道较为平缓,由此说明对导弹的过载要求较低。
图4给出了导弹攻击典型空中运动目标过程中捷联导引头测量的两个体视线角曲线,可以看出,在障碍积分Lyapunov函数的作用下体视线角始终保持在约束的视场角范围内。
图5给出了导弹攻击典型空中运动目标过程中弹体的滚转角曲线,整个攻击过程中弹体的滚转角始终保持在0.4°以内,这同样说明制导控制过程中弹体基本没有产生滚转。
图6给出了导弹攻击典型空中运动目标过程中的舵偏角曲线,整个攻击过程中舵偏角光滑并且非奇异,适合在实际工程中应用。
Claims (1)
1.一种考虑全捷联导引头视场约束的三维制导控制一体化设计方法,其特征在于步骤如下:
步骤1:建立全捷联导引头视线解耦模型、三维空间内导弹-目标的相对运动模型以及弹体姿态控制系统模型;
(a).建立全捷联导引头视线解耦模型
其中,ηBL,εBL分别表示体视线方位角和体视线高低角,分别表示体视线方位角速率和体视线高低角速率,η,ε分别表示惯性系下弹-目相对视线方位角和高低角,分别表示惯性系下的弹-目相对视线方位角速率和高低角速率,ψ,θ分别表示偏航角和俯仰角,分别表示偏航角速率和俯仰角速率,由下式给出:
其中,ωx,ωy,ωz分别是导弹的滚转角速率、偏航角速率和俯仰角速率,γ表示弹体的滚转角;
(b).建立三维空间内导弹-目标的相对运动模型
其中,分别是惯性系下的弹-目相对视线方位角加速度和高低角加速度,R,分别是弹-目相对距离和相对速度,r是弹-目相对距离在水平面上的投影;α,β分别是导弹的飞行攻角和飞行侧滑角,P是导弹的发动机推力,q是导弹的飞行动压,S是导弹的参考面积,L是导弹的参考长度,是升力系数对攻角的偏导数,是侧向力系数对偏航角的偏导数,dZ,dY分别是导弹侧向力和升力的不确定性;aty,atz分别是目标纵向平面和侧向平面的加速度分量;
(c).建立弹体姿态控制系统模型
其中,δx,δy,δz分别是导弹的滚转舵偏角、偏航舵偏角和俯仰舵偏角;P是导弹的发动机推力,m是导弹的质量,Jx,Jy,Jz是导弹的转动惯量,VM是导弹的飞行速度;q是导弹的飞行动压,S是导弹的参考面积,L是导弹的参考长度;是升力系数对攻角的偏导数,是侧向力系数对偏航角的偏导数;是俯仰力矩系数对攻角的偏导数,是偏航力矩系数对侧滑角的偏导数,是滚转力矩系数对滚转舵偏角的偏导数,是偏航力矩系数对偏航舵偏角的偏导数,是俯仰力矩系数对俯仰舵偏角的偏导数;d3,d4表示由导弹的空气动力学系数引起的不确定性;
步骤2:选择状态变量和系统输出变量,建立考虑视场角约束的三维制导控制一体化状态空间数学模型
选择状态变量为:x1=[ηBL εBL]T,x3=[γ β α],x4=[ωx ωyωz],u=[δx δy δz];
得到系统的状态空间模型如下:
其中:
Δ3=d3
Δ4=d4
Δ1为第1个状态方程的综合不确定性,Δ2为第2个状态方程的综合不确定性,Δ3为第3个状态方程的综合不确定性,Δ4为第4个状态方程的综合不确定性;u是待设计的系统控制输入;
步骤3:给定视场角约束边界,设计x2的虚拟控制量
定义误差项s1=x1且x1=[x11 x12]T,以x2d作为状态x2的虚拟控制量;定义Q为需要约束的视场角范围,为了确保纵向通道和侧向通道的体视线角同时满足约束条件|x11|≤Q,|x12|≤Q,设计x2d为:
其中, 是第一个状态方程的综合不确定性上界平方的估计量,λ1和k1=diag(k11,k12)为待设计的控制参数;
引入如下的自适应律对模型的不确定性进行估计和补偿:
其中,是第1个状态方程的综合不确定性上界平方的估计量的一阶导数,μ1为待设计的参数;
为了避免虚拟控制微分膨胀,引入一阶滤波器获取新的变量x2c:
其中,x2c是虚拟控制量x2d的近似量,是x2c的一阶导数,τ2=diag(τ21,τ22)为动态面的时间延迟参数;
步骤4:保证在飞行过程中弹体不发生滚转,设计的虚拟控制量
定义误差项s2=x2-x2d,以作为状态的虚拟控制量,设计为:
其中,是第2个状态方程的综合不确定性上界平方的估计量,λ2和k2=diag(k21,k22)为待设计的控制参数;
引入如下的自适应律对模型的不确定性进行估计和补偿:
其中,是第2个状态方程的综合不确定性上界平方的估计量的一阶导数,μ2为待设计的参数;
为了避免虚拟控制微分膨胀,引入一阶滤波器获取新的变量
其中,是虚拟控制量的近似量,是的一阶导数,τ3=diag(τ31,τ32)为动态面的时间延迟参数;
步骤5:设计x4的虚拟控制量
定义误差项以x4d作为状态x4的虚拟控制量,设计x4d为:
其中,是第3个状态方程的综合不确定性上界平方的估计量,λ3和k3=diag(k31,k32,k33)为待设计的控制参数;
引入如下的自适应律对模型的不确定性进行估计和补偿:
其中,是第3个状态方程综合不确定性上界平方的估计量的一阶导数,μ3为待设计的参数;
为了避免虚拟控制微分膨胀,引入一阶滤波器获取新的变量x4c:
其中,x4c是虚拟控制量x4d的近似量,是x4c的一阶导数,τ4=diag(τ41,τ42,τ43)为动态面的时间延迟参数;
步骤6:设计制导控制一体化的理想舵偏角指令
定义误差项s4=x4-x4c,u为理想的舵偏角指令,设计u为:
其中,是第4个状态方程的综合不确定性上界平方的估计量,λ4和k4=diag(k41,k42,k43)为待设计的控制参数;
引入如下的自适应律对模型的不确定性进行估计和补偿:
其中,是第4个状态方程综合不确定性上界平方的估计量的一阶导数,μ4为待设计的参数;
步骤7:结合步骤3~6综合得到最终考虑全捷联导引头视场角约束的三维制导控制一体化设计结果;给出最终的控制器表达式如下:
步骤8:设计带有障碍积分形式的Lyapunov函数证明闭环系统的有界稳定性
将滤波器引起的边界层误差向量定义为:
自适应律的估计误差可以表示为:
设计带有障碍积分形式的Lyapunov函数为:
根据上述定义,基于Lyapunov稳定性定义可知闭环系统渐进收敛。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910083420.3A CN110008502B (zh) | 2019-01-29 | 2019-01-29 | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910083420.3A CN110008502B (zh) | 2019-01-29 | 2019-01-29 | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110008502A true CN110008502A (zh) | 2019-07-12 |
CN110008502B CN110008502B (zh) | 2022-07-15 |
Family
ID=67165526
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910083420.3A Active CN110008502B (zh) | 2019-01-29 | 2019-01-29 | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110008502B (zh) |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111102886A (zh) * | 2019-12-12 | 2020-05-05 | 中国人民解放军海军航空大学 | 一种小微飞行器无陀螺精确制导方法 |
CN111102887A (zh) * | 2019-12-31 | 2020-05-05 | 三峡大学 | 一种基于反作用飞轮的弹体滚转角控制方法 |
CN111649734A (zh) * | 2020-06-11 | 2020-09-11 | 哈尔滨工业大学 | 一种基于粒子群算法的捷联导引头目标定位方法 |
CN111680426A (zh) * | 2020-06-12 | 2020-09-18 | 孙宏宇 | 一种变系数比例导引参数设计方法 |
CN111679687A (zh) * | 2020-05-22 | 2020-09-18 | 北京空天技术研究所 | 一种带有落角约束的导引控制一体化方法 |
CN112013726A (zh) * | 2020-08-25 | 2020-12-01 | 哈尔滨工业大学 | 一种基于三阶模型的全捷联制导控制一体化设计方法 |
CN112050693A (zh) * | 2020-09-04 | 2020-12-08 | 哈尔滨工业大学 | 考虑攻击角和视场约束的半捷联制导控制一体化设计方法 |
CN113064350A (zh) * | 2021-03-22 | 2021-07-02 | 中国人民解放军国防科技大学 | 一种导弹助推段自适应动态面控制方法和装置 |
CN114138000A (zh) * | 2021-08-16 | 2022-03-04 | 西北工业大学 | 考虑全捷联导引头视场约束的弹群协同制导控制一体化设计方法 |
CN114636352A (zh) * | 2022-02-22 | 2022-06-17 | 西安航天三沃机电设备有限责任公司 | 一种捷联式激光导引头角度输出标定方法 |
CN114815888A (zh) * | 2022-04-28 | 2022-07-29 | 哈尔滨工业大学 | 一种仿射形式的制导控制一体化控制方法 |
CN115406312A (zh) * | 2022-09-23 | 2022-11-29 | 北京航空航天大学 | 考虑视场角和舵机延时约束的导弹制导控制一体化方法 |
CN115421501A (zh) * | 2022-09-14 | 2022-12-02 | 中国科学院声学研究所 | 一种水下航行器有限时间信号估计方法及系统 |
CN116700306A (zh) * | 2023-06-02 | 2023-09-05 | 北京理工大学 | 一种用于捷联导引飞行器的一体化制导控制方法 |
CN116839429A (zh) * | 2023-09-01 | 2023-10-03 | 北京航空航天大学 | 一种考虑导引头视场角度约束的制导控制一体化方法 |
CN116974208A (zh) * | 2023-09-22 | 2023-10-31 | 西北工业大学 | 基于捷联导引头的旋翼无人机目标打击控制方法及系统 |
CN118009819A (zh) * | 2024-04-10 | 2024-05-10 | 西安现代控制技术研究所 | 一种弱资源情况下的转弯控制策略设计方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101256080A (zh) * | 2008-04-09 | 2008-09-03 | 南京航空航天大学 | 卫星/惯性组合导航系统的空中对准方法 |
CN103197545A (zh) * | 2013-02-25 | 2013-07-10 | 西北工业大学 | 高速飞行器快速在线综合识别方法 |
KR20140052301A (ko) * | 2012-10-24 | 2014-05-07 | 국방과학연구소 | 상사성을 이용한 극좌표 기반 동체 부착형 탐색기 시선각 변화율 추정 시스템 |
US20140288896A1 (en) * | 2009-10-15 | 2014-09-25 | American Gnc Corporation | Gyrocompass modeling and simulation system (GMSS) and method thereof |
CN105865272A (zh) * | 2016-05-27 | 2016-08-17 | 北京航空航天大学 | 一种用于半捷联制导导弹的一体化控制方法 |
CN106681348A (zh) * | 2017-01-13 | 2017-05-17 | 西北工业大学 | 考虑全捷联导引头视场约束的制导控制一体化设计方法 |
US20170160306A1 (en) * | 2015-12-07 | 2017-06-08 | Atlantic Inertial Systems Limited | Inertial navigation system |
CN107255924A (zh) * | 2017-06-14 | 2017-10-17 | 哈尔滨工业大学 | 基于扩维模型的容积卡尔曼滤波提取捷联导引头制导信息的方法 |
-
2019
- 2019-01-29 CN CN201910083420.3A patent/CN110008502B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101256080A (zh) * | 2008-04-09 | 2008-09-03 | 南京航空航天大学 | 卫星/惯性组合导航系统的空中对准方法 |
US20140288896A1 (en) * | 2009-10-15 | 2014-09-25 | American Gnc Corporation | Gyrocompass modeling and simulation system (GMSS) and method thereof |
KR20140052301A (ko) * | 2012-10-24 | 2014-05-07 | 국방과학연구소 | 상사성을 이용한 극좌표 기반 동체 부착형 탐색기 시선각 변화율 추정 시스템 |
CN103197545A (zh) * | 2013-02-25 | 2013-07-10 | 西北工业大学 | 高速飞行器快速在线综合识别方法 |
US20170160306A1 (en) * | 2015-12-07 | 2017-06-08 | Atlantic Inertial Systems Limited | Inertial navigation system |
CN105865272A (zh) * | 2016-05-27 | 2016-08-17 | 北京航空航天大学 | 一种用于半捷联制导导弹的一体化控制方法 |
CN106681348A (zh) * | 2017-01-13 | 2017-05-17 | 西北工业大学 | 考虑全捷联导引头视场约束的制导控制一体化设计方法 |
CN107255924A (zh) * | 2017-06-14 | 2017-10-17 | 哈尔滨工业大学 | 基于扩维模型的容积卡尔曼滤波提取捷联导引头制导信息的方法 |
Non-Patent Citations (4)
Title |
---|
XINGWEI LI 等: "Integrated guidance and control for missiles with strap-down seeker", 《2017 36TH CHINESE CONTROL CONFERENCE (CCC)》 * |
YONGSHAN LIU 等: "Extraction and Filter Algorithm of Guidance Information for Full-strapdown Seeker on Rotation Missile", 《MATEC WEB OF CONFERENCES》 * |
白瑞 等: "全捷联导引头视线角速度STCKF提取技术", 《红外与激光工程》 * |
赵斌 等: "考虑视场角约束的捷联导引与控制一体化设计", 《宇航学报》 * |
Cited By (28)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111102886A (zh) * | 2019-12-12 | 2020-05-05 | 中国人民解放军海军航空大学 | 一种小微飞行器无陀螺精确制导方法 |
CN111102886B (zh) * | 2019-12-12 | 2022-03-25 | 中国人民解放军海军航空大学 | 一种小微飞行器无陀螺精确制导方法 |
CN111102887A (zh) * | 2019-12-31 | 2020-05-05 | 三峡大学 | 一种基于反作用飞轮的弹体滚转角控制方法 |
CN111102887B (zh) * | 2019-12-31 | 2022-04-08 | 三峡大学 | 一种基于反作用飞轮的弹体滚转角控制方法 |
CN111679687A (zh) * | 2020-05-22 | 2020-09-18 | 北京空天技术研究所 | 一种带有落角约束的导引控制一体化方法 |
CN111679687B (zh) * | 2020-05-22 | 2023-09-12 | 北京空天技术研究所 | 一种带有落角约束的导引控制一体化方法 |
CN111649734A (zh) * | 2020-06-11 | 2020-09-11 | 哈尔滨工业大学 | 一种基于粒子群算法的捷联导引头目标定位方法 |
CN111649734B (zh) * | 2020-06-11 | 2021-03-23 | 哈尔滨工业大学 | 一种基于粒子群算法的捷联导引头目标定位方法 |
CN111680426A (zh) * | 2020-06-12 | 2020-09-18 | 孙宏宇 | 一种变系数比例导引参数设计方法 |
CN111680426B (zh) * | 2020-06-12 | 2024-02-23 | 孙宏宇 | 一种变系数比例导引参数设计方法 |
CN112013726A (zh) * | 2020-08-25 | 2020-12-01 | 哈尔滨工业大学 | 一种基于三阶模型的全捷联制导控制一体化设计方法 |
CN112050693A (zh) * | 2020-09-04 | 2020-12-08 | 哈尔滨工业大学 | 考虑攻击角和视场约束的半捷联制导控制一体化设计方法 |
CN113064350A (zh) * | 2021-03-22 | 2021-07-02 | 中国人民解放军国防科技大学 | 一种导弹助推段自适应动态面控制方法和装置 |
CN114138000A (zh) * | 2021-08-16 | 2022-03-04 | 西北工业大学 | 考虑全捷联导引头视场约束的弹群协同制导控制一体化设计方法 |
CN114636352A (zh) * | 2022-02-22 | 2022-06-17 | 西安航天三沃机电设备有限责任公司 | 一种捷联式激光导引头角度输出标定方法 |
CN114636352B (zh) * | 2022-02-22 | 2023-08-04 | 西安航天三沃机电设备有限责任公司 | 一种捷联式激光导引头角度输出标定方法 |
CN114815888A (zh) * | 2022-04-28 | 2022-07-29 | 哈尔滨工业大学 | 一种仿射形式的制导控制一体化控制方法 |
CN114815888B (zh) * | 2022-04-28 | 2023-05-19 | 哈尔滨工业大学 | 一种仿射形式的制导控制一体化控制方法 |
CN115421501A (zh) * | 2022-09-14 | 2022-12-02 | 中国科学院声学研究所 | 一种水下航行器有限时间信号估计方法及系统 |
CN115406312A (zh) * | 2022-09-23 | 2022-11-29 | 北京航空航天大学 | 考虑视场角和舵机延时约束的导弹制导控制一体化方法 |
CN115406312B (zh) * | 2022-09-23 | 2023-06-23 | 北京航空航天大学 | 考虑视场角和舵机延时约束的导弹制导控制一体化方法 |
CN116700306A (zh) * | 2023-06-02 | 2023-09-05 | 北京理工大学 | 一种用于捷联导引飞行器的一体化制导控制方法 |
CN116700306B (zh) * | 2023-06-02 | 2024-02-27 | 北京理工大学 | 一种用于捷联导引飞行器的一体化制导控制方法 |
CN116839429A (zh) * | 2023-09-01 | 2023-10-03 | 北京航空航天大学 | 一种考虑导引头视场角度约束的制导控制一体化方法 |
CN116839429B (zh) * | 2023-09-01 | 2023-11-10 | 北京航空航天大学 | 一种考虑导引头视场角度约束的制导控制一体化方法 |
CN116974208A (zh) * | 2023-09-22 | 2023-10-31 | 西北工业大学 | 基于捷联导引头的旋翼无人机目标打击控制方法及系统 |
CN116974208B (zh) * | 2023-09-22 | 2024-01-19 | 西北工业大学 | 基于捷联导引头的旋翼无人机目标打击控制方法及系统 |
CN118009819A (zh) * | 2024-04-10 | 2024-05-10 | 西安现代控制技术研究所 | 一种弱资源情况下的转弯控制策略设计方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110008502B (zh) | 2022-07-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110008502B (zh) | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 | |
CN106681348B (zh) | 考虑全捷联导引头视场约束的制导控制一体化设计方法 | |
Wise et al. | Agile missile dynamics and control | |
CN114509946B (zh) | 一种基于预设时间滑模的飞行器制导控制一体化设计方法 | |
CN105182985A (zh) | 高超声速飞行器俯冲段全量一体化制导控制方法 | |
CN109343563B (zh) | 考虑舵机失效及落角约束的飞行器制导系统及方法 | |
CN115406312B (zh) | 考虑视场角和舵机延时约束的导弹制导控制一体化方法 | |
CN114138000B (zh) | 考虑全捷联导引头视场约束的弹群协同制导控制一体化设计方法 | |
Kovach et al. | A bank-to-turn autopilot design for an advanced air-to-air interceptor | |
CN109703769B (zh) | 一种基于预瞄策略的空中加油对接控制方法 | |
CN114020019B (zh) | 飞行器的制导方法与装置 | |
CN107977009A (zh) | 一种考虑耦合的吸气式飞行器姿态控制律设计方法 | |
CN112648886B (zh) | 一种组合制导目标拦截方法及系统 | |
CN114815888B (zh) | 一种仿射形式的制导控制一体化控制方法 | |
CN114756959A (zh) | 一种飞行器近距空战机动智能决策机模型设计方法 | |
CN115033024A (zh) | 基于攻击时间和角度共同约束的多导弹三维协同制导方法 | |
CN117171877A (zh) | 基于时机博弈的高超声速飞行器机动突防策略设计方法 | |
CN116974208B (zh) | 基于捷联导引头的旋翼无人机目标打击控制方法及系统 | |
CN112050693B (zh) | 考虑攻击角和视场约束的半捷联制导控制一体化设计方法 | |
CN107703967B (zh) | 一种控制受限飞艇航迹控制方法 | |
Huo et al. | Integrated guidance and control based on high-order sliding mode method | |
Baba et al. | Air combat guidance law for an UCAV | |
Sconyers et al. | Rotorcraft control and trajectory generation for target tracking | |
CN117891271B (zh) | 考虑时间和角度约束的高速飞行器三维协同制导方法 | |
CN115268487B (zh) | 一种基于扰动估计补偿los制导律的飞行器高度控制方法和系统 |
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 |