基于平台调制的半解析式惯导系统高纬度工作研究
Research on High-Latitude Work of Semi-Analytical Inertial Navigation System Based on Platform Modulation
摘要: 针对高纬度地区经线收敛导致以真北向作为航向参考的导航算法失效的问题,并结合半解析式惯导系统中传统机械编排方法在极区工作的性能分析,由于采用当地水平指北机械编排方法的惯性导航系统在极区工作时方位轴陀螺施矩困难的问题,详细介绍了方位轴陀螺施矩特殊的惯性导航系统机械编排方法,即游移方位惯性导航系统。本文提出了以惯性平台垂直轴调制的半解析式惯导系统为研究对象,对比传统的半解析式惯导系统在高纬度工作模式,具有平台调制作用的半解析式惯导系统能够调制水平陀螺和水平加速度计零位误差,避免惯导导航误差的发散。本文推导了基于惯性平台垂直轴调制的半解析式惯导系统高纬度机械编排方法,提出了基于格网导航力学编排的极区导航算法。通过对两种导航机械编排的工作原理的分析和仿真验证,建立具有平台调制功能的半解析式惯导极区导航方案。
Abstract: Aiming at the problem that meridian convergence in high latitude area leads to the failure of navigation algorithm with true north direction as heading reference, combined with the performance analysis of the traditional mechanical arrangement method in the polar region of the semi-analytical inertial navigation system, taking the problem that azimuth axis gyrotorquing under the inertial navigation system with local horizontal north pointing mechanical arrangement method is difficult to work in the polar region as an example, the special mechanical arrangement method of the inertial navigation system with azimuth axis gyrotorquing, i.e. wandering azimuth inertial navigation system, is introduced in detail. This paper proposes a semi-analytical inertial navigation system with vertical axis modulation of the inertial platform as the research object. Compared with the traditional semi-analytical inertial navigation system at high latitudes, the semi-analytical inertial navigation system with platform modulation function can modulate the zero bias error of the horizontal gyroscope and the horizontal accelerometer to avoid the divergence of the inertial navigation error. This paper deduces the high-latitude mechanical arrangement method of the semi-analytical inertial navigation system based on the vertical axis modulation of the inertial platform and proposes a polar region navigation algorithm based on the grid navigation mechanics arrangement. Through the analysis and simulation verification of the working principles of the two kinds of navigation mechanical arrangements, a semi-analytical inertial navigation scheme with a platform modulation function is established.
文章引用:赵汪洋, 官小莎, 张广拓, 宋高玲, 王远明. 基于平台调制的半解析式惯导系统高纬度工作研究[J]. 动力系统与控制, 2021, 10(4): 211-220. https://doi.org/10.12677/DSC.2021.104022

1. 引言

对于极区的定义,不同国家、不同地区对极区定义不同。如美国联邦航空管理局(FAA)定义北纬78˚以北为北极地区,而波音公司进入84˚以北或南纬84˚以南定义为极区飞行,进入北纬83.5˚以南或南纬83.5度以北定义为穿出极区,MD-11客机以北纬85˚和南纬85˚作为进入和穿出极区的分界线。极区惯性导航技术作为一门惯性导航技术专门研究,是因为在传统的以指北方位作为导航坐标系的惯性导航系统中,经纬度地理坐标和方位角解算机械编排是关于纬度的余弦和正切的三角函数,解算误差会随纬度的升高呈指数倍变大,纬度接近或通过极点时将会导致惯导系统解算奇异。相对于传统惯导系统解算方案只适用于低纬度导航的局限性,研究的极区惯性导航方案可使惯导系统工作于全纬度范围,实现舰艇全球海域作战任务的需求 [1] [2]。

2. 半解析式惯导工作原理

2.1. 半解析式惯导系统平台结构及功能

惯性平台导航系统由装有陀螺仪和加速度计的台体及框架系统组成。由于载体具有三个转动的自由度,所以平台系统至少要有三个环,才能保证将台体与载体的运动相隔离,不受运载体影响,而在惯性空间始终保持要求的姿态。作为惯性导航系统的稳定平台,一般情况下至少由三个框架和三个稳定伺服回路(纵摇、横摇及方位稳定回路)所组成。因为要实现平台轴不受干扰的跟踪与地球有关的坐标系,如地理坐标系,就必须有相互垂直的三个轴。舰船三环半解析式惯性平台的一种结构形式如图1所示 [3]。

Figure 1. Schematic diagram of semi-analytical inertial navigation system

图1. 半解析式惯性系统示意图

在稳定回路和修正回路同时工作时,惯性平台能准确地模拟当地地理坐标系,给出舰船的水平角和航向角等基准信息;通过惯导计算机给出舰船的速度、位置,完成导航定位。

2.2. 平台系统伺服回路的耦合

载体的横滚、俯仰及偏航运动,三轴平台系统的框架轴实际上不是相互正交的,而且,由于台体与载体运动的隔离,框架轴与平台参考坐标系轴也是不平行的。以单自由度陀螺仪的平台系统为例,如图2所示。

Figure 2. Schematic diagram of platform frame in neutral position

图2. 中立位置的平台框架示意图

当平台框架处于中立位置,这时若需要平台 X p 轴以角速度 ω p x 转动,须向 G x 陀螺仪施加一定控制信号,并把其输出信号经伺服放大器输入装在 X i 轴上的力矩电机,使平台以角速度 ω i x = ω p x 转动。如载体航向变化为k时,这时绕 X p Y p 轴转动的角速度分别为 ω p x ω p y ;那么, ω p x ω p y X I Y 0 轴上的投影为

ω i x = ω p x cos k ω p y sin k ω 0 y = ω p x sin k + ω p y cos k } (1)

可见,载体的航向变化,使得陀螺仪输入轴和装在框架轴上的力矩电机轴不平行,因而所需平台绕陀螺仪输入轴的运动必须由绕两根框架轴的运动来保证。那么, X I Y 0 轴上的力矩电机所产生的控制角度由式(1)决定。而平台沿 X p Y p 轴的角速度如式(2)所示 [4]。

ω p x = ω i x cos k + ω 0 y sin k ω p y = ω i x sin k + ω 0 y cos k ω p z = ω p z } (2)

平台坐标系相对于惯性坐标系的坐标变化矩阵,由式(2)可得

C P I = [ cos k sin k 0 sin k cos k 0 0 0 1 ] (3)

3. 游移方位编排

游移方位惯性导航系统的导航坐标系为游移坐标系,仍使用n系表示。在游移方位坐标系中,在方位轴方向上只对方位陀螺施加补偿地球自转角速度垂直分量的控制力矩。惯性导航系统中的导航坐标系n系的 y n 轴相对地球围绕 z e 轴的角速度为零,定义 y n 轴与真北方向的夹角为游移方位角 α ,且会随时间变化。如图3所示:

Figure 3. Walking azimuth inertial navigation system coordinate system

图3. 游移方位惯性导航系统的导航坐标系

图3可知从地理坐标系t系到导航坐标系n系的方向余弦矩阵可以表示为:

C t n = [ cos α sin α 0 sin α cos α 0 0 0 1 ] (4)

导航坐标系n系与地球坐标系e系之间存在转换关系如下:

[ x n y n z n ] = [ x e y e z e ] C e n (5)

式(5)中, C e n 为由e系到n系的方向余弦矩阵,且具体表达式为:

C e n = C t n C e t = [ cos α sin α 0 sin α cos α 0 0 0 1 ] [ sin λ cos λ 0 sin L cos λ sin L sin λ cos L cos L cos λ sin λ sin L ] = [ cos α sin λ sin α sin L cos λ cos α cos λ sin α sin L sin λ sin α cos L sin α sin λ cos α sin L cos λ sin α cos λ cos α sin L sin λ cos α cos L cos L cos λ cos L sin λ sin L ] = [ C 11 C 12 C 13 C 21 C 22 C 23 C 31 C 32 C 33 ] (6)

式(6)中包含可以确定载体位置的纬度L、经度 λ 的信息与游移方位角 α 的函数,所以由该式进行解算可以得到载体纬度L、经度 λ 和游移方位角 α 的主值:

{ λ = arctan C 32 C 31 L = arcsin C 33 α = arctan C 13 C 23 (7)

ω i e n = C e n ω i e e = [ C 11 C 12 C 13 C 21 C 22 C 23 C 31 C 32 C 33 ] [ 0 0 Ω ] = [ C 13 Ω C 23 Ω C 33 Ω ] = [ Ω sin α cos L Ω cos α cos L Ω sin L ] (8)

此外,根据导航坐标系n系和地理坐标系t系之间的关系可知载体的水平速度分量在n系和t系上的投影之间的关系为:

[ V E V N ] = [ cos α sin α sin α cos α ] [ V x V y ] = [ V x cos α V y sin α V x sin α + V y cos α ] (9)

其中, V x V y 为载体在游移方位坐标系中的水平速度 [5]。

则数学平台的旋转角速度 ω e n n 为:

ω e n n = [ cos α sin α 0 sin α cos α 0 0 0 1 ] [ V N R M V E R N 0 ] = [ cos α sin α 0 sin α cos α 0 0 0 1 ] [ V x sin α + V y cos α R M V x cos α V y sin α R N 0 ] = [ V x sin α cos α ( 1 R M 1 R N ) V y ( cos 2 α R M sin 2 α R N ) V x ( cos 2 α R M + sin 2 α R N ) + V y sin α cos α ( 1 R M 1 R N ) 0 ] (10)

根据式(9)、(10)可以进一步得到惯性导航系统的平台指令角速度 ω i n n 为:

ω i n n = ω i e n + ω e n n = [ Ω sin α cos L V x sin α cos α ( 1 R M 1 R N ) V y ( cos 2 α R M sin 2 α R N ) Ω cos α cos L + V x ( cos 2 α R M + sin 2 α R N ) + V y sin α cos α ( 1 R M 1 R N ) Ω sin L ] = [ ω i n x n ω i n y n ω i n z n ] (11)

位置矩阵 C e n 的方向余弦矩阵的微分方程为:

[ C ˙ 11 C ˙ 12 C ˙ 13 C ˙ 21 C ˙ 22 C ˙ 23 C ˙ 31 C ˙ 32 C ˙ 33 ] = [ 0 0 ω e n y n 0 0 ω e n x n ω e n y n ω e n x n 0 ] [ C 11 C 12 C 13 C 21 C 22 C 23 C 31 C 32 C 33 ] (12)

利用式(10)可以对位置矩阵进行即时的更新,然后通过式(11)得到载体的位置信息和游移方位角信息。

在游移方位机械编排中,惯性导航系统的导航解算方程可以写为:

V ˙ = f n ( 2 ω i e n + ω e n n ) × V + g n (13)

利用 C b n 可以获得载体的横摇角 ϕ 、纵摇角 θ 及航向角 ψ ,但是航向角 ψ 是b系的 y b 轴和n系的 y n 轴之间的夹角,中间还有一个游移方位角 α ,所以真正的航向角为:

ψ = ψ + α (17)

游移方位角的数学模型如下:

α ˙ = Ω sin L ( Ω sin L + V E R N tan L ) = V E R N tan L (18)

由式(18)可以看出,当载体只存在北向速度或静止时,游移方位角 α 保持不变;只有当载体存在东向速度时,游移方位角才会变化(赤道除外) [6]。

综上所述,可以得到游移方位惯性导航系统的机械编排框图如图4所示。

Figure 4. Mechanical layout block diagram of walking azimuth inertial navigation system

图4. 游移方位惯性导航系统机械编排框图

根据游移方位惯性导航系统的工作原理可知,游移方位惯性导航系统的机械编排由于方位轴陀螺不需要施矩,所以可以解决当地水平指北方位惯性导航系统在高纬度地区工作时遇到的部分问题中。但是在地理极点处,没有了北向基准,所以游移方位角失去意义。当纬度接近90˚时游移方位角在极点处的变化率趋于无穷大,所以游移方位机械编排惯性导航系统与当地水平指北系统一样不能在地理极点附近使用 [6] [7]。

4. 基于惯性平台调制的高纬度工作方案

旋转调制技术在捷联惯导方案中已经使用较为广泛,通过惯性平台的旋转调制实现惯性元件的自补偿。在一般的捷联惯导系统中,对水平陀螺进行旋转调制需要在平台增加转动结构和测角机构,使其满足平台调制的旋转功能。在半解析式系统中,由于已经具有了隔离载体的物理惯性平台,因此在增加垂直轴调制作用时,仅仅需要对机械编排的方案机械更改,通过对垂向陀螺增加一个附加角速度的控制来完成。

与捷联惯导系统的旋转调制不同在于,捷联惯导系统的旋转调制通常采用“正反停”调制方案,以减少由于光学陀螺标度带来的影响;但是在半解析式惯导系统中,由于采用的是机械陀螺,若采用与捷联惯导类似的调制方案,将导致机械陀螺在“转停”切换过程中,引起陀螺转速失衡,极大影响机械陀螺漂移稳定性。因此在半解析式惯导系统的水平陀螺调制技术中,采用的是绕垂直轴匀速旋转的调制方案,考虑到机械陀螺对惯性平台的施矩承受能力,采用60˚/小时的匀速调制方案,即惯性平台6小时调制一周。具有平台调制功能的半解析式惯性导航系统的机械编排方案如图5所示。

Figure 5. Semi-analytical high latitude mechanical arrangement of inertial navigation with rotation modulation of inertial platform

图5. 基于惯性平台旋转调制的半解析式惯导高纬度机械编排

当惯性平台调制后,取得的调制后的方位角变换如下:

k ( t ) = k 0 0 t ( Ω sin φ + ω T Z sin φ + V x R tan φ ) d t (19)

其中, ω T Z = 1 / s 的惯性平台调制周期。

调制后陀螺的水平分解为:

[ ω k p x ω k p y ] = [ cos k sin k sin k cos k ] [ ω c x ω c y ] (20)

惯性平台调制后,附加的惯性平台施矩量为:

δ C ˙ e p = Ω p e δ C e p (21)

Ω p e = Ω e p = [ 0 0 ω e p y 0 0 ω e p x ω e p y ω e p x 0 ] (22)

其中, Ω p e 是平台坐标系相对于地球坐标系变化角速率 ω p e 的斜对称矩阵。

ω e p 有如下关系:

[ ω e p x ω e p y ] = [ 1 R p x 1 ξ k 1 ξ k 1 R p y ] [ V p x V p y ] (23)

其中, R p x R p y 为惯性平台旋转调制的曲率半径, ξ k 为调制挠率。

在调制情况下,曲率半径和挠率由式(24)得到:

{ 1 R p x = cos 2 k R M + sin 2 k R N 1 R p y = sin 2 k R M + cos 2 k R N 1 ξ k = ( 1 R N 1 R M ) sin k cos k (24)

平台的控制指令如式(25):

{ ω e p x ( t ) = C 13 Ω + ω e p x ( t 1 ) ω e p y ( t ) = C 23 Ω + ω e y x ( t 1 ) (25)

速度计算由速度方程得到式(26):

{ V ˙ p x = A p x + Ω C 33 V p y V ˙ p y = A p y Ω C 33 V p x (26)

基于惯性平台调制的半解析式惯导系统,在不改动硬件基础的条件下,通过对垂向陀螺施加附加力矩,以系统调制技术提高传统半解析式惯导系统在高纬度的导航精度。

5. 格网导航

无论是传统的半解析式惯导系统还是具有平台调制功能的半解析式惯导系统,在格网平面内的“显示输出”是统一的。

设P点地理纬度、经度和高度分别为L、 λ 和h,格网坐标系和地理坐标系间的方向余弦矩阵 C g G 为:

C g G = [ cos σ sin σ 0 sin σ cos σ 0 0 0 1 ] (27)

式中:

σ :格网角。

载体系与格网系之间的方向余弦阵为

C b G = C g G C b n = [ × sin ( ψ σ ) cos θ × × cos ( ψ σ ) cos θ × sin γ cos θ sin θ cos γ cos θ ] (28)

式中:

ψ :地理航向;

θ :纵摇角;

γ :横摇角;

格网航向 ψ

ψ = ψ σ (29)

在极区, σ 不易求,因此真北航向同样难以得到。但格网航向 ψ 容易得到,它是以格网北向作为航向参考基准的,避免了相对经线汇聚带来的定向困难,所以格网航向在极区内可以用作导航 [8]。

6. 极区导航输出

以游移方位力学编排作为执行全球导航解算的内核,惯导工作时平台(或数学平台)内的方位轴仅跟踪地球旋转,不再始终指向地理正北,解决了计算方位指令加速度时带来的计算溢出问题;将游移坐标系内的速度和方位投影到地理系内,得到常规地理真北航向和地理东北天速度;同时又将游移系内的速度和方位投影到横向坐标系内,得到横向地理坐标系下的航向、东北天速度和位置。设计进入和穿出极区的判别逻辑,根据纬度确定状态切换的判定值,在高纬度地区惯导实现地理系导航参数和横坐标系导航参数的平稳切换。

极区导航的机械编排如图6所示。在游移方位坐标系内,完成姿态余弦矩阵 C b w 、位置余弦矩阵 C e w 和游移系速度 v w 的更新计算;由于游移坐标系内解算方位仅跟踪地球旋转,规避了地理坐标系内解算的溢出问题,因此能够进行全球解算更新。完成游移坐标系内的导航解算更新后,进行坐标变换,得到地理系和横向坐标系的姿态、速度和位置,最后根据纬度进行判断,在极区时,输出横向地理坐标系的导航参数,否则输出常规地理坐标系的导航参数 [9] [10]。

Figure 6. Polar navigation mechanical layout

图6. 极区导航机械编排

为比较基于平台调制的半解析式惯导系统与传统半解析式惯导系统在高纬度工作的导航性能,设定仿真条件如下:初始位置 φ 0 = 45 , λ 0 = 117 ,以 V n = 5 K n 匀速向北极航行,其中陀螺常值漂移 ε x 0 = ε y 0 = 0.003 / h ε z 0 = 0.001 / h ,加速度计零偏 Δ A x 0 = Δ A y 0 = Δ A z 0 = 3 × 10 5 g ,则在两套系统在纬度变换的过程中,航向误差仿真结果如表1所示。

Table 1. Heading error comparison

表1. 航向误差对比

从仿真对比可以看出,基于惯性平台调制技术半解析式惯导系统利用系统技调制术,在一定能程度补偿了陀螺及加速度计的常值误差,这种补偿效果同样适用于高纬度的情况,较大程度地提高半解析式惯导系统高纬度航向精度,提升了半解析式惯导系统的高纬度工作性能。

7. 结论

本文以基于垂直轴调制的半解析式惯导系统为研究对象,分析了高纬度惯导系统的工作特点以及高纬度极区导航算法,开展了基于平台调制的半解析式惯导系统技术研究,提出了具有平台调制功能的半解析惯导系统在高纬度导航方法,对比传统的半解析式惯导系统在高纬度工作模式,通过仿真分析了基于惯性平台调制下半解析式惯导系统与传统半解析式惯导系统在高纬度的航向精度,验证了其在高纬度工作性能的优势。

参考文献

[1] Yao, Y. (2016) Transverse Navigation under the Ellipsoidal Earth Model and Its Performance in Both Polar and Non-Polar Areas. Journal of Navigation, 69, 335-352.
https://doi.org/10.1017/S0373463315000715
[2] Li, Q., Ben, Y.Y. and Yu, F. (2015) System Reset of Transversal Strapdown INS for Ship in Polar Region. Measurement, 60, 247-257.
https://doi.org/10.1016/j.measurement.2014.10.020
[3] Goshen-Meskin, D. and Bar-Itzhack, I.Y. (1992) Observability Analysis of Piece-Wise Constant Systems. I. Theory. IEEE Transactions on Aerospace and Electronic Systems, 28, 1056-1067.
https://doi.org/10.1109/7.165367
[4] 周凌峰, 赵小明, 翁海娜, 等. 基于惯导误差的多波束测深精度分析[J]. 中国惯性技术学报, 2013, 21(6): 758-762.
[5] Xiong, Z., Chen, H.M. and Yu, F. (2010) Research of Airborne INS/STAR Integrated Algorithm Coupled with Position Error. Journal of Astronoutis, 31, 2683-2690.
[6] 高钟毓. 惯性导航系统技术[M]. 北京: 清华大学出版社, 2012: 203-230.
[7] Chen, W.X., Wang, L., Zheng, T., et al. (2017) Research on Calibration Method of Installation Error of Star Sensor in Inertial Platform. Navigation and Control, 16, 71-75.
[8] Greenaway, K.R. and Gates, M.D. (2009) Polar Air Navigation—A Record. Art Bookbindery, Canada.
[9] Kong, X.-W., Guo, M.-F. and Dong, J.-X. (2010) Observability and Maneuvering for Rapid Transfer Alignment of Strapdown Inertial Navigation System. Journal Tsinghua University (Sci & Tech), 50, 232-236.
[10] 杨波, 王跃刚, 单斌, 等. 长航时环境下高精度组合导航方法研究与仿真[J]. 宇航学报, 2011, 32(5): 1054-1059.