大长细比弹性辨识与视线角速率提取融合方法

阅读：评论：0

1.本发明涉及一种大长细比弹性辨识与视线角速率提取融合方法，属于飞行器控制领域。

背景技术：

2.大长细比构型并配备捷联导引头的制导能够有效提高的射程和精度，但是该构型的在飞行过程中受到气动弹性力等因素的影响会产生周期性的弹性形变，尤其是在被动飞行阶段，随着固体燃料的消耗，使得弹体刚度变弱，发生弹性形变的幅度大大增加。对于上搭载的捷联导引头来说，由于敏感元件与弹体固连，无法隔离弹性形变，导致弹性形变混入导引头的目标观测信息与陀螺仪的姿态信息。
3.传统视线角速率获取方法是基于刚体假设提出的，用于为导弹提供准确的视线角速率及视线角，但是对于配备捷联导引头的大长细比，用来提供姿态解耦信息的角速率陀螺以及用来提供目标角度信息的导引头将受到弹性形变的干扰，导致传统方法提取到的视线角速率具有较大偏差。
4.实际上，大长细比在整个无控飞行过程中，纵向弹性形变量则始终存在，并逐渐增大，如图2所示，尤其是在弹道末段由于飞行速度快、弹道高度较低、动压变大，导致弹性形变幅度不断增大的变化趋势，受到的弹性形变的影响，弹体俯仰方向的速度、角速度以及攻角在都产生了一定幅度的振动，进而影响到姿态传感器的输出。如果不进行处理，会造成制导和姿态控制等环节产生较大误差。
5.针对这种情况，目前主流研究方向致力于对弹性形变进行主动抑制，来减弱甚至消除弹性形变对弹体传感器的影响，例如文献pan c l,rong j l,xu t f, et al.novel approach for active vibration control of a flexible missile[j].defencetechnology,2020,16(4):956-967.，通过给弹体加入一个环形弹性抑制机构，利用遗传算法设计pid控制器实现对弹性形变的主动抑制，然而该方法最多只能实现约40％的抑制效果，又例如文献张博伦,周荻.引入角加速度测量的柔性飞行器姿态控制方法[j].兵工学报,2020,41(11):2225-2233.通过控制舵机产生与弹性形变相反方向的控制力来维持弹体的稳定，然而]通过数值仿真发现，当弹性形变引起的扰动混入加速度和角速度传感器，会引起闭环反馈系统严重发散，并且大长细比的结构频率与刚体运动频率更加接近，很难从刚体运动中分离弹性形变。
[0006]
由于上述原因，有必要提出一种能够解决上述问题的大长细比弹性辨识与视线角速率提取融合方法。

技术实现要素：

[0007]
为了克服上述问题，本发明人进行了深入研究，设计出一种大长细比弹性辨识与视线角速率提取融合方法，包括以下步骤：
[0008]
s1、以视线角、视线角速率、姿态角、角速度、振动方程广义坐标及其广义
坐标的变化率作为状态变量，建立大长细比视线角速率状态模型；
[0009]
s2、对体视线高低角、体视线方位角进行修正；
[0010]
s3、以体视线高低角、体视线方位角以及弹体三个轴向的角速度作为观测变量，建立大长细比视线角速率观测模型；
[0011]
s4、基于视线角速率状态模型和观测模型，通过滤波估计获得视线角速率。
[0012]
进一步地，在s1中，所述大长细比视线角速率状态模型表示为：
[0013][0014]
其中，状态变量[x1,x2,x3,x4,x5,x6,x7,x8,x9,x
10
,x
11
,x
12
,x
13
,x
14
]
t
设置为：qz表示视线高低角，qy表示视线方位角；θ、ψ、γ为地面固连坐标系下的姿态角；ω
x
、ωy、ωz为瞬态坐标系下的角速度；ηy、ηz为振动方程拉格朗日函数第1阶模态下的广义坐标；r表示与目标之间的相对距离；表示在体视线坐标系内垂直方向加速度分量，表示在体视线坐标系内水平加速度分量；m
x
、my、mz为质心处气动弹性力矩；j
x
为极转动惯量，jy与jz为赤道转动惯量；ny、nz分别为瞬态坐标系下垂直方向和侧向广义力； m1为瞬态坐标系下动能的拉格朗日函数第1阶模态的质量；μ1为瞬态坐标系下势能的拉格朗日函数第1阶模态的临界阻尼系数，ω1为瞬态坐标系下势能的拉格朗日函数第1阶模态的固有频率。
[0015]
进一步地，设置相对地面坐标系姿态变化的运动学模型对参数θ、ψ、γ、 ω
x
、ωy、ωz进行约束，所述相对地面坐标系姿态变化的运动学模型表示为：
[0016]
其中，t表示时间。
[0017]
进一步地，设置绕质心动力学模型对参数ω
x
、ωy、ωz进行约束，所述绕质心动力学模型表示为：
[0018]
其中，
[0019][0020]
b1＝-σ1η
z,1
；
[0021]
c1＝-σ1η
y,1
；
[0022][0023]
a2＝-σ1η
y,1
；
[0024][0025][0026][0027]
a3＝-σ1η
z,1
[0028][0029][0030][0031]
η
y,1
表示垂直方向弹性形变的广义坐标，η
z,1
表示侧向弹性形变的广义坐标，m为质量，σ1为常数，表征弹性形变与刚体旋转耦合引起的动能增量，λ1为常数，表征引起质心位移大小。
[0032]
进一步地，设置瞬态坐标系下的大长细比的动力学模型对参数m
x
、my、 mz、ηy、ηz、ny、nz、ω
x
、ωy、ωz进行约束，所述瞬态坐标系下的大长细比的动力学模型表示为：
[0033][0034][0035][0036][0037][0038][0039][0040][0041]
其中，v
x
、vy和vz分别为在地面固连坐标系下的速度分量，l为拉格朗日函数，表示为l＝t-p，t为动能，p为势能，d为阻尼耗散能，f
x
、fy、 fz为所受合力在瞬态坐标系下的分量。
[0042]
进一步地，所述拉格朗日函数第1阶模态下的振动方程表示为：
[0043][0044][0045]
其中，λ1为引起质心位移大小的常数，σ1为弹性形变与刚体旋转耦合引起的动能增量有关的常数，m1为为瞬态坐标系下动能的拉格朗日函数第1阶模态质量，通过的动能t获得。
[0046]
进一步地，所述的动能t表示为：
[0047]
[0048]
其中，mi＝∫mφiφidm，λi＝∫mφidm，
[0049][0050]
当n＝1时，通过的动能t即可获得λ1、σ1、m1。
[0051]
在一个优选的实施方式中，在s2中，以导引头位置处的弹性形变角对导引头体视线角进行修正，表示为：
[0052]qαm
＝q
α-φ
′1(x
head
)ηy，q
βm
＝q
β-φ
′1(x
head
)ηz，
[0053]qαm
、q
βm
为修正后的导引头体视线角，q
α
、q
β
为刚性运动的体视线角，由导引头输出，下标α表示体视线坐标系下导引头垂直方向分量，下标β表示体视线坐标系下导引头水平方向分量，φ
′1(x
head
)ηy、φ
′1(x
head
)ηz为导引头位置处的弹性形变角，x
head
表示导引头位置，
[0054]
设置全弹气动力和力矩模型对导引头位置处的弹性形变角φ
′1(x
head
)ηy、φ
′1(x
head
)ηz进行约束；
[0055]
所述全弹气动力和力矩模型表示为：
[0056][0057][0058][0059][0060][0061][0062]
其中，为轴段微元xb的升力系数导数、为轴段微元xb的侧向力系数导数，q为动压，s为截面积，l表示弹长，xg为末端到质心的轴向距离；α(xb,t)为在弹性形变影响下，t时刻在弹体轴向任一微元xb的局部攻角，β(xb,t)为在弹性形变影响下，t时刻在弹体轴向任一微元xb的侧滑角， φ
′1(x)表示φ1(x)对x的导数。
[0063]
在一个优选的实施方式中，在s3中，所述大长细比视线角速率观测模型表示为：
[0064]
骤，如图1所示：
[0080]
s1、以视线角、视线角速率、姿态角、转动角速度、振动方程广义坐标及其广义坐标的变化率作为状态变量，建立大长细比视线角速率状态模型；
[0081]
s2、对体视线高低角、体视线方位角进行修正；
[0082]
s3、以体视线高低角、体视线方位角以及弹体三个轴向的角速度作为观测变量，建立大长细比视线角速率观测模型；
[0083]
s4、基于视线角速率状态模型和观测模型，通过滤波估计获得视线角速率。
[0084]
由于的弹性变形量会影响视线角速率提取的准确率，发明人发现，虽然可以通过弹性辨识过程获取的弹性变形量，再利用获取的弹性变形量以及将弹性变形量进行视线角速率提取的过程会出现变形量传递时延，这个时延将导致视线角速率提取过程中引入的弹性形变不能与实际弹性形变相匹配，导致获得的角速率准确率降低。
[0085]
在本发明s1中，通过将的弹性辨识过程和视线角速率提取过程进行合并研究，使辨识和提取可以在同一个采样周期完成，从而避免采样信号传递出现时延，提高提取的结果的准确性。
[0086]
具体地，通过以视线角、视线角速率、姿态角、转动角速度、振动方程广义坐标及其广义坐标的变化率作为状态变量，其中，视线角、视线角速率与实现角速率获取直接关联，姿态角、转动角速度、振动方程广义坐标及其广义坐标的变化率与的弹性变形量直接关联，通过将这些量融合为一体，使得建立的大长细比视线角速率状态模型将弹性辨识过程和视线角速率获取过程融合，从而解决上述问题。
[0087]
进一步地，在s1中，所述大长细比视线角速率状态模型基于拉格朗日函数构建，表示为：
利用达朗贝尔原理，即在虚位移上，主动力所做虚功与惯性力所做虚功之和为零，实现了从系统的能量与功的角度来描述耦合了弹性形变的大长细比运动过程。
[0096]
与传统表征相同，在本发明中，参数上方标记一点表示对参数求一阶导数，标记两点表示二阶导数。
[0097]
进一步地，设置相对地面坐标系姿态变化的运动学模型对参数θ、ψ、γ、 ω
x
、ωy、ωz进行约束，所述相对地面坐标系姿态变化的运动学模型表示为：
[0098][0099]
其中，t表示时间。
[0100]
进一步地，设置绕质心动力学模型对参数ω
x
、ωy、ωz进行约束，所述绕质心动力学模型表示为：
[0101][0102]
其中，
[0103][0104]
b1＝-σ1η
z,1
；
[0105]
c1＝-σ1η
y,1
；
[0106][0107]
a2＝-σ1η
y,1
；
[0108][0109][0110][0111]
a3＝-σ1η
z,1
[0112][0113][0114][0115]
η
y,1
表示垂直方向弹性形变的广义坐标，η
z,1
表示侧向弹性形变的广义坐标，m为质量，σ1为常数，表征弹性形变与刚体旋转耦合引起的动能增量，λ1为常数，表征引起质心位移大小。
[0116]
进一步地，设置瞬态坐标系下的大长细比的动力学模型对参数m
x
、my、mz、ηy、ηz、ny、nz、ω
x
、ωy、ωz进行约束，所述瞬态坐标系下的大长细比的动力学模型表示为：
[0117][0118][0119][0120][0121][0122][0123][0124][0125]
其中，v
x
、vy和vz分别为在地面固连坐标系下的速度分量，l为拉格朗日函数，表示为l＝t-p，t为动能，p为势能，d为阻尼耗散能，f
x
、fy、 fz为所受合力在瞬态坐标系下的分量。
[0126]
进一步地，势能p＝pe+pg，其中，pe为弹性势能，pg为重力势能，其表达式分别为：
[0127]
pg＝-∫mr0gdm＝mgy
[0128][0129]
其中，r0为地面固连坐标系到大长细比质心的位置矢量；
[0130]
阻尼耗散能d表示为：
[0131][0132]
其中，μi为第i阶模态的临界阻尼系数，一般取0.05～0.1，ωi为第i阶模态的固有频率。
[0133]
进一步地，所受合力包括：发动机推力tb、弹性气动力fe和重力fg；优选地，合力在瞬态坐标系下的分量表示为：
[0134][0135]
其中，为发动机喷口处弹性形变量组成的坐标转换矩阵，tm为火箭发动机喷口处推力，为地面坐标系到瞬态坐标系的转换矩阵；m为质量，g为重力加速度，
[0136]
具体地，
[0137][0138][0139]
根据本发明，所述拉格朗日函数第1阶模态下的振动方程表示为：
[0140][0141][0142]
其中，λ1为引起质心位移大小的常数，σ1为弹性形变与刚体旋转耦合引起的动能增量有关的常数，通过的动能t获得。
[0143]
所述的动能t可以表示为：
[0144][0145]
其中，mi＝∫mφiφidm，λi＝∫mφidm，φi为第i阶模态的振型函数，
[0146][0147]
sinh为双曲正弦函数，cosh为双曲余弦函数，
[0148]
当n＝1时，通过的动能t即可获得λ1、σ1、m1。
[0149]
在s2中，以导引头位置处的弹性形变角对导引头体视线角进行修正，表示为：
[0150]qαm
＝q
α-φ
′1(x
head
)ηy，q
βm
＝q
β-φ
′1(x
head
)ηz，
[0151]qαm
为修正后的导引头垂直方向体视线角、q
βm
为修正后的导引头水平方向体视线角，
[0152]qα
为体视线坐标系下刚性运动导引头垂直方向的体视线角、q
β
为体视线坐标系下刚性运动导引头水平方向的体视线角，均由导引头输出，
[0153]
φ
′1(x
head
)ηy为导引头位置处的弹性形变角的垂直分量、φ
′1(x
head
)ηz为导引头位置处的弹性形变角的侧向分量，x
head
表示导引头位置，
[0154]
设置全弹气动力和力矩模型对导引头位置处的弹性形变角φ
′1(x
head
)ηy、φ
′1(x
head
)ηz进行约束；
[0155]
所述全弹气动力和力矩模型表示为：
[0156][0157][0158][0159][0160][0161][0162]
其中，xb为轴段微元，为轴段微元xb的升力系数导数、为轴段微元xb的侧向力系数导数，q为动压，s为截面积，l表示弹长，xg为
末端到质心的轴向距离；α(xb,t)为在弹性形变影响下，t时刻在弹体轴向任一微元xb的局部攻角，β(xb,t)为在弹性形变影响下，t时刻在弹体轴向任一微元xb的侧滑角，φ
′1(x)表示φ1(x)对x的导数。
[0163]
进一步地，α(xb,t)和β(xb,t)可以表示为：
[0164][0165][0166]
α0、β0分别为刚体攻角、侧滑角；分别为弹体弹性变形对时间的导数；d
′y＝φ
′1(xb)ηy(t)、d
′z＝φ
′1(xb)ηz(t)分别为弹体弹性变形对轴向坐标的导数。
[0167]
在s3中，所述大长细比视线角速率观测模型表示为：
[0168][0169][0170]
其中，观测变量[z1,z2,z3,z4z5]
t
设置为：
[0171]
[z1,z2,z3,z4z5]
t
＝[q
αm
,q
βm
,ω
xm
,ω
ym
,ω
zm
]
t
；
[0172]
x
imu
表示陀螺仪安装位置，ω
xm
,ω
ym
,ω
zm
为耦合弹性形变后的陀螺仪角速度的输出，a、b、c为中间量。
[0173]
根据本发明一个优选的实施方式，s4中，基于视线角速率状态模型和观测模型，通过无迹卡尔曼滤波法进行滤波估计，获得视线角速率。
[0174]
无迹卡尔曼滤波法(unscented kalman filter,ukf)是一种经典的对系统状态进行最优估计的方法，在本发明中不做赘述。
[0175]
具体地，对视线角速率提取状态模型和观测模型进行离散化，对离散化后的结果采用无迹卡尔曼滤波(ukf)法进行滤波，无迹卡尔曼滤波法是对非线性函数的概率密度分布进行近似，而不是对非线性函数进行近似，其选用确定的样本sigma点来逼近系统状态的后验概率密度，能较好地描述状态的真实均值和方差，避免了计算jacobian矩阵，且在高斯条件下可达到三阶taylor级数展开精度。
[0176]
无迹卡尔曼滤波法通过在估计点附近进行ut变换，使获得的sigma点集的状态均值和协方差与原统计特性匹配，再直接对这些点集进行非线性映射，以近似得到状态概率密度函数，能够以较低的计算复杂度获得较高的估计精度，实现对视线角速率的高精度提取。
[0177]
实施例
[0178]
实施例1
[0179]
基于装载捷联导引头的某型远程制导的无控弹道仿真实验，设置仿真初始参数如下表所示：
[0180][0181]
通过以下步骤获得视线角速率：
[0182]
s1、以视线角、视线角速率、姿态角、转动角速度、振动方程广义坐标及其广义坐标的变化率作为状态变量，建立大长细比视线角速率状态模型；
[0183]
s2、对体视线高低角、体视线方位角进行修正；
[0184]
s3、以体视线高低角、体视线方位角以及弹体三个轴向的角速度作为观测变量，建立大长细比视线角速率观测模型；
[0185]
s4、基于视线角速率状态模型和观测模型，通过滤波估计获得视线角速率。
[0186]
在s1中，所述大长细比视线角速率状态模型表示为：
[0187][0188]
其中，状态变量[x1,x2,x3,x4,x5,x6,x7,x8,x9,x
10
,x
11
,x
12
,x
13
,x
14
]
t
设置为： [-0.8464,-0.0025,0,0,-0.7752,0,0,0,0,-0.0072,-0.0008,-0.0133,0,0]
t
；μ1取0.05。
[0189]
设置相对地面坐标系姿态变化的运动学模型对参数θ、ψ、γ、ω
x
、ωy、 ωz进行约束，所述相对地面坐标系姿态变化的运动学模型表示为：
[0190][0191]
设置绕质心动力学模型对参数ω
x
、ωy、ωz进行约束，所述绕质心动力学模型表示为：
[0192][0193]
其中，
[0194][0195]
b1＝-σ1η
z,1
；
[0196]
c1＝-σ1η
y,1
；
[0197][0198]
a2＝-σ1η
y,1
；
[0199][0200][0201][0202]
a3＝-σ1η
z,1
[0203][0204][0205][0206]
设置瞬态坐标系下的大长细比的动力学模型对参数m
x
、my、mz、ηy、ηz、 ny、nz、ω
x
、ωy、ωz进行约束，所述瞬态坐标系下的大长细比的动力学模型表示为：
[0207][0208]
(x
head
)ηz进行约束；
[0226]
所述全弹气动力和力矩模型表示为：
[0227][0228][0229][0230][0231][0232][0233]
在s3中，所述大长细比视线角速率观测模型表示为：
[0234][0235][0236]
其中，观测变量[z1,z2,z3,z4z5]
t
设置为：
[0237]
[z1,z2,z3,z4z5]
t
＝[q
αm
,q
βm
,ω
xm
,ω
ym
,ω
zm
]
t
；
[0238]
s4中，基于视线角速率状态模型和观测模型，通过无迹卡尔曼滤波法进行滤波估计，获得视线角速率。
[0239]
对比例1
[0240]
进行与实施例1相同的实验，区别在于，采用文章zhang d,song j m,zhao l y,et al.extraction algorithm for line of sight angular rate under non-gaussian correlativenoise environment[j].acta aeronautica et astronautica sinica,2020,41(6):324629.中的方法进行。
[0241]
对比例2
[0242]
进行与实施例1相同的实验，区别在于，通过以下步骤获得视线角速率： s1、建立大长细比弹性辨识模型；s2、利用无迹卡尔曼滤波法实时估计获得火箭弹弹性形变量；s3、设置视线角速率提取状态模型，以弹性形变量修正导引头体视线角，以修正后的导引头体视线角作为视线角速率提取的观测变量之一，获得视线角速率提取观测模型，基于视线角速率提取状态模型和观测模型进行滤波估计，获得视线角速率。
[0243]
在s1中，所述大长细比弹性辨识模型基于拉格朗日函数构建，表示为：
[0244][0245]
其中，μ1取0.05，
[0246][0247]
设置相对地面坐标系姿态变化的运动学模型对参数θ、ψ、γ、ω
x
、ωy、 ωz进行约束，所述相对地面坐标系姿态变化的运动学模型表示为：
[0248][0249]
设置绕质心动力学模型对参数ω
x
、ωy、ωz进行约束，所述绕质心动力学模型表示为：
[0250][0251][0252]
b1＝-σ1η
z,1
；
[0253]
c1＝-σ1η
y,1
；
[0254][0255]
a2＝-σ1η
y,1
；
[0256][0257][0258][0259]
a3＝-σ1η
z,1
[0260][0261][0262][0263]
进一步地，设置瞬态坐标系下的大长细比的动力学模型对参数m
x
、my、 mz、ηy、ηz、ny、nz、ω
x
、ωy、ωz进行约束，所述瞬态坐标系下的大长细比的动力学模型表示为：
[0264][0265][0266][0267][0268][0269][0270][0271][0272]
所述拉格朗日函数第1阶模态下的振动方程表示为：
[0273]
[0274][0275]
其中，λ1、σ1、m1通过的动能t获得。
[0276]
所述的动能t表示为：
[0277][0278]
其中，
[0279][0280]
其中截面积s＝0.07068m2，弹长l＝7.6m。
[0281]
当n＝1时，通过的动能t即可获得λ1、σ1、m1。
[0282]
设置全弹气动力和力矩模型对参数fy、fz、my、mz、ηy、ηz进行约束，所述全弹气动力和力矩模型表示为：
[0283][0284][0285][0286][0287][0288][0289]
α(xb,t)和β(xb,t)可以表示为：
[0290][0291]
末端最大误差仅在0.2
°
以内，而对比例1中不考虑的弹性形变而直接进行提取的方式，会导致视线角和视线角速率估计误差大幅增加，其视线角速率估计误差最大达到了1
°
以上。
[0311]
因此在存在弹性形变的情况下，传统视线角速率提取方法(对比例1)不再适用。
[0312]
实验例2
[0313]
对比实施例1与对比例2中获取的视线角速率，结果如图7～9所示，其中，
[0314]
图7示出了实施例1与对比例2中视线高低角估计曲线，图8示出了实施例1与对比例2中视线方位角估计曲线，图9示出了实施例1与对比例2中视线高低角估计误差曲线，
[0315]
从图7～9中可以看出，实施例1与对比例2在仿真前半段弹目距离较大，弹目视线角变化较慢的情况下，都具有较高的估计精度，但是到了仿真后半段，随着弹目距离接近，弹目视线角变化更加剧烈，对比例2由于先辨识出弹性形变量，再利用获取的弹性变形量以及将弹性变形量进行视线角速率提取的过程具有50ms的传递时延，导致对比例2不能像实施例1那样准确跟踪弹体的实时变化，使得对比例2中获得的视线角速率相对于实施例有更大的误差，从而影响最终的制导精度。
[0316]
在本发明的描述中，需要说明的是，术语“上”、“下”、“内”、“外”、“前”、“后
”ꢀ
等指示的方位或位置关系为基于本发明工作状态下的方位或位置关系，仅是为了便于描述本发明和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本发明的限制。此外，术语“第一”、
ꢀ“
第二”、“第三”、“第四”仅用于描述目的，而不能理解为指示或暗示相对重要性。
[0317]
在本发明的描述中，需要说明的是，除非另有明确的规定和限定，术语“安装
”ꢀ“
相连”“连接”应作广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体的连接普通；可以是机械连接，也可以是电连接；可以是直接连接，也可以通过中间媒介间接连接，可以是两个元件内部的连通。对于本领域的普通技术人员而言，可以具体情况理解上述术语在本发明中的具体含义。
[0318]
以上结合了优选的实施方式对本发明进行了说明，不过这些实施方式仅是范例性的，仅起到说明性的作用。在此基础上，可以对本发明进行多种替换和改进，这些均落入本发明的保护范围内。

技术特征：

1.一种大长细比弹性辨识与视线角速率提取融合方法，其特征在于，包括以下步骤：s1、以视线角、视线角速率、姿态角、角速度、振动方程广义坐标及其广义坐标的变化率作为状态变量，建立大长细比视线角速率状态模型；s2、对体视线高低角、体视线方位角进行修正；s3、以体视线高低角、体视线方位角以及弹体三个轴向的角速度作为观测变量，建立大长细比视线角速率观测模型；s4、基于视线角速率状态模型和观测模型，通过滤波估计获得视线角速率。2.根据权利要求1所述的大长细比弹性辨识与视线角速率提取融合方法，其特征在于，在s1中，所述大长细比视线角速率状态模型表示为：其中，状态变量[x1,x2,x3,x4,x5,x6,x7,x8,x9,x
10
,x
11
,x
12
,x
13
,x
14
]
t
设置为：q
z
表示视线高低角，q
y
表示视线方位角；
θ、ψ、γ为地面固连坐标系下的姿态角，θ为俯仰角，ψ为偏航角，γ为滚转角；ω
x
、ω
y
、ω
z
为瞬态坐标系下的角速度；η
y
为瞬态坐标系下振动方程拉格朗日函数第1阶模态下的垂直方向广义坐标、η
z
为瞬态坐标系下振动方程拉格朗日函数第1阶模态下的侧向广义坐标；r表示与目标之间的相对距离；表示在体视线坐标系内垂直方向加速度分量，表示在体视线坐标系内水平加速度分量；m
x
、m
y
、m
z
为质心处气动弹性力矩；j
x
为极转动惯量，j
y
与j
z
为赤道转动惯量；n
y
、n
z
分别为瞬态坐标系下垂直方向和侧向广义力；m1为瞬态坐标系下动能的拉格朗日函数第1阶模态的质量；μ1为瞬态坐标系下势能的拉格朗日函数第1阶模态的临界阻尼系数，ω1为瞬态坐标系下势能的拉格朗日函数第1阶模态的固有频率。3.根据权利要求2所述的大长细比弹性辨识与视线角速率提取融合方法，其特征在于，设置相对地面坐标系姿态变化的运动学模型对参数θ、ψ、γ、ω
x
、ω
y
、ω
z
进行约束，所述相对地面坐标系姿态变化的运动学模型表示为：其中，t表示时间。4.根据权利要求2所述的大长细比弹性辨识与视线角速率提取融合方法，其特征在于，设置绕质心动力学模型对参数ω
x
、ω
y
、ω
z
进行约束，所述绕质心动力学模型表示为：其中，a1、a2、a3、b1、b2、b3、c1、c2、c3、d1、d2、d3为中间变量，b1＝-σ1η
z,1
；c1＝-σ1η
y,1
；
a2＝-σ1η
y,1
；；；a3＝-σ1η
z,1z,1z,1
η
y,1
表示垂直方向弹性形变的广义坐标，η
z,1
表示侧向弹性形变的广义坐标，m为质量，σ1为常数，λ1为常数。5.根据权利要求2所述的大长细比弹性辨识与视线角速率提取融合方法，其特征在于，设置瞬态坐标系下的大长细比的动力学模型对参数m
x
、m
y
、m
z
、η
y
、η
z
、n
y
、n
z
、ω
x
、ω
y
、ω
z
进行约束，所述瞬态坐标系下的大长细比的动力学模型表示为：为：为：为：为：
其中，v
x
、v
y
和v
z
分别为在地面固连坐标系下的速度分量，l为拉格朗日函数，表示为l＝t-p，t为动能，p为势能，d为阻尼耗散能，f
x
、f
y
、f
z
为所受合力在瞬态坐标系下的分量。6.根据权利要求2所述的大长细比弹性辨识与视线角速率提取融合方法，其特征在于，所述拉格朗日函数第1阶模态下的振动方程表示为：所述拉格朗日函数第1阶模态下的振动方程表示为：其中，λ1为常数，σ1为常数，m1为为瞬态坐标系下动能的拉格朗日函数第1阶模态质量，通过的动能t获得。7.根据权利要求6所述的大长细比弹性辨识与视线角速率提取融合方法，其特征在于，所述的动能t表示为：其中，m
i
＝∫
m
φ
i
φ
i
dm，λ
i
＝∫
m
φ
i
dm，
当n＝1时，通过的动能t即可获得λ1、σ1、m1。8.根据权利要求5所述的大长细比弹性辨识与视线角速率提取融合方法，其特征在于，在s2中，以导引头位置处的弹性形变角对导引头体视线角进行修正，表示为：q
αm
＝q
α-φ
′1(x
head
)η
y
，q
βm
＝q
β-φ
′1(x
head
)η
z
，q
αm
为修正后的导引头垂直方向体视线角、q
βm
为修正后的导引头水平方向体视线角，q
α
为体视线坐标系下刚性运动导引头垂直方向的体视线角、q
β
为体视线坐标系下刚性运动导引头水平方向的体视线角，均由导引头输出，φ
′1(x
head
)η
y
为导引头位置处的弹性形变角的垂直分量、φ
′1(x
head
)η
z
为导引头位置处的弹性形变角的侧向分量，x
head
表示导引头位置，设置全弹气动力和力矩模型对导引头位置处的弹性形变角φ
′1(x
head
)η
y
、φ
′1(x
head
)η
z
进行约束；所述全弹气动力和力矩模型表示为：所述全弹气动力和力矩模型表示为：所述全弹气动力和力矩模型表示为：所述全弹气动力和力矩模型表示为：所述全弹气动力和力矩模型表示为：所述全弹气动力和力矩模型表示为：其中，x
b
为轴段微元，为轴段微元x
b
的升力系数导数、为轴段微元x
b
的侧向力系数导数，q为动压，s为截面积，l表示弹长，x
g
为末端到质心的轴向距离；α(x
b
,t)为在弹性形变影响下，t时刻在弹体轴向任一微元x
b
的局部攻角，β(x
b
,t)为在弹性形变影响下，t时刻在弹体轴向任一微元x
b
的侧滑角，φ
′1(x)表示φ1(x)的对x的导数。9.根据权利要求1所述的大长细比弹性辨识与视线角速率提取融合方法，其特征在于，在s3中，所述大长细比视线角速率观测模型表示为：
其中，观测变量[z1,z2,z3,z4z5]
t
设置为：[z1,z2,z3,z4z5]
t
＝[q
αm
,q
βm
,ω
xm
,ω
ym
,ω
zm
]
t
；x
imu
表示陀螺仪安装位置，ω
xm
,ω
ym
,ω
zm
为耦合弹性形变后的陀螺仪角速度的输出，a、b、c为中间量。10.根据权利要求1所述的大长细比弹性辨识与视线角速率提取融合方法，其特征在于，s4中，基于视线角速率状态模型和观测模型，通过无迹卡尔曼滤波法进行滤波估计，获得视线角速率。

技术总结

本发明公开了一种大长细比弹性辨识与视线角速率提取融合方法，包括以下步骤：S1、以视线角、视线角速率、姿态角、转动角速度、振动方程广义坐标及其广义坐标的变化率作为状态变量，建立大长细比视线角速率状态模型；S2、对体视线高低角、体视线方位角进行修正；S3、以体视线高低角、体视线方位角以及弹体三个轴向的角速度作为观测变量，建立大长细比视线角速率观测模型；S4、基于视线角速率状态模型和观测模型，通过滤波估计获得视线角速率。本发明提供的方法，实现了弹性形变情况下视线角速率的高精度提取，且提取准确度不会受到信号传递时延影响。到信号传递时延影响。到信号传递时延影响。