空间稳定惯性导航系统的动基座初始对准过程中,由于其平台系统稳定在惯性空间的特点,传统对准网络存在对准时间较长,动态下对准精度不能保证的问题,本文考虑运用H ∞控制技术设计对准方案,并进行了仿真设计。通过传统对准网络和H ∞控制网络在对准性能和对准误差的比较,验证了H ∞控制对于噪声的不敏感性,使系统在不确定干扰的噪声条件下的初始对准具有快速性和较高的精度,仿真分析表明H ∞控制技术应用于空间稳定惯性导航系统的初始对准中,能有效缩短约初始对准时间。 During dynamic alignment of space-stable inertial navigation system, because its platform system is stable in inertial space, the traditional alignment network has a long alignment time, and the alignment accuracy cannot be guaranteed under dynamic conditions. In this paper, H ∞ control technology is used to design the alignment scheme, and the simulation design is carried out. Comparing the traditional alignment network and H ∞ control network in alignment performance and alignment error, it is verified that H ∞ control is insensitive to noise, which makes the initial alignment of the system fast and high accuracy under the condition of uncertain interference. Simulation analysis shows that H ∞ control technology can effectively shorten the initial alignment of initial alignment time when applied in initial alignment of space-stable inertial navigation systems.
付中泽1,赵汪洋2,王兴岭2,王凯2
1海装驻天津军事代表局,天津
2天津航海仪器研究所,天津
收稿日期:2020年5月7日;录用日期:2020年6月2日;发布日期:2020年6月9日
空间稳定惯性导航系统的动基座初始对准过程中,由于其平台系统稳定在惯性空间的特点,传统对准网络存在对准时间较长,动态下对准精度不能保证的问题,本文考虑运用H∞控制技术设计对准方案,并进行了仿真设计。通过传统对准网络和H∞控制网络在对准性能和对准误差的比较,验证了H∞控制对于噪声的不敏感性,使系统在不确定干扰的噪声条件下的初始对准具有快速性和较高的精度,仿真分析表明H∞控制技术应用于空间稳定惯性导航系统的初始对准中,能有效缩短约初始对准时间。
关键词 :H∞控制,空间稳定,惯导系统,初始对准
Copyright © 2020 by author(s) and Hans Publishers Inc.
This work is licensed under the Creative Commons Attribution International License (CC BY 4.0).
http://creativecommons.org/licenses/by/4.0/
惯性导航系统(Inertial Navigation System)在启动时,必须依赖提供的外部精准信息完成初始对准,以修正惯性系统惯性平台的初始失调角。由于使用惯性导航系统的运载平台的差异,其采用的初始对准方式也不一样,如机载平台通常采用“传递对准”方式、陆用平台则“行进间”对准方式较为普遍、船载平台以码头条件的“系泊对准”为主要考虑的对准方式;同时由于惯导设备形态的差别,采用的对准方式也不尽相同,如捷联惯导系统主要采用凝固坐标系 + 卡尔曼滤波器的方式完成初始对准、液浮惯导则采用传统的经典控制网络实现初始对准。本文讨论的是空间稳定型惯导系统,采用H∞ control的方式实现初始对准。
空间稳定型惯导系统平台框架结构如图1所示,由于陀螺和加速度计装于惯性平台,一起稳定于地心惯性坐标系,相对于当地重力矢量翻滚 [
以连续定常系统为例,其动态方程作为广义控制对象:
{ x ˙ ( t ) = A x ( t ) + B 1 ω ( t ) + B 2 u ( t ) y ( t ) = C x ( t ) + D 11 ω ( t ) + D 12 u ( t ) z ( t ) = L x ( t ) + D 21 ω ( t ) + D 22 u ( t ) (1)
其中, ω ∈ R m 1 为外输入信号,包括外干扰、噪声、参考输入等; u ∈ R m 2 为控制信号; z ∈ R p 1 为被控输出信号; y ∈ R p 2 为被测信号。 P ( s ) 代表广义被控对象, K ( s ) 代表要设计的控制器。
图1. 空间稳定系统框架结构示意图
在确定性次优滤波过程中,可将噪声看作是能量有限的随机信号,使系统的干扰到估计误差的闭环传递函数的范数小于给定的正数 [
若相应的传递函数形式为
P ( s ) = [ P 11 P 12 P 21 P 22 ] (2)
则从 ω 到z的闭环传递函数为
其中, F l ( P , K ) = P 11 + P 12 K ( I − P 22 K ) − 1 P 21 。最优 H ∞ 控制的目的就是设计控制器 K ( s ) 使闭环系统内稳定且使系统闭环传递函数
‖ F l ( P , K ) ‖ < ς (4)
其中 ς 为给定常数。
空间稳定惯性导航系统原理如图2所示,其初始对准分为两个步骤进行,第一个步骤为粗对准(平台对准),在陀螺启动之前,借助外部信息(如平台罗经提供的姿态信息)平台用平衡环锁定技术(将指令角度输入平衡环模数转换器)定向,调整框架使平台坐标系与惯性坐标系接近一致。第二个步骤为精对准(确定平台坐标系的实际指向),即确定平台坐标系相对于惯性坐标系的关系或者确定平台坐标系相对于当地地理坐标系的关系 [
图2. 空间稳定惯性导航系统
空间稳定型惯导系统精对准中根据在不同坐标标系的编排可以考虑在惯性坐标系下和地理坐标系下实现。但在惯性坐标系的机械编排中,平台坐标系引出的加速度讯号直接在地心惯性坐标系中解算,由于重力分量的补偿比较困难,难以寻找一个基准信号(地理坐标系下的基准信号为 [ 0 0 g ] )作为参考在这样的情况下设计初始对准网络不容易满足其导航要求的对准精度,因此考虑在地理坐标系编排中实现精对准,如图3所示。
图3. 北向水平回路误差方块图
a) f ′ l 的变化计算
式中
f ′ p :平台坐标系加速度计输出;
b) 有害加速度计算
{ A l x b ′ = ( 2 Ω sin φ + V ′ l x tg φ / R N ) V ′ l y + ( 2 Ω cos φ + V ′ l x / R N ) V ′ l z A l y b ′ = ( 2 Ω sin φ + V ′ l x tg φ / R N ) V ′ l x + V ′ l y V ′ l z / R M A l z b ′ = − ( 2 Ω cos φ + V ′ l x / R N ) V ′ l x − V ′ l y 2 / R M + g (6)
其中“ ' ”表示解算量。
c) V l ′ 的解算方程
{ V ˙ ′ l x = f ′ l x − A l x b ′ − K 1 V ′ l x V ′ l x ( 0 ) = 0 V ˙ ′ l y = f ′ l y − A l y b ′ − K 1 V ′ l y V ′ l y ( 0 ) = 0 (7)
式中
{ V l x D ′ = V ′ l x + T x + J x V l y D ′ = V ′ l y + T y + J y (8)
D方程满足以下方程:
{ T ′ ˙ x = K 3 V ′ l x T x ( 0 ) = 0 T ′ ˙ y = K 3 V ′ l y T y ( 0 ) = 0 (9)
J方程由下式计算
{ J x = K 2 V ′ l x J y = K 2 V ′ l y (10)
d) 角速度 ω ′ l 的计算
{ ω ′ l x = − V l y D ′ R M ω ′ l y = V l x D ′ R N + Ω cos φ ω ′ l z = V ′ l x tg φ R N + Ω sin φ (11)
e) C l ′ p 的求解
C l ′ p 满足方程
C l ′ p = − ω ′ l C l ′ p + C l ′ p ω ′ p C l ′ p ( 0 ) = C l i ( 0 ) (12)
此时,用解算的速度计算“数学平台”相对于惯性空间的角速度,不断求解变换矩阵 C l ′ p ,使得速度误差逐渐趋于零这个过程,也就是 C l ′ p 趋于 C l p 的过程。在这个过程中,重力分量的调节过程如图4所示。精对准的调整过程就是不断使 C l ′ p 趋于 C l p 的过程,当调整结束时认为已经精确的确定了矩阵 C l p ( 0 ) ,相当于“数学平台”已经得到了对准 [
图4. 初始对准中重力分量变化过程
如果考虑到系统的干扰如陀螺壳体旋转、加速度计的非线性、框架随动的跟踪误差等因素。系统的初始对准将无法达到2.3节中所述效果,故采用H∞控制技术设计初始对准。同经典分析方法类似,把水平对准和方位对准分开来考虑。以水平回路为例讨论,系统的方块如图5所示。
图5. 水平对准方块图
{ α ( t ) = ω s Δ A i x sin ( Ω t ) − ω s Δ A i y cos ( Ω t ) + ω s Δ A i y cos ( ω s t ) − sin ( ω s t ) Ω Δ A i x − sin ( ω s t ) cos ( φ ) Δ A i z ω s 2 + sin ( ω s t ) cos ( φ ) Δ A i z Ω 2 / R / ω s / ( ω s 2 − Ω 2 ) β ( t ) = − sin ( φ ) ( Δ A i x cos ( ω s t ) ω − Δ A i x cos ( Ω t ) ω + Ω Δ A i y sin ( ω t ) − Δ A i y sin ( Ω t ) ω ) / ( R ω ( ω 2 − Ω 2 ) ) γ ( t ) = ( sin ( ω s t ) Ω Δ A i x − ω s Δ A i x sin ( Ω t ) − ω s Δ A i y cos ( ω s t ) + ω s Δ A i y cos ( Ω t ) ) / R / ω s / ( ω s 2 − Ω 2 ) (13)
在空间稳定惯性导航中,系统加速度计零偏为常值时造成的“数学平台”误差角如式(13)所述。如果考虑系统中壳体旋转造成的影响为 A sin ( ω t ) ,框架跟踪误差和加速度计的非线性综合考虑为 f ( W z ) 为一高频有界不确定量 [
{ Δ A i x = Δ A i x 0 + A x sin ω t + f ( W x ) Δ A i y = Δ A i y 0 + A y sin ω t + f ( W y ) Δ A i z = Δ A i z 0 + A z sin ω t + f ( W z ) (14)
在基于混合灵敏度的 H ∞ 控制方法要求
‖ W 1 ( s ) S ( s ) W 2 ( s ) T ( s ) ‖ ∞ ≤ 1 (15)
其中 S ( s ) = ( I + G ( s ) ∗ K ( s ) ) − 1 为系统的灵敏度函数,
A = [ − 3.12 × 10 − 3 − 4.05 × 10 − 4 0 0 1 0 0 0 0 1 0 0 0 0 g − 2 × 10 − 3 ] ; B 1 = [ 0 1 ] ; B 2 = [ 1 0 0 0 ] ; C 1 = [ 0 0 0 1 0 0 0 0 ] ; C 2 = [ 0 0 7.3 × 10 − 11 0 ] ; D 11 = [ 0.001 0 ] ;
D 12 = [ 0 ] ; D 22 = [ 0 ] ; D 21 = I .
利用 H ∞ 控制理论,可求得一近似最优控制器:
{ W 1 ( s ) = 36 ( 0.72 s 2 + 0.057 0.72 s + 0.057 2 ) 36 s 2 + 0.057 36 s + 0.057 2 W 2 ( s ) = s 2 0.85 K ( s ) = 5.352 × 10 2 ( s 2 + 0.1673 s + 0.0000062 ) s 3 + 0.1352 s 2 + 0.0183 s + 0.0003 (16)
当方位回路设计时与水平回路相似,
{ W 1 ( s ) = 0.0067 s + 1000 1000 s + 1 W 2 ( s ) = s 3 0.02 3 K ( s ) = 8.743 × 10 − 7 ( s 2 + 0.0043 s + 0.0003 ) s 3 + 0.21 s 2 + 0.00972 s + 0.0007 (17)
仿真比较 H ∞ 控制技术设计的初始对准与传统的初始对准,设陀螺常值漂移: ε x 0 = ε y 0 = ε z 0 = 0.005 ∘ / h ;陀螺与g有关项漂移系数: ε x g = ε y g = ε z g = 0.003 ∘ / h / g ;陀螺与g2有关项漂移系数: ε x g 2 = ε y g 2 = ε z g 2 = 0.006 ∘ / h / g 2 ;加速度计零位: Δ A i x 0 = Δ A i y 0 = Δ A i z 0 = 3 × 10 − 5 g ;壳体的旋转干扰: A sin ω t , A ∈ ( 3.9 , 4.1 ) × 10 − 5 g , ω ∈ ( 0.02554 , 0.02685 ) ;壳体旋转、框架随动等干扰: | f ( W ) | ∈ ( 5 , 8 ) × 10 − 5 g , T ω ( t ) ∈ ( 3.8 , 4.2 ) × 60 s ;平台粗对准后初始不对准角: α 0 = β 0 = γ 0 = 1 8 ′ 。
图6. 两种初始对准方案比较
图6可以看出,在带有干扰的空间稳定型惯导系统初始动态对准中,H∞控制方案与经典控制方案相比,具有两个突出优点:一方面它缩短了对准时间,H∞控制方案在100分钟左右就已经进入了稳态,而经典的控制收敛的效果与H∞控制方案相比,在精度上较差;同时在外界干扰噪声较大的情况下,H∞控制方案方位对准后的波动更小,体现了系统具有较强的鲁棒性。
本文针对空间稳定型惯性导航系统的特点,开展其初始对准的研究。在系统分析和设计阶段,充分考虑被控对象所存在的不确定因素,如空间稳定型惯导系统各框架的“牵连”干涉运动,对精确初始对准带来的影响,因此利用H∞控制技术设计了近似最优控制器,给出了保持系统渐进稳定且满足给定H∞性能指标的充分条件,针对空间稳定型的对准方式,引入了加权函数进行自适应调节,根据空间稳定型惯性导航系统的误差规律,得到了可用于控制输入的未知时滞参数的自适应律。通过仿真实验,验证了H∞控制技术克服系统噪声的不确定等因素的有效性,提升了10%的初始对准精度,同时能够一定程度缩短约系统初始对准时间。
国家科技部重大仪器专项(2013YQ310799)。
付中泽,赵汪洋,王兴岭,王 凯. H∞控制在空间稳定型惯导系统初始对准中的应用Application of H∞ Control to Initial Alignment of Space-Stable Inertial Navigation Systems[J]. 动力系统与控制, 2020, 09(03): 152-160. https://doi.org/10.12677/DSC.2020.93014