CN109541941A - 一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错方法 - Google Patents

一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错方法 Download PDF

Info

Publication number
CN109541941A
CN109541941A CN201811377089.8A CN201811377089A CN109541941A CN 109541941 A CN109541941 A CN 109541941A CN 201811377089 A CN201811377089 A CN 201811377089A CN 109541941 A CN109541941 A CN 109541941A
Authority
CN
China
Prior art keywords
control
adaptive
fault
follows
actuator
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
CN201811377089.8A
Other languages
English (en)
Other versions
CN109541941B (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.)
Harbin Institute of Technology
Original Assignee
Harbin Institute of Technology
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 Harbin Institute of Technology filed Critical Harbin Institute of Technology
Priority to CN201811377089.8A priority Critical patent/CN109541941B/zh
Publication of CN109541941A publication Critical patent/CN109541941A/zh
Application granted granted Critical
Publication of CN109541941B publication Critical patent/CN109541941B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • B64G1/245Attitude control algorithms for spacecraft attitude control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • B64G1/247Advanced control concepts for autonomous, robotic spacecraft, e.g. by using artificial intelligence, neural networks or autonomous agents

Landscapes

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

Abstract

本发明提出了一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错方法,属于飞行器控制技术领域。所述方法包括:步骤一:基本PID控制器设计;步骤二:自适应增益调节律设计;步骤三:干扰补偿算法;步骤四:最优控制分配算法;步骤五:快速故障检测与自适应容错控制算法。所述方法能够满足实际飞行控制要求,控制参数设计简单,具有详细的控制性能指标进行表征,同时也具有鲁棒性更强、自适应性更好和控制结构更简单等优点。

Description

一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错 方法
技术领域
本发明涉及一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错方法,属于飞行器控制技术领域。
背景技术
垂直起降重复使用运载火箭在主动段飞行过程中存在的不确定因素较多,例如火箭的飞行高度、飞行速度、大气条件的变化以及火箭内部结构干扰等因素,导致箭体姿态动力学模型参数存在很大程度的时变性和不确定性;而且柔性火箭的姿态控制系统设计必须考虑箭体弹性振动的影响,而弹性振动频率同样存在不确定性;火箭的执行机构同时也易于发生故障或失效等情况,因此也可归结为模型不确定因素。上述这些不确定因素将使得姿态控制系统的稳定裕度降低甚至失稳。基于传统的增益定序设计的PID控制器由于是在地面离线设计的控制参数,对于在高空中实时飞行过程中的模型突变/不确定性难以有效应对且设计参数较为保守。因此有必要研究自适应控制技术,并结合传统的PID控制器设计思路,通过增加一系列自适应环节以及补偿校正环节以达到自适应姿态容错控制要求,这对于垂直起降重复使用运载器主动段稳定控制技术具有重要的研究意义。
通过对已有技术文献进行检索分析,目前针对运载器的容错控制系统设计主要分为自适应控制技术和自校正控制技术两类。国内针对运载火箭自适应控制研究主要有:大连理工大学的范军朋针对刚性火箭模型的不确定性,基于Lyapunov稳定性理论和Popov超稳定性理论设计了运载火箭姿态的模型参考自适应控制器,给出了相应的自适应控制律,针对箭体弹性振动频率的不确定性,基于递推最小二乘法实时更新陷波器中心频率,设计了自适应陷波器。赵党军针对弹性运载火箭存在的振动、参数摄动及外部扰动等影响,提出了自适应陷波器对测量信号预处理,并利用积分观测器获得系统状态和扰动的估计,根据极点配置方法设计了自适应姿态控制律。赵小平针对新一代重型运载火箭飞行参数变化范围较大和弹性振动剧烈等情况,设计了基于自适应H控制器,主要采用了混合灵敏度法设计鲁棒H控制器,研究了参数投影技术解决自适应问题。刘玉玺针对全射向发射状态下的运载火箭系统通道间存在交连耦合问题,设计了基于解耦的变结构自适应滑模控制器,并利用Lyapunov稳定性理论证明了控制系统的全局渐进稳定性。国外对此研究主要有:BrianD针对战神-I火箭弹性条件下设计了基于四元数误差PI校正+神经网络训练D反馈的自适应控制器,取得了较好的设计效果。Evgeny Kharisov针对美国通用运载火箭CLV在高不确定性参数等条件下设计了自适应输出反馈控制律,可以明显的抑制低频干扰情况并进行了实际飞行测试验证。Lei针对弹性体运载火箭的多变量不确定性干扰(如结构动态和随机风扰动)应用了非线性扰动观测器来进行估计扰动,为了提高准确度和灵敏性,采用模糊理论来改善非线性扰动观测器的性能。总的扰动消除后通过动态反演方法获得一个级联系统,然后设计稳定的自适应滑模控制器以提高性能。Eric N.Johnson针对重复使用运载火箭控制系统设计了基于神经网络训练的自适应控制器,通过两回路的设计思路,内回路用于自适应控制器设计,而外回路提供闭环的跟踪标准轨迹跟踪制导指令,内回路用于估计干扰力矩,而外回路用于估计干扰力,通过两回路实现自适应制导控制需求。针对神经网络自适应控制器设计的还有Yong,Li,Bin等人,而Wang等人设计了自适应神经网络反步控制器。然而上述方法的一般是采用非线性的控制方法,难以以频域指标(如幅值裕度和相位裕度等)表征控制性能,难以应用于重复使用运载器主动段的实际飞行过程中,因此急需研究新的控制方法。
发明内容
本发明目的是为了解决垂直起降重复使用运载器在主动段飞行时,存在发动机伺服机构故障条件下及其他内外干扰条件下的高精度姿态稳定控制问题,提供了自适应增广抗扰容错控制方法。
一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错方法,其特征在于,所述方法包括:
步骤一、根据垂直起降重复使用运载器主动段的小扰动线性化动力学模型,采用拉普拉斯变换后获得控制系统传递函数模型,然后采用增益定序方法确定火箭俯仰通道、偏航通道和滚转通道的PID控制参数,获得PID控制器;
步骤二、针对垂直起降重复使用运载器主动段飞行过程中的姿态误差以及测量获得的弹性振动信号,确定自适应增益调节控制律,从而自适应调整基本控制器的静态放大系数(即PID控制器中的P控制参数);
步骤三、根据火箭刚体条件下的小扰动线性化方程,建立状态空间模型,通过所述状态空间模型将未建模动态和不确定性统一表述为未知量,然后,采用扩张状态观测器对所述未知量进行估计,进而在PID控制律的基础上建立干扰补偿控制算法;
步骤四、利用所述PID控制器、自适应增益调节控制律和干扰补偿控制算法获得控制指令,然后采用最优控制分配算法对所述控制指令进行最优控制分配处理,获得实际的执行机构控制指令,如发动机摆角、RCS喷气指令或栅格舵偏转指令;
步骤五:根据垂直起降重复使用运载器中的执行机构,利用快速故障检测和自适应容错控制算法将所述执行机构等效为一阶动力学模型,采用故障因子这一描述故障的参数描述执行器故障动力学模型,然后建立故障估计器对所述执行器故障动力学模型进行估计来观测故障类型以及故障程度,最后利用伪逆法进行执行器的控制重构,进而完成执行器故障条件下的自适应容错重构控制。
进一步地,步骤一所述获得PID控制律的具体过程包括:
第一步:根据垂直起降重复使用运载器主动段飞行过程,确定所述垂直起降重复使用运载器主动段的小扰动线性化方程,所述小扰动线性化方程如下:
其中,α为攻角,θ为弹道倾角,为发动机摆角,弹道倾角导数,为俯仰角,分别为俯仰角的一阶导数和二阶导数;皆为火箭相关的动力系数值;
第二步:对第一步所述小扰动线性化方程进行拉普拉斯变换后获得传递函数模型;
第三步:将所述传递函数模型搭建所述垂直起降重复使用运载器的控制系统,获得所述PID控制律,所述PID控制律如下:
其中,kp为静态放大系数,ki为积分系数,kd为动态放大系数,为期望俯仰角,ωz为俯仰角速率。
进一步地,所述PID控制律获取过程利用校正网络对所述PID控制律中的控制信号进行滤波,所述校正网络如下:
其中,s为拉普拉斯算子,ω1,ω2,ω3,ω4,ωs1,ω1f,ω2f皆为校正网络的频率值,ζ1,ζ2,ζ3,ζ4和ζs1均为校正网络的阻尼系数值。
进一步地,步骤二所述建立自适应增益调节控制律的具体过程包括:
步骤1:将火箭飞行过程中测量的姿态角、角速率和实际期望的姿态角及角速率进行作差比较,获得误差综合信号;所述误差信号如下:
其中,d为常系数值,er为姿态跟踪误差综合信号,γr为姿态跟踪误差,为姿态跟踪误差导数值;
步骤2:将实际测量信号输入到PID控制律中获得控制指令,利用高通滤波器将控制指令中的振动信号从控制指令中剥离出来;
步骤3:将所述振动信号进行平方处理或者取绝对值处理;然后利用低通滤波器使经过平方处理或者取绝对值处理后的振动信号变平缓,不再剧烈抖动;其中,高通滤波器和低通滤波器的形式分别为:
其中,ωH为高通滤波器中心频率,ωL为低通滤波器中心频率,ξ为低通滤波器阻尼比;经过高通滤波器和低通滤波器处理后的振动信号ys的形式为:
步骤4:根据姿态跟踪误差综合信号er和振动信号ys获得自适应增益调节律,所述自适应增益调节律为:
其中,a、α1、β1分别为常数,用以调节kT值,phi(kT)为增益上限值,plo(kT)为降低增益系数的限制,kT max为最大kT限制,kT min为最小kT限制,ε为一较小的常数;
步骤5:根据三通道基本PID控制律并结合所述自适应增益调节律对垂直起降重复使用运载器主动段飞行过程中的摆角指令进行最优控制分配,分别得到主发动机摆角和栅格舵摆角指令。
进一步地,步骤三所述建立干扰补偿控制算法的具体过程包括:
第1步:根据垂直起降重复使用运载器主动段的小扰动线性化方程获得状态空间方程,所述状态空间方程的形式如下:
其中,F为干扰量;进而可得矩阵表达形式为:
其中, 为X的导数;所述矩阵表达形式即为姿态控制模型;
第2步:利用姿态控制模型确定扩张状态观测器,所述扩张状态观测器为:
其中,Z1和Z2为扩张状态观测器观测值,其中Z1用于实时跟踪X,Z2跟踪干扰项F;β01和β02为观测器增益系数,a2为幂次系数,δ为积分步长,e为观测误差向量;fal(e,a2,δ)函数定义有:
第3步:根据扩张状态观测器,所述扩张状态观测器观测值Z2将干扰量F估计出来,所述估计补偿算法为:
其中,为摆角指令。
进一步地,步骤五所述自适应容错重构控制的具体过程包括:
Step1:根据垂直起降运载器的执行器的火故障模式按其故障特点分为四种故障模式;执行器包括发动机和栅格舵;所述四种故障模式分别为:卡死故障、松浮、饱和和部分失效;所述四种故障模式对应的故障数学模型分别为:
其中,记为第i个执行器的发生故障的时间,ki记为损伤因子,且ki∈[∈ki,1],∈ki>0为最小的损伤因子;
Step2:将公式(15)简化为:
其中,Δ=diag[δ/(φ1+δ) δ/(φ2+δ) ... δ/(φm+δ)],Φ=diag[φ1 φ2 ...φm]为故障因子矩阵,并且δ是一个大于零且远远小于1的数;Λ=diag[λa1 λa2 ... λam]表示执行器增益矩阵,u、uc分别表示执行器输出控制信号和执行器输入信号。
Step3:对每一个执行器建立一个观测器,用于观测执行器的输出值;将公式(16)进行展开获得如下展开式:
其中,γi>0为自适应律系数,λai为i个执行器的增益系数,第τi为观测器的增益系数,ξi为保证系统稳定所引入的一个量;
Step4:令将上两式子相减可得:
通过上述设计的自适应控制律使得即可完成故障观测。
Step5:根据火箭三通道独立的等效发动机摆角到实际发动机摆角的转换关系式,利用自适应观测器将执行器的故障信息矩阵送入所述转换关系式中,获得对应公式为:
Ω=AΦU (19)
其中,Ω=[δ1 δ2 δ3 δ4]T,δi(i=1,2,3,4)为实际发动机摆角值,而为俯仰通道等效摆角、偏航通道等效摆角和滚转通道等效摆角值;
Step6:根据公式(19)结合伪逆法获取实际发动机摆角在发生故障后分配的控制量Ωc为:
Ωc=A·(pinv(AΦ)·Ω)=A(AΦ)-1Ω (20)
进而完成执行器故障条件下的自适应容错重构控制。
本发明有益效果:
本发明提出了一种针对垂直起降重复使用运载器主动段的自适应增广抗扰容错控制方法。该发明首先针对垂直起降重复使用运载器主动段动力学模型利用小扰动线性化原理采用增益定序方法设计PID控制参数。随后,针对火箭控制系统中静态增益的动态调节性能要求,设计了自适应增益调节控制律,可以根据火箭飞行过程中的姿态跟踪误差和弹性振动信号进行处理从而自适应调节静态增益系数,进而可以保证姿态控制精度的同时满足火箭弹性稳定要求。然后,利用自抗扰控制器中的扩张状态观测器进行估计补偿系统中的不确定性。利用快速故障检测与自适应容错控制算法将执行器等效为一阶动力学模型,利用故障因子来描述故障状态下的执行器动力学模型,然后设计故障观测器观测故障类型及故障程度,最后采用伪逆法进行控制重构;本发明所设计的控制方法主要在传统的PID控制系统基础上进行增广相应的子模块,从而可以保证控制系统能够在线应对飞行过程中的内外干扰、弹性振动频率不确定性、发动机/其他执行机构的故障等条件下的姿态稳定控制要求,因而能够满足实际飞行控制要求,控制参数设计简单,具有详细的控制性能指标进行表征,同时也具有鲁棒性更强、自适应性更好和控制结构更简单等优点。因而在垂直起降重复使用运载器垂直主动段姿态控制器设计中具有广阔的应用前景。
附图说明
图1是本发明所述一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错方法流程图;
图2是本发明所述自适应增广抗扰容错控制方法的系统组成结构图。
具体实施方式
下面结合具体实施例对本发明做进一步说明,但本发明不受实施例的限制。
实施例1:
一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错方法,其特征在于,所述方法包括:
步骤一、根据垂直起降重复使用运载器主动段的小扰动线性化动力学模型,采用拉普拉斯变换后获得控制系统传递函数模型,然后采用增益定序方法确定火箭俯仰通道、偏航通道和滚转通道的PID控制参数,获得PID控制器;
步骤二、针对垂直起降重复使用运载器主动段飞行过程中的姿态误差以及测量获得的弹性振动信号,确定自适应增益调节控制律,从而自适应调整基本控制器的静态放大系数(即PID控制器中的P控制参数);
步骤三、根据火箭刚体条件下的小扰动线性化方程,建立状态空间模型,通过所述状态空间模型将未建模动态和不确定性统一表述为未知量,然后,采用扩张状态观测器对所述未知量进行估计,进而在PID控制律的基础上建立干扰补偿控制算法;
步骤四、利用所述PID控制器、自适应增益调节控制律和干扰补偿控制算法获得控制指令,然后采用最优控制分配算法对所述控制指令进行最优控制分配处理,获得实际的执行机构控制指令,如发动机摆角、RCS喷气指令或栅格舵偏转指令;
步骤五:根据垂直起降重复使用运载器中的执行机构,利用快速故障检测和自适应容错控制算法将所述执行机构等效为一阶动力学模型,采用故障因子这一描述故障的参数描述执行器故障动力学模型,然后建立故障估计器对所述执行器故障动力学模型进行估计来观测故障类型以及故障程度,最后利用伪逆法进行执行器的控制重构,进而完成执行器故障条件下的自适应容错重构控制。
其中,步骤一所述获得PID控制律的具体过程包括:
第一步:根据垂直起降重复使用运载器主动段飞行过程,确定所述垂直起降重复使用运载器主动段的小扰动线性化方程,所述小扰动线性化方程如下:
其中,α为攻角,θ为弹道倾角,为发动机摆角,为弹道倾角导数,为俯仰角,分别为俯仰角的一阶导数和二阶导数;皆为火箭相关的动力系数值;
第二步:对第一步所述小扰动线性化方程进行拉普拉斯变换后获得传递函数模型;
第三步:将所述传递函数模型搭建所述垂直起降重复使用运载器的控制系统,所述PID控制律如下:
其中,kp为静态放大系数,ki为积分系数,kd为动态放大系数,为期望俯仰角,ωz为俯仰角速率。
所述PID控制律获取过程利用校正网络对所述PID控制律中的控制信号进行滤波,所述校正网络如下:
其中,s为拉普拉斯算子,ω1,ω2,ω3,ω4,ωs1,ω1f,ω2f皆为校正网络的频率值,ζ1,ζ2,ζ3,ζ4和ζs1均为校正网络的阻尼系数值。
步骤二所述建立自适应增益调节控制律的具体过程包括:
步骤1:将火箭飞行过程中测量的姿态角、角速率和实际期望的姿态角及角速率进行作差比较,获得误差综合信号;所述误差信号如下:
其中,d为常系数值,er为姿态跟踪误差综合信号,γr为姿态跟踪误差,为姿态跟踪误差导数值;
步骤2:由于火箭弹性振动的影响,在实际飞行中位置陀螺仪和速率陀螺仪测量信号中将包括火箭各阶振动信号,将其输入到PID控制律后,计算得到的控制指令也将包含振动信号,此时通过一个高通滤波器将振动信号从控制指令中剥离开来,只需要振动信号,然而此时的信号振荡较为剧烈,不易于处理,因此,将实际测量信号输入到PID控制律中获得控制指令,利用高通滤波器将控制指令中的振动信号从控制指令中剥离出来;
步骤3:将所述振动信号进行平方处理或者取绝对值处理;然后利用低通滤波器使经过平方处理或者取绝对值处理后的振动信号变平缓,不再剧烈抖动;其中,高通滤波器和低通滤波器的形式分别为:
其中,ωH为高通滤波器中心频率,ωL为低通滤波器中心频率,ξ为低通滤波器阻尼比;经过高通滤波器和低通滤波器处理后的振动信号ys的形式为:
步骤4:根据姿态跟踪误差综合信号er和振动信号ys获得自适应增益调节律,所述自适应增益调节律为:
其中,a、α1、β1分别为常数,用以调节kT值,phi(kT)为增益上限值,plo(kT)为降低增益系数的限制,kT max为最大kT限制,kT min为最小kT限制,ε为一较小的常数;
步骤5:根据三通道基本PID控制律并结合所述自适应增益调节律对垂直起降重复使用运载器主动段飞行过程中的摆角指令进行最优控制分配,分别得到主发动机摆角和栅格舵摆角指令。
所述方法减轻了算法的复杂度,减少了自适应增益响应的非线性,简化了动力学分析,并能更快的响应偏差,phi和plo为非线性饱和函数,允许系统具有更大的可调性。在基本控制器设计中,根据三轴单方向的角加速度信号来进行控制分配,其实质是一种最优控制分配算法,以俯仰方向为例有:
步骤三所述建立干扰补偿控制算法的具体过程包括:
第1步:根据垂直起降重复使用运载器主动段的小扰动线性化方程获得状态空间方程,所述状态空间方程的形式如下:
其中,F为干扰量;进而可得矩阵表达形式为:
其中, 为X的导数;所述矩阵表达形式即为姿态控制模型;
第2步:考虑到自抗扰控制器设计中的扩张状态观测器对于干扰估计补偿具有较好的效果,因此可基于此设计扩张状态观测器用于对干扰进行估计。具体利用姿态控制模型确定扩张状态观测器,所述扩张状态观测器为:
其中,Z1和Z2为扩张状态观测器观测值,其中Z1用于实时跟踪X,Z2跟踪干扰项F;β01和β02为观测器增益系数,a2为幂次系数,δ为积分步长,e为观测误差向量;fal(e,a2,δ)函数定义有:
第3步:根据扩张状态观测器,所述扩张状态观测器观测值Z2将干扰量F估计出来,所述估计补偿算法为:
其中,为摆角指令。
步骤四中最优控制分配算法的设计思路如下:
基于最优化的控制分配算法往往是要求算法保证获得的控制输入,能够取得一定最优指标;具体可以描述为:给定最优控制指标,对于某个虚拟控制指令v,求出控制输入u;若该控制输入存在多个合适的解,则从这个解中选取最优的解,否则就选择使得Bu最接近v的控制输入。该方法的主要思想是用控制输入的范数对控制分配的解进行度量,将两种分配问题转化为数学规划问题。伪逆法就是最优化算法中的一种,它是将控制分配问题转化为最小范数问题:
上式的解为:u=B+v;其中,B+是B的伪逆。上述最优控制分配算法用于将式(13)中获得的摆角指令分配到主发动机摆角和栅格舵摆角指令上。
步骤五所述自适应容错重构控制的具体过程包括:
Step1:根据垂直起降运载器的执行器的火故障模式按其故障特点分为四种故障模式;执行器包括发动机和栅格舵;所述四种故障模式分别为:卡死故障、松浮、饱和和部分失效;所述四种故障模式对应的故障数学模型分别为:
其中,记为第i个执行器的发生故障的时间,ki记为损伤因子,且ki∈[∈ki,1],∈ki>0为最小的损伤因子;
Step2:将公式(15)简化为:
其中,Δ=diag[δ/(φ1+δ) δ/(φ2+δ) ... δ/(φm+δ)],Φ=diag[φ1 φ2 ...φm]为故障因子矩阵,并且δ是一个大于零且远远小于1的数;Λ=diag[λa1 λa2 ... λam]表示执行器增益矩阵;u、uc分别表示执行器输出控制信号和执行器输入信号;
Step3:对每一个执行器建立一个观测器,用于观测执行器;将公式(16)进行展开获得如下展开式:
其中,γi>0为自适应律系数,λai为i个执行器的增益系数,第τi为观测器的增益系数,ξi为保证系统稳定所引入的一个量;
Step4:令将上两式子相减可得:
通过上述设计的自适应控制律使得即可完成故障观测。
Step5:根据火箭三通道独立的等效发动机摆角到实际发动机摆角的转换关系式,利用自适应观测器将执行器的故障信息矩阵送入所述转换关系式中,获得对应公式为:
Ω=AΦU (19)
其中,Ω=[δ1 δ2 δ3 δ4]T,δi(i=1,2,3,4)为实际发动机摆角值,而为俯仰通道等效摆角、偏航通道等效摆角和滚转通道等效摆角值;
Step6:根据公式(19)结合伪逆法获取实际发动机摆角在发生故障后分配的控制量为:
Ωc=A·(pinv(AΦ)·Ω)=A(AΦ)-1Ω (20)
进而完成执行器故障条件下的自适应容错重构控制。
本发明针对现有的运载火箭主动段增益定序PID控制器难以适应实际飞行过程中的强干扰和振动频率不确定性的缺点而提出的,同时也为了满足垂直起降重复使用运载器的快速发射需求,降低火箭控制参数和校正网络设计工作量。本发明在传统PID控制系统基础上增广了自适应增益调节律、干扰补偿算法、最优控制分配算法和快速故障检测与自适应容错控制算法,通过这种设计模式不仅有效提高了系统对复杂外部干扰抑制能力和多种发动机故障模式下的自适应容错能力,同时也能保证火箭姿态的稳定控制与火箭自身的弹性振动和液体晃动稳定要求。
虽然本发明已以较佳的实施例公开如上,但其并非用以限定本发明,任何熟悉此技术的人,在不脱离本发明的精神和范围内,都可以做各种改动和修饰,因此本发明的保护范围应该以权利要求书所界定的为准。

Claims (6)

1.一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错方法,其特征在于,所述方法包括:
步骤一、根据垂直起降重复使用运载器主动段的小扰动线性化动力学模型,采用拉普拉斯变换后获得控制系统传递函数模型,然后采用增益定序方法确定火箭俯仰通道、偏航通道和滚转通道的PID控制参数,获得PID控制律,完成PID控制器设计;
步骤二、针对垂直起降重复使用运载器主动段飞行过程中的姿态误差以及测量获得的弹性振动信号,建立自适应增益调节控制律;
步骤三、根据火箭刚体条件下的小扰动线性化方程,建立状态空间模型,通过所述状态空间模型将未建模动态和不确定性统一表述为未知量,然后,采用扩张状态观测器对所述未知量进行估计,进而在PID控制律的基础上建立干扰补偿控制算法;
步骤四、利用所述PID控制律、自适应增益调节控制律和干扰补偿控制算法获得控制指令,然后采用最优控制分配算法对所述控制指令进行最优控制分配处理,获得实际的执行器控制指令;
步骤五:根据垂直起降重复使用运载器中的执行器,利用快速故障检测和自适应容错控制算法将所述执行器等效为一阶动力学模型,采用故障因子描述执行器故障动力学模型,然后建立故障估计器对所述执行器故障动力学模型进行估计,最后利用伪逆法进行执行器的控制重构,进而完成执行器故障条件下的自适应容错重构控制。
2.根据权利要求1所述自适应增广抗扰容错方法,其特征在于,步骤一所述获得PID控制律的具体过程包括:
第一步:根据垂直起降重复使用运载器主动段飞行过程,确定所述垂直起降重复使用运载器主动段的小扰动线性化方程,所述小扰动线性化方程如下:
其中,α为攻角,θ为弹道倾角,为发动机摆角,为弹道倾角导数,为俯仰角,分别为俯仰角的一阶导数和二阶导数;皆为火箭相关的动力系数值;
第二步:对第一步所述小扰动线性化方程进行拉普拉斯变换后获得传递函数模型;
第三步:将所述传递函数模型搭建所述垂直起降重复使用运载器的控制系统,获得所述PID控制律,所述PID控制律如下:
其中,kp为静态放大系数,ki为积分系数,kd为动态放大系数,为期望俯仰角,ωz为俯仰角速率。
3.根据权利要求1或2所述自适应增广抗扰容错方法,其特征在于,所述PID控制律获取过程利用校正网络对所述PID控制律中的控制信号进行滤波,所述校正网络如下:
其中,s为拉普拉斯算子,ω1,ω2,ω3,ω4,ωs1,ω1f,ω2f皆为校正网络的频率值,ζ1,ζ2,ζ3,ζ4和ζs1均为校正网络的阻尼系数值。
4.根据权利要求1所述自适应增广抗扰容错方法,其特征在于,步骤二所述建立自适应增益调节控制律的具体过程包括:
步骤1:将火箭飞行过程中测量的姿态角、角速率和实际期望的姿态角及角速率进行作差比较,获得误差综合信号;所述误差信号如下:
其中,d为常系数值,er为姿态跟踪误差综合信号,γr为姿态跟踪误差,为姿态跟踪误差导数值;
步骤2:将实际测量信号输入到PID控制律中获得控制指令,利用高通滤波器将控制指令中的振动信号从控制指令中剥离出来;
步骤3:将所述振动信号进行平方处理或者取绝对值处理;然后利用低通滤波器使经过平方处理或者取绝对值处理后的振动信号变平缓,不再剧烈抖动;其中,高通滤波器和低通滤波器的形式分别为:
其中,ωH为高通滤波器中心频率,ωL为低通滤波器中心频率,ξ为低通滤波器阻尼比;
经过高通滤波器和低通滤波器处理后的振动信号ys的形式为:
步骤4:根据姿态跟踪误差综合信号er和振动信号ys获得自适应增益调节律,所述自适应增益调节律为:
其中,a、α1、β1分别为常数,用以调节kT值,phi(kT)为增益上限值,plo(kT)为降低增益系数的限制,kTmax为最大kT限制,kTmin为最小kT限制,ε为一较小的常数;
步骤5:根据三通道基本PID控制律并结合所述自适应增益调节律对垂直起降重复使用运载器主动段飞行过程中的摆角指令进行最优控制分配,分别得到主发动机摆角和栅格舵摆角指令。
5.根据权利要求1所述自适应增广抗扰容错方法,其特征在于,步骤三所述建立干扰补偿控制算法的具体过程包括:
第1步:根据垂直起降重复使用运载器主动段的小扰动线性化方程获得状态空间方程,所述状态空间方程的形式如下:
其中,F为干扰量;进而可得矩阵表达形式为:
其中, 为X的导数;所述矩阵表达形式即为姿态控制模型;
第2步:利用姿态控制模型确定扩张状态观测器,所述扩张状态观测器为:
其中,Z1和Z2为扩张状态观测器观测值,其中Z1用于实时跟踪X,Z2跟踪干扰项F;β01和β02为观测器增益系数,a2为幂次系数,δ为积分步长,e为观测误差向量;fal(e,a2,δ)函数定义有:
第3步:根据扩张状态观测器,所述扩张状态观测器观测值Z2将干扰量F估计出来,所述估计补偿算法为:
其中,为摆角指令。
6.根据权利要求1所述自适应增广抗扰容错方法,其特征在于,步骤五所述自适应容错重构控制的具体过程包括:
Step1:根据垂直起降运载器的执行器的火故障模式按其故障特点分为四种故障模式;所述四种故障模式分别为:卡死故障、松浮、饱和和部分失效;所述四种故障模式对应的故障数学模型分别为:
其中,记为第i个执行器的发生故障的时间,ki记为损伤因子,且ki∈[∈ki,1],∈ki>0为最小的损伤因子;
Step2:将公式(15)简化为:
其中,Δ=diag[δ/(φ1+δ) δ/(φ2+δ)...δ/(φm+δ)],Φ=diag[φ1 φ2...φm]为故障因子矩阵,并且δ是一个大于零且远远小于1的数;Λ=diag[λa1 λa2...λam]表示执行器增益矩阵;u、uc分别表示执行器输出控制信号和执行器输入信号;
Step3:对每一个执行器建立一个观测器,用于观测执行器的输出值;将公式(16)进行展开获得如下展开式:
其中,γi>0为自适应律系数,λai为i个执行器的增益系数,第τi为观测器的增益系数,ξi为保证系统稳定所引入的一个量,
Step4:令将上两式子相减可得:
通过上述设计的自适应控制律使得即可完成故障观测;
Step5:根据火箭三通道独立的等效发动机摆角到实际发动机摆角的转换关系式,利用自适应观测器将执行器的故障信息矩阵送入所述转换关系式中,获得对应公式为:
Ω=AΦU (19)
其中,Ω=[δ1 δ2 δ3 δ4]T,δi(i=1,2,3,4)为实际发动机摆角值,而为俯仰通道等效摆角、偏航通道等效摆角和滚转通道等效摆角值;
Step6:根据公式(19)结合伪逆法获取实际发动机摆角在发生故障后分配的控制量Ωc为:
Ωc=A·(pinv(AΦ)·Ω)=A(AΦ)-1Ω (20)
进而完成执行器故障条件下的自适应容错重构控制。
CN201811377089.8A 2018-11-19 2018-11-19 一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错方法 Active CN109541941B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811377089.8A CN109541941B (zh) 2018-11-19 2018-11-19 一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811377089.8A CN109541941B (zh) 2018-11-19 2018-11-19 一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错方法

Publications (2)

Publication Number Publication Date
CN109541941A true CN109541941A (zh) 2019-03-29
CN109541941B CN109541941B (zh) 2020-07-21

Family

ID=65848238

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811377089.8A Active CN109541941B (zh) 2018-11-19 2018-11-19 一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错方法

Country Status (1)

Country Link
CN (1) CN109541941B (zh)

Cited By (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108803649A (zh) * 2018-08-22 2018-11-13 哈尔滨工业大学 一种垂直起降重复使用运载器自抗扰滑模控制方法
CN110531622A (zh) * 2019-09-05 2019-12-03 沈阳航空航天大学 一种基于径向基神经网络的固体火箭发动机推力控制方法
CN110794863A (zh) * 2019-11-20 2020-02-14 中山大学 一种控制性能指标可定制的重型运载火箭姿态控制方法
CN111046499A (zh) * 2019-12-27 2020-04-21 北京中科宇航探索技术有限公司 一种确定速率陀螺安装位置的方法及系统
CN111399473A (zh) * 2019-12-31 2020-07-10 北京理工大学重庆创新中心 一种自适应容错控制方法、系统及空中机器人
CN111409869A (zh) * 2020-04-10 2020-07-14 湖南云顶智能科技有限公司 可重复使用运载火箭一子级回收容错控制方法
RU2727612C1 (ru) * 2019-11-01 2020-07-22 Федеральное государственное бюджетное образовательное учреждение высшего образования "Московский авиационный институт (национальный исследовательский университет)" Способ формирования астатических быстродействующих демпферов летательных аппаратов
CN112325710A (zh) * 2020-09-24 2021-02-05 北京航天自动控制研究所 一种运载火箭大推力直接入轨高精度姿态控制方法和系统
CN112486193A (zh) * 2020-11-19 2021-03-12 南京航空航天大学 一种基于自适应增广控制理论的飞翼无人机三轴全权限控制方法
CN112713834A (zh) * 2020-12-17 2021-04-27 华中科技大学 一种永磁同步电机无位置传感器控制方法及系统
CN113031448A (zh) * 2021-03-24 2021-06-25 西安电子科技大学 基于神经网络的飞行器上升段轨迹优化方法
CN113609581A (zh) * 2021-07-30 2021-11-05 航天科工火箭技术有限公司 运载火箭弹性频率在线辨识的方法及存储介质
CN113859586A (zh) * 2021-09-17 2021-12-31 北京空间机电研究所 一种空间遥感器伺服控制系统控制参数在轨自动调整方法
CN114260892A (zh) * 2021-12-17 2022-04-01 深圳市优必选科技股份有限公司 弹性关节力矩控制方法、装置、可读存储介质及机器人
CN114442647A (zh) * 2021-12-08 2022-05-06 航天科工火箭技术有限公司 基于模糊隶属度函数的火箭末级姿态分时控制方法及装置
CN114879718A (zh) * 2022-07-12 2022-08-09 南京理工大学 具有栅格舵的飞行器的控制方法

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20110126049A1 (en) * 2009-11-24 2011-05-26 Honeywell International Inc. Architecture and method for hardware-assisted processor checkpointing and rollback
CN102854874A (zh) * 2012-06-18 2013-01-02 南京航空航天大学 一种基于联合多观测器的故障诊断与容错控制装置及方法
CN103592946A (zh) * 2013-10-23 2014-02-19 北京航天自动控制研究所 一种基于视加速度测量的主动段程序自适应纵向制导方法
US20170242109A1 (en) * 2016-02-18 2017-08-24 Aeye, Inc. Ladar Receiver Range Measurement using Distinct Optical Path for Reference Light
CN108227483A (zh) * 2018-01-05 2018-06-29 哈尔滨工程大学 海洋运载器用pd型紧格式无模型自适应航速控制方法
CN108536020A (zh) * 2018-07-17 2018-09-14 哈尔滨工业大学 一种针对垂直起降重复使用运载器的模型参考自适应滑模控制方法
CN108646778A (zh) * 2018-07-18 2018-10-12 哈尔滨工业大学 一种垂直起降重复使用运载器的非线性自抗扰控制方法
CN108732601A (zh) * 2018-04-16 2018-11-02 哈尔滨工业大学 基于差分卫星导航的垂直返回运载器着陆段导航方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20110126049A1 (en) * 2009-11-24 2011-05-26 Honeywell International Inc. Architecture and method for hardware-assisted processor checkpointing and rollback
CN102854874A (zh) * 2012-06-18 2013-01-02 南京航空航天大学 一种基于联合多观测器的故障诊断与容错控制装置及方法
CN103592946A (zh) * 2013-10-23 2014-02-19 北京航天自动控制研究所 一种基于视加速度测量的主动段程序自适应纵向制导方法
US20170242109A1 (en) * 2016-02-18 2017-08-24 Aeye, Inc. Ladar Receiver Range Measurement using Distinct Optical Path for Reference Light
CN108227483A (zh) * 2018-01-05 2018-06-29 哈尔滨工程大学 海洋运载器用pd型紧格式无模型自适应航速控制方法
CN108732601A (zh) * 2018-04-16 2018-11-02 哈尔滨工业大学 基于差分卫星导航的垂直返回运载器着陆段导航方法
CN108536020A (zh) * 2018-07-17 2018-09-14 哈尔滨工业大学 一种针对垂直起降重复使用运载器的模型参考自适应滑模控制方法
CN108646778A (zh) * 2018-07-18 2018-10-12 哈尔滨工业大学 一种垂直起降重复使用运载器的非线性自抗扰控制方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
LIANG ZHANG,等: "Heavy lift launch vehicle technology of adaptive augmented fault tolerant control", 《2016 IEEE CHINESE GUIDANCE, NAVIGATION AND CONTROL CONFERENCE》 *
崔乃刚,等: "运载火箭自适应增广抗扰减载控制", 《导弹与航天运载技术》 *
程堂明,等: "运载火箭伺服机构故障检测与诊断的扩展多模型自适应方法", 《国防科技大学学报》 *

Cited By (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108803649B (zh) * 2018-08-22 2019-07-09 哈尔滨工业大学 一种垂直起降重复使用运载器自抗扰滑模控制方法
CN108803649A (zh) * 2018-08-22 2018-11-13 哈尔滨工业大学 一种垂直起降重复使用运载器自抗扰滑模控制方法
CN110531622A (zh) * 2019-09-05 2019-12-03 沈阳航空航天大学 一种基于径向基神经网络的固体火箭发动机推力控制方法
CN110531622B (zh) * 2019-09-05 2022-04-05 沈阳航空航天大学 一种基于径向基神经网络的固体火箭发动机推力控制方法
RU2727612C1 (ru) * 2019-11-01 2020-07-22 Федеральное государственное бюджетное образовательное учреждение высшего образования "Московский авиационный институт (национальный исследовательский университет)" Способ формирования астатических быстродействующих демпферов летательных аппаратов
CN110794863A (zh) * 2019-11-20 2020-02-14 中山大学 一种控制性能指标可定制的重型运载火箭姿态控制方法
CN111046499A (zh) * 2019-12-27 2020-04-21 北京中科宇航探索技术有限公司 一种确定速率陀螺安装位置的方法及系统
CN111046499B (zh) * 2019-12-27 2023-08-04 广州中科宇航探索技术有限公司 一种确定速率陀螺安装位置的方法及系统
CN111399473A (zh) * 2019-12-31 2020-07-10 北京理工大学重庆创新中心 一种自适应容错控制方法、系统及空中机器人
CN111399473B (zh) * 2019-12-31 2022-06-24 北京理工大学重庆创新中心 一种自适应容错控制方法、系统及空中机器人
CN111409869A (zh) * 2020-04-10 2020-07-14 湖南云顶智能科技有限公司 可重复使用运载火箭一子级回收容错控制方法
CN112325710A (zh) * 2020-09-24 2021-02-05 北京航天自动控制研究所 一种运载火箭大推力直接入轨高精度姿态控制方法和系统
CN112325710B (zh) * 2020-09-24 2023-03-31 北京航天自动控制研究所 一种运载火箭大推力直接入轨高精度姿态控制方法和系统
CN112486193A (zh) * 2020-11-19 2021-03-12 南京航空航天大学 一种基于自适应增广控制理论的飞翼无人机三轴全权限控制方法
CN112486193B (zh) * 2020-11-19 2022-04-22 南京航空航天大学 一种基于自适应增广控制理论的飞翼无人机三轴全权限控制方法
CN112713834A (zh) * 2020-12-17 2021-04-27 华中科技大学 一种永磁同步电机无位置传感器控制方法及系统
CN112713834B (zh) * 2020-12-17 2022-04-19 华中科技大学 一种永磁同步电机无位置传感器控制方法及系统
CN113031448A (zh) * 2021-03-24 2021-06-25 西安电子科技大学 基于神经网络的飞行器上升段轨迹优化方法
CN113609581A (zh) * 2021-07-30 2021-11-05 航天科工火箭技术有限公司 运载火箭弹性频率在线辨识的方法及存储介质
CN113609581B (zh) * 2021-07-30 2024-04-19 航天科工火箭技术有限公司 运载火箭弹性频率在线辨识的方法及存储介质
CN113859586B (zh) * 2021-09-17 2023-02-28 北京空间机电研究所 一种空间遥感器伺服控制系统控制参数在轨自动调整方法
CN113859586A (zh) * 2021-09-17 2021-12-31 北京空间机电研究所 一种空间遥感器伺服控制系统控制参数在轨自动调整方法
CN114442647A (zh) * 2021-12-08 2022-05-06 航天科工火箭技术有限公司 基于模糊隶属度函数的火箭末级姿态分时控制方法及装置
CN114442647B (zh) * 2021-12-08 2024-04-26 航天科工火箭技术有限公司 基于模糊隶属度函数的火箭末级姿态分时控制方法及装置
CN114260892A (zh) * 2021-12-17 2022-04-01 深圳市优必选科技股份有限公司 弹性关节力矩控制方法、装置、可读存储介质及机器人
CN114260892B (zh) * 2021-12-17 2023-12-15 深圳市优必选科技股份有限公司 弹性关节力矩控制方法、装置、可读存储介质及机器人
CN114879718A (zh) * 2022-07-12 2022-08-09 南京理工大学 具有栅格舵的飞行器的控制方法

Also Published As

Publication number Publication date
CN109541941B (zh) 2020-07-21

Similar Documents

Publication Publication Date Title
CN109541941A (zh) 一种针对垂直起降运载器主动段飞行的自适应增广抗扰容错方法
Hu et al. Adaptive backstepping control for air-breathing hypersonic vehicles with input nonlinearities
Shim et al. A comprehensive study of control design for an autonomous helicopter
CN110442020B (zh) 一种新型的基于鲸鱼优化算法的容错控制方法
Qu et al. Adaptive output-feedback control with closed-loop reference models for very flexible aircraft
Hu et al. Fuzzy reliable tracking control for flexible air-breathing hypersonic vehicles
CN105867119A (zh) 一种采用保护映射理论的空天飞行器大包线切换控制方法
Elumalai et al. A new algebraic LQR weight selection algorithm for tracking control of 2 DoF torsion system
CN111142550B (zh) 民用飞机辅助驾驶控制方法、系统及飞行品质评估方法
Van Oort et al. Full-envelope modular adaptive control of a fighter aircraft using orthogonal least squares
CN112114522A (zh) 一种基于切换自适应算法的四旋翼飞行器故障容错控制方法
Wang et al. Composite practically fixed time controller design for a hypersonic vehicle with multisource uncertainty and actuator fault
Torabi et al. Intelligent pitch controller identification and design
CN110333656A (zh) 一种基于互联系统方法的挠性航天器容错控制方法
Du et al. Fault tolerant control of a quadrotor unmanned aerial vehicle based on active disturbance rejection control and two-stage Kalman filter
Zheng et al. Adaptive NN zeta-backstepping control with its application to a quadrotor hover
Shtessel et al. Flexible modes control using sliding mode observers: Application to Ares I
Butler et al. Takagi-sugeno fuzzy model-based flight control and failure stabilization
Shuang et al. An anti-windup fault tolerant control scheme with guaranteed transient performance for tailless flying wing aircrafts
Nguyen et al. Hybrid intelligent flight control with adaptive learning parameter estimation
CN116360255A (zh) 一种非线性参数化高超声速飞行器的自适应调节控制方法
Barzanooni et al. Attitude flight control system design of UAV using LQG\LTR multivariable control with noise and disturbance
CN111306995B (zh) 一种面向弹体颤振抑制的组合控制器设计方法
Han et al. Reduced-Order Active Disturbance Rejection Control Scheme for a Quadrotor and Its Autotuning Method
Lu et al. Adaptive Sliding Mode Active Disturbance Rejection Control of Quadrotor UAV for Hydropower Station Geomorphology

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