CN115422496A - 推力故障下运载火箭质量和推力参数的联合校正辨识方法 - Google Patents
推力故障下运载火箭质量和推力参数的联合校正辨识方法 Download PDFInfo
- Publication number
- CN115422496A CN115422496A CN202210979915.6A CN202210979915A CN115422496A CN 115422496 A CN115422496 A CN 115422496A CN 202210979915 A CN202210979915 A CN 202210979915A CN 115422496 A CN115422496 A CN 115422496A
- Authority
- CN
- China
- Prior art keywords
- thrust
- rocket
- mass
- matrix
- moment
- 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.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
- G06F17/12—Simultaneous equations, e.g. systems of linear equations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01M—TESTING STATIC OR DYNAMIC BALANCE OF MACHINES OR STRUCTURES; TESTING OF STRUCTURES OR APPARATUS, NOT OTHERWISE PROVIDED FOR
- G01M15/00—Testing of engines
- G01M15/14—Testing gas-turbine engines or jet-propulsion engines
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/15—Correlation function computation including computation of convolution operations
-
- 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
Abstract
本发明公开了一种推力故障下运载火箭质量和推力参数的联合校正辨识方法,包括:建立用于辨识的运载火箭质心运动方程和质量消耗方程;根据运载火箭惯性敏感器件测量的视加速度信息作为辨识的观测量,建立观测方程;每个计算周期中利用当前时刻推力参数辨识结果通过卡尔曼滤波来辨识下一时刻的火箭质量,同时利用下一时刻的火箭质量辨识结果通过渐消因子递推最小二乘来估计下一时刻的推力参数。本发明基于渐消因子递推最小二乘与卡尔曼滤波结合的辨识方法对火箭飞行过程中的质量和推力参数联合辨识,可以有效地辨识推力故障下运载火箭的质量和推力参数。
Description
技术领域
本发明属于飞行器飞行过程中典型动力学系统推力故障在线辨识领域,具体涉及一种推力故障下运载火箭质量和推力参数的联合校正辨识方法。
背景技术
运载火箭是航天运输系统的主要组成部分,是目前人类进入空间的主要工具,是发展空间技术、确保空间安全的基石。运载火箭系统结构复杂,发射成本高,保证其安全可靠非常重要。动力系统是运载火箭的关键系统之一,在国内外失败的发射案例中,相当一部分是动力系统故障,非致命的动力系统故障表现一般为推力下降或关机。发动机推力下降或关机会使火箭推力不平衡产生干扰力矩,推进剂消耗缓慢使得箭体质量分布不均,降低了控制系统控制能力。事实上,这种非致命动力系统故障并非不可逆转,当火箭推力下降后,火箭有能力继续执行任务,因此及时的诊断出推力故障的大小以及火箭当前质量有助于后续的控制重构和飞行任务调整。
故障诊断的方法主要包括基于模型的、基于信号的和基于知识的方法。基于模型的故障诊断方法已经得到了广泛的研究,可细分为参数估计法、状态估计法、等效空间方法等。例如用卡尔曼滤波对状态进行估计,利用增广的卡尔曼滤波也可以对参数进行估计,但是这种增广的卡尔曼滤波前提假设待估参数矢量是不变的状态矢量,无法准确的估计出变化的参数,尤其是当待估参数发生突变的情况。在参数辨识领域中,最小二乘法是一种得到最广泛应用的估计方法,可用于动态、静态、线性、非线性系统。
针对运载火箭推力参数辨识的方向主要有两个方面:一种是利用遥测的发动机燃烧室压强和预先建立的内弹道程序估计性能参数,目的是掌握发动机的真实性能,服务于发动机和火箭的研发;另一种是利用视加速度、火箭速度、位置和质量信息进行辨识,从而为后续的控制重构和飞行任务调整提供信息。目前利用火箭视加速度等信息对火箭推力进行辨识的研究中,均假设火箭的质量已知,然而火箭飞行过程中实时的质量信息是无法测量的。尤其是当火箭推力发生故障的情况下,燃料的消耗速度跟预先设定速度会产生偏差,导致火箭质量存在相应偏差,影响控制系统的稳定。
发明内容
为解决现有技术中存在的问题,本发明提供一种适用于推力故障下运载火箭质量和推力参数的联合校正辨识方法——基于渐消因子递推最小二乘与卡尔曼滤波相结合的辨识方法,可以有效地辨识推力故障下运载火箭的质量和推力参数。
本发明为解决其技术问题所采用的技术方案是:一种推力故障下运载火箭质量和推力参数的联合校正辨识方法,包括:建立用于辨识的运载火箭质心运动方程和质量消耗方程;根据火箭惯性敏感器件测量的视加速度信息作为辨识的观测量,建立观测方程;每个计算周期中利用当前时刻推力参数辨识结果通过卡尔曼滤波来辨识下一时刻的火箭质量,同时利用下一时刻的火箭质量辨识结果通过渐消因子递推最小二乘来估计下一时刻的推力参数。
进一步的,具体包括如下步骤:
建立运载火箭质心运动方程和质量消耗方程:
其中:r表示火箭距地心的矢量,且r=[rx ry rz]T;v表示火箭的速度矢量,且v=[vx vy vz]T;μ表示引力常数;F表示火箭的总推力;u表示推力方向矢量输入,m表示火箭的质量;C表示过程噪声分布矩阵;w表示过程噪声;Isp表示火箭比冲;g0表示海平面处重力加速度;
建立视加速度的观测方程如下:
y=Fu/m+d
其中y表示观测的视加速度信息;d表示视加速度的测量噪声。记观测矩阵h(m,u)=u/m;
选取状态量x=[rx ry rz vx vy vz m]T,则火箭的质量m=x7,将上述火箭方程与观测方程转化为状态空间方程:
其中f(x,u,F)和g(x,u,F)表示相应函数;
设置过程噪声方差Qw,观测噪声方差Rd,渐消因子ρ;
预测k+1时刻的状态预估值:
其中Δt=tk+1-tk;
计算转移矩阵:
Φ(k+1|k)=eA(k+1)Δt
计算离散噪声分布矩阵:
Γ(k+1|k)=Φ(k+1|k)C(k+1)Δt
计算状态预估值对应的协方差矩阵:
计算卡尔曼滤波增益矩阵:
K(k+1)=P(k+1|k)HT(k+1)[H(k+1)P(k+1|k)HT(k+1)+Rd(k+1)]-1
计算k+1时刻的状态估计协方差矩阵:
P(k+1)=[I-K(k+1)H(k+1)]P(k+1|k)
其中I表示对应状态维度的单位阵;
计算k+1时刻的状态滤波值:
计算最小二乘增益矩阵:
其中IM表示对应观测维度的单位阵;
计算k+1时刻的最小二乘协方差矩阵
计算k+1时刻的推力参数估计值:
如果k<N,则k=k+1,返回预测k+1时刻的状态预估值;否则循环结束,输出运载火箭质量与推力参数辨识结果。
进一步的,对视加速度观测量进行线性插值,用以增加采样点的总数,减小辨识的步长。
本发明的有益效果包括:提出了一种最小二乘与卡尔曼滤波相结合的联合校正辨识方法,可以有效的辨识推力故障下运载火箭的质量和推力参数,同时也适用于正常飞行情况下飞行器的质量和推力参数的在线辨识;提出的对采样观测数据进行插值改进的方式可以有效提高辨识的跟踪性。选择合适的渐消因子以及插值步长,可以在参数精度误差的接受范围内,提高参数辨识方法的跟踪性。
本发明可以对火箭等飞行器推力突变故障进行辨识,具有结构简单、设计过程简洁、辨识精度高等特点,在运载火箭质量与推力故障辨识中具有应用前景,为火箭质量与推力参数辨识提供了参考。
附图说明
图1为本发明运载火箭质量等状态量与推力参数联合校正辨识方案图;
图2为本发明提出的推力故障下运载火箭质量和推力参数的联合校正辨识方法流程图。
具体实施方式
下面将结合附图对本发明的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
此外,下面所描述的本发明不同实施方式中所涉及的技术特征只要彼此之间未构成冲突就可以相互结合。
本发明针对运载火箭质量与推力参数辨识,提出一种最小二乘与卡尔曼滤波相结合的联合校正辨识方法,该方法特别适用于推力故障下的飞行器的质量和推力参数的在线辨识,也适用于正常飞行情况下飞行器的质量和推力参数的在线辨识。
运载火箭质量与推力参数联合辨识方法包含以下步骤:
针对运载火箭质量与推力联合辨识问题建立用于辨识的火箭质心运动方程和质量消耗方程;
根据火箭惯性敏感器件测量的视加速度信息作为辨识的观测方程;
为了提高辨识的跟踪性,可以对采样的视加速度信息进行插值,从而可以减小辨识的步长提高方法突变跟踪能力;
利用推力参数辨识结果通过卡尔曼滤波来辨识火箭质量,同时利用火箭质量辨识结果通过递推最小二乘估计推力参数,从而实现质量与推力参数联合辨识。
实施例1
本实施例研究火箭真空段的质心运动,假设发动机比冲全程已知。对运载火箭质量与推力参数的联合辨识方法包含以下步骤:
步骤1:针对运载火箭质量与推力联合辨识问题建立用于辨识的火箭质心运动方程(以真空段为例)和质量消耗方程:
其中:r表示火箭距地心的矢量,且r=[rx ry rz]T;v表示火箭的速度矢量,且v=[vx vy vz]T;μ表示引力常数;F表示火箭的总推力;u表示推力方向矢量输入,且u=[u1 u2u3]T;m表示火箭的质量;C表示过程噪声分布矩阵;w表示过程噪声;Isp表示火箭比冲;g0表示海平面处重力加速度。
步骤2:采用惯性敏感器件测量的视加速度信息作为辨识的观测量,建立观测方程如下:
y=Fu/m+d (2)
其中y表示观测的视加速度信息;d表示视加速度的测量噪声。记观测矩阵h(m,u)=u/m,则观测方程也可以写成:
y=h(m,u)F+d (3)
步骤3:选取状态量x=[rx ry rz vx vy vz m]T,则有火箭的质量m=x7。将上述火箭方程与观测方程转化为状态空间方程的形式为:
其中f(x,u,F)和g(x,u,F)表示相应函数,其具体表达形式如下:
矩阵方程A,H中非零元素分别如下表示:
A(1,4)=1,A(2,5)=1,A(3,6)=1,
A(6,7)=-Fu3m-2 (7)
H(1,7)=-Fu1m-2
H(2,7)=-Fu2m-2,
H(3,7)=-Fu3m-2 (8)
步骤5:设置过程噪声方差Qw,观测噪声方差Rd,渐消因子ρ。
步骤6:初始化状态估计初值则有质量的初值推力参数估计初值设P表示状态估计协方差矩阵,则初始化状态估计协方差矩阵初值为P(0);设PLs表示最小二乘协方差矩阵,则初始化最小二乘协方差矩阵初值为PLs(0),且有:
以下步骤7至步骤20为联合校正辨识方法的一个计算周期,联合校正辨识方法就是基于上述步骤后在以下计算周期不断循环的过程。采样点总数为N。
优选的,通过对原采样数据,即视加速度观测量进行线性插值,可以增加采样点的总数,进而减小辨识的步长,从而提高方法的辨识跟踪能力。
其中Δt=tk+1-tk。
步骤9:计算转移矩阵:
Φ(k+1|k)=eA(k+1)Δt (11)
步骤10:计算离散噪声分布矩阵:
Γ(k+1|k)=Φ(k+1|k)C(k+1)Δt (12)
步骤11:根据k时刻的状态估计协方差矩阵P(k)计算状态预估值对应的协方差矩阵:
步骤13:计算卡尔曼滤波增益矩阵:
K(k+1)=P(k+1|k)HT(k+1)[H(k+1)P(k+1|k)HT(k+1)+Rd(k+1)]-1 (14)
步骤14:计算k+1时刻的状态估计协方差矩阵:
P(k+1)=[I-K(k+1)H(k+1)]P(k+1|k) (15)
其中I表示对应状态维度单位阵。
步骤15:根据k+1时刻的观测值校正预估的状态,得到k+1时刻的状态滤波值:
其中IM表示对应观测维度单位阵。
步骤18:计算k+1时刻的最小二乘协方差矩阵
步骤19:计算k+1时刻的推力参数估计值:
步骤20:如果k<N,则k=k+1,返回步骤8;否则循环结束,输出火箭质量与推力参数辨识结果。
显然,上述实施例仅仅是为清楚地说明所作的举例,而并非对实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。而由此所引伸出的显而易见的变化或变动仍处于本发明创造的保护范围之中。
Claims (6)
1.一种推力故障下运载火箭质量和推力参数的联合校正辨识方法,其特征在于,包括:建立用于辨识的火箭质心运动方程和质量消耗方程;根据火箭惯性敏感器件测量的视加速度信息作为辨识的观测量,建立观测方程;每个计算周期中利用当前时刻推力参数辨识结果通过卡尔曼滤波来辨识下一时刻的火箭质量,同时利用下一时刻的火箭质量辨识结果通过渐消因子递推最小二乘来估计下一时刻的推力参数。
2.根据权利要求1所述的推力故障下运载火箭质量和推力参数的联合校正辨识方法,其特征在于,具体包括如下步骤:
建立运载火箭质心运动方程和质量消耗方程:
其中:r表示火箭距地心的矢量,且r=[rx ry rz]T;v表示火箭的速度矢量,且v=[vx vyvz]T;μ表示引力常数;F表示火箭的总推力;u表示推力方向矢量输入,m表示火箭的质量;C表示过程噪声分布矩阵;w表示过程噪声;Isp表示火箭比冲;g0表示海平面处重力加速度;
建立观测方程如下:
y=Fu/m+d
其中y表示观测的视加速度信息;d表示视加速度的测量噪声;记观测矩阵h(m,u)=u/m;
选取状态量x=[rx ry rz vx vy vz m]T,则火箭的质量m=x7,将上述火箭方程与观测方程转化为状态空间方程:
其中f(x,u,F)和g(x,u,F)表示相应函数;
设置过程噪声方差Qw,观测噪声方差Rd,渐消因子ρ;
预测k+1时刻的状态预估值:
其中Δt=tk+1-tk;
计算转移矩阵:
Φ(k+1|k)=eA(k+1)Δt
计算离散噪声分布矩阵:
Γ(k+1|k)=Φ(k+1|k)C(k+1)Δt
计算状态预估值对应的协方差矩阵:
计算卡尔曼滤波增益矩阵:
K(k+1)=P(k+1|k)HT(k+1)[H(k+1)P(k+1|k)HT(k+1)+Rd(k+1)]-1
计算k+1时刻的状态估计协方差矩阵:
P(k+1)=[I-K(k+1)H(k+1)]P(k+1|k)
其中I表示对应状态维度的单位阵;
计算k+1时刻的状态滤波值:
计算最小二乘增益矩阵:
其中IM表示对应观测维度的单位阵;
计算k+1时刻的最小二乘协方差矩阵
计算k+1时刻的推力参数估计值:
如果k<N,则k=k+1,返回预测k+1时刻的状态预估值;否则循环结束,输出运载火箭质量与推力参数辨识结果。
6.根据权利要求2所述的推力故障下运载火箭质量和推力参数的联合校正辨识方法,其特征在于,对视加速度观测量进行线性插值,用以增加采样点的总数,减小辨识的步长,提高方法跟踪性能。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210979915.6A CN115422496A (zh) | 2022-08-16 | 2022-08-16 | 推力故障下运载火箭质量和推力参数的联合校正辨识方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210979915.6A CN115422496A (zh) | 2022-08-16 | 2022-08-16 | 推力故障下运载火箭质量和推力参数的联合校正辨识方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115422496A true CN115422496A (zh) | 2022-12-02 |
Family
ID=84198559
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210979915.6A Pending CN115422496A (zh) | 2022-08-16 | 2022-08-16 | 推力故障下运载火箭质量和推力参数的联合校正辨识方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115422496A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116879763A (zh) * | 2023-09-07 | 2023-10-13 | 上海融和元储能源有限公司 | 一种基于卡尔曼滤波算法的电池故障预警方法 |
-
2022
- 2022-08-16 CN CN202210979915.6A patent/CN115422496A/zh active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116879763A (zh) * | 2023-09-07 | 2023-10-13 | 上海融和元储能源有限公司 | 一种基于卡尔曼滤波算法的电池故障预警方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Dierks et al. | Output feedback control of a quadrotor UAV using neural networks | |
CN111290366A (zh) | 一种航天器姿控系统多故障诊断方法 | |
Tripathi et al. | Finite‐time super twisting sliding mode controller based on higher‐order sliding mode observer for real‐time trajectory tracking of a quadrotor | |
CN102795323B (zh) | 一种基于ukf的水下机器人状态和参数联合估计方法 | |
CN110340898A (zh) | 一种具有指定跟踪性能的自由漂浮空间机械臂自适应容错控制方法 | |
CN113361013B (zh) | 一种基于时间同步稳定的航天器姿态鲁棒控制方法 | |
CN109164708B (zh) | 一种高超声速飞行器神经网络自适应容错控制方法 | |
CN111624878B (zh) | 自主式水面机器人轨迹跟踪的积分滑模获取方法及系统 | |
CN111880410A (zh) | 一种针对电机故障的四旋翼无人机容错控制方法 | |
Zhang et al. | Adaptive observer-based fault diagnosis with application to satellite attitude control systems | |
CN115422496A (zh) | 推力故障下运载火箭质量和推力参数的联合校正辨识方法 | |
CN109188910B (zh) | 一种刚性飞行器的自适应神经网络容错跟踪控制方法 | |
CN115451952B (zh) | 一种故障检测及抗差自适应滤波的多系统组合导航方法和装置 | |
Emami et al. | Intelligent trajectory tracking of an aircraft in the presence of internal and external disturbances | |
CN110532621A (zh) | 一种飞行器气动参数在线辨识方法 | |
CN113858218A (zh) | 一种机械臂执行器故障诊断方法 | |
US6711476B2 (en) | Method and computer program product for estimating at least one state of a dynamic system | |
Chang et al. | Adaptive second-order sliding mode observer for quadrotor attitude estimation | |
CN114035550B (zh) | 一种基于eso的自主式水下机器人执行机构故障诊断方法 | |
CN114879515A (zh) | 基于学习神经网络的航天器姿态重构容错控制方法 | |
Han et al. | Quadratic-Kalman-filter-based sensor fault detection approach for unmanned aerial vehicles | |
CN113670314B (zh) | 基于pi自适应两级卡尔曼滤波的无人机姿态估计方法 | |
CN114923503A (zh) | 一种基于主元分析的在轨航天器陀螺仪和星敏感器故障诊断方法 | |
CN114995163B (zh) | 一种无人机免疫控制方法 | |
CN111605736A (zh) | 地月l2点转移轨道最优误差修正点选择方法 |
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 |