2. 飞行控制与仿真技术研究所, 陕西 西安 710072
许多现代战术导弹都采用了惯性稳定平台式的导引头,其跟踪及稳定回路中都少不了机械常平架。因此这种体制具有如下缺点:①系统可靠性不高,生产、装配、标定较复杂;②导致弹体的体积和质量大,造价较高;③跟踪系统性能、万向架摩擦等因素皆会影响视线角速率测量的准确性。
当代光电传感器技术不断进步,使得导引头光学系统的瞬时视场足够大,不再需要机械常平架,于是捷联导引头技术以及捷联寻的制导技术走向了实际应用阶段。得益于机械平台及连接部件的消失,导引头系统变得更加可靠。大的瞬时视场则使得视线跟踪角速率不再受到限制;由摩擦导致的俯仰、方位跟踪通道之间交叉耦合被有效消除;系统的结构复杂性下降,制造成本也随之降低。
当然,相对于经典的常平架体制导引头,全捷联导引头的寻的制导体制还存在如下困难[2]:
1) 光学系统必须有足够大的瞬时视场;
2) 无法直接测量制导所需视线角速度信号;
3) 大的瞬时视场会引入大的测量噪声。这将对整个制导系统的稳定性和精确性产生直接影响;
4) 必须采用数学平台来对弹体姿态对视线角的扰动进行解耦。
1 捷联导引头制导信息滤波算法 1.1 体视线角解耦为惯性系下视线角设 qIH、qIV分别为惯性系水平视线角和垂直视线角,qBH、qBV分别为弹体系水平视线角和垂直视线角,ψ、ϑ、γ 分别为弹体偏航角、俯仰角和滚转角,通过坐标变换可得到解耦公式:
式中
1.2 弹目相对运动模型建立
1) 状态方程建立
本文假设目标为地面目标,并可作未知机动,取目标位置及速度值作为状态变量,状态初值可在发射时由载机装订:
取目标加速度作为参数向量:
取增广状态向量为:
则有状态转移方程:
离散化状态转移方程:(T为滤波周期)
2) 观测方程建立
观测方程使用1.1中解耦后的惯性系下视线角作为测量值,即观测向量为:
由此可得观测方程:
1.3 无迹施密特卡尔曼滤波器USKF[3](unscented Schmidt-Kalman filter)即无迹施密特卡尔曼滤波器。USKF基于UKF的框架,通过设定状态-参数增广矩阵来进一步考虑模型参数误差对于估计的影响。USKF并不需要将估计方程和参数方程分开,而是通过增广方式进行一次性计算。只是在最后的校正步骤时,参数估值并不进行校正。在传统UKF算法中,参数估值必须校正。然而USKF的优势在于,通常情况下参数不能很好地从测量值中被观测,因此对它们的估值进行校正可能使其较大的估值误差影响到状态估值的精度。USKF滤波计算步骤如下:
考虑增广后的状态向量及其方差矩阵:
式中, X为状态向量,C为参数向量。
1) 一步预测
我们对k-1步的方差阵PZZ,k-1作Cholesky分解:PZZ=SZZSTZZ,然后用SZZ,k-1来产生2(nx+nc)个扩增Sigma点Zi,k-1,i=2(nc+nx)。利用状态转移方程Zi=f(Zi,k-1,t)可以得到Zi,k ,之后可以计算状态预测值及预测方差:
这里对于所有的i有:
2) 一步校正(此步运算将角标 k省略)
系统量测值的Sigma点Yi=H(Zi,t) ,借此我们计算量测预测值、方差及增广的量测-状态协方差
接下来计算扩增卡尔曼增益:
由此得到一步校正,完成第k步的滤波运算:
注意到(10)式的 Kc(y-ý)项与(11)式的KcPyyKTc 被强制设为零,即不进行参数估值校正,避免了参数估值误差太大对状态估值的影响。
1.4 制导信息提取使用USKF对增广状态向量进行估值后,对状态值做代数运算后可提取制导律所需信息:
弹目相对距离 x、y、z 向分量滤波值
弹目相对速度 vx、vy、vz 向分量滤波值
弹目相对距离的滤波值:
弹目接近速度的滤波值:
惯性视线角滤波值:
惯性视线角速率滤波值:
剩余飞行时间滤波值:
2 带落角约束导引律由于制导信息滤波算法为制导律提供制导信息,因此在没有制导律的前提下无法考察滤波算法的性能。为此我们采用了针对地面目标的带落角约束的导引律验证USKF算法的性能。
2.1 弹目关系方程建立一般弹目关系模型方程组:
式中: q为惯性系下视线角,r为弹目相对距离,at,am分别为目标和导弹的加速度,vt,vm分别为目标和导弹的速度,δ为导弹速度矢量与r的夹角,θ为目标速度矢量与r的夹角,y 为弹目纵向距离:
方程组线性化后得到:
式中, tf为终端时间,tgo=tf-t,vc=vmcosδ-vtcosθ。
2.2 弹道成型导引律原理借助2.1中的弹目关系线性化方程,考虑机动目标的制导系统状态方程为:
时变目标代价函数:
终端条件 Dx(tf)=E ,式中:
根据最优控制理论,可解得:
(37)式即广义最优弹道成型导引律,其中:
位置项系数 NP=2(n+2)
落角项系数Nθ=(n+1)(n+2)
目标机动项系数NaT=(1-n)(n+2)/2
当n取1 时,目标机动项为零:
考虑到目前的导引头硬件能力,目标加速度无法准确获得,因此我们认为(38)式相比较一般形式更具有实用价值。我们将此导引律选为本文所论述的制导系统方案的导引律。
3 制导系统方案整体设计与仿真 3.1 设计思路及示意图结合前文所述制导信息滤波算法及最优导引律,我们对制导系统进行了整体设计,如图 1所示:
由于制导末段必将进入导引头盲区,我们采取了剩余时间小于0.3s时保持制导指令不变的方案。
3.2 仿真条件及结果1) 单次打靶验证
假设末制导启动时导弹位置/m(0,1 000,0),
目标位置/m(2 000,0,2 000),导弹初始速度/(m·s-1)(200,0,0),目标初始速度/(m·s-1)(10,0,10),目标机动情况为:
0~8 s: ax=ay=az=0 m/s2
8 s以后:ax=2 m/s2,ay=0 m/s2,az=4 m/s2
采样步长为0.01 s选取捷联式导引头测量噪声为零均值,3σ=0.8°的白噪声,落角约束大于45°。发射时载机装订的目标初始状态值误差为:ΔX=(50,50,50,5,5,5),飞控等效模型:过载指令限幅10g ,仿真结果如图 2~图 8所示。
仿真结果:单次脱靶量0.834 m,命中点落角为44.65°,各个制导信息的估计效果较好,所采用的制导系统方案能有效打击地面机动目标。
2) 蒙特卡罗打靶效果比较
我们选择了EKF、UKF作为对比,导引头噪声特性、导引律与飞控等效模型都是相同的,调整弹目初始距离,经过50次蒙特卡罗打靶得到如下结果:
对比仿真结果表明:在面对机动目标时,相比于传统非线性滤波器EKF及UKF,USKF算法能够显著改善捷联导引头信息滤波的精度,相应地改善了脱靶量,提高了制导系统的性能。
4 结 论本文采用无迹施密特卡尔曼滤波器设计了一种全捷联导引头信息滤波方案,并选取了落角约束导引律进行了目标机动情况下的仿真验证。仿真结果表明,无迹施密特卡尔曼滤波器可以准确估计制导信息。将这些估值应用于落角约束型导引律,明显地增强了导弹的寻的导引能力,提升了其打击地面机动目标的命中精度和毁伤能力。
[1] | 王佩,张科. 跟踪-微分器在全捷联制导中的应用分析[J]. 西北工业大学学报,2014,32(5):817-821 Wang Pei, Zhang Ke. Application and Analysis of Tracking-Differentiator in Strapdown Guidance[J]. Journal of Northwestern Polytechnical University, 2014, 32(5):817-821 (in Chinese) |
Cited By in Cnki (1) | |
[2] | 姚郁,章国江. 捷联成像制导系统的若干问题探讨[J]. 红外与激光工程,2006,35(1):1-6 Yao Yu, Zhang Guojiang. Discussion on Strapdown Imaging Guidance System[J]. Infrared and Laser Engineering, 2006, 35(1):1-6 (in Chinese) |
Cited By in Cnki (43) | Click to display the text | |
[3] | Jason Stauch, Unscented Schmidt-Kalman Filter Algorithm[J]. Journal of Guidance, Control and Dynamics, 2015, 38(1):117-123 |
Click to display the text | |
[4] | James M Maley. Line of Sight Rate Estimation for Guided Projectiles with Strapdown Seekers[C]//AIAA Guidance, Navigation, and Control Conference, 2015:1-24 |
Click to display the text | |
[5] | Sreeja Hablani. Precision Munition Guidance and Moving Target Position Estimation[C]//AIAA Guidance, Navigation, and Control Conference, 2015:1-21 |
Click to display the text | |
[6] | 林德福,王辉. 战术导弹自动驾驶仪设计与制导律分析[M]. 北京:北京理工大学出版社,2012 Lin Defu, Wang Hui. Autopilot Design and Guidance Law Analysis for Tactical Missiles[M]. Beijing:Beijing Institute of Technology Press, 2012 (in Chinese) |
2. Research Institute of Flight Control and Simulation, Xi'an 710072, China