惯性导航5参数坐标变换矩阵解算方法技术

本发明专利技术公开了惯性导航5参数坐标变换矩阵解算方法，该方法包括：确定坐标变换矩阵的两行中的5个参数作为实时更新的变量；采用积分公式对5参数微分方程进行积分更新计算得到5个参数在t

【技术实现步骤摘要】
惯性导航5参数坐标变换矩阵解算方法


[0001]本专利技术属于航空、航天
，尤其涉及惯性导航5参数坐标变换矩阵解算方法。

技术介绍

[0002]惯性导航广泛应用于导弹、飞机、舰船和兵器等领域，主要作用是实时确定载体相对导航系的位置、速度和姿态信息。捷联式惯性系统与载体直接固连，通过陀螺仪测量角速度并经数学解算后给出载体坐标系相对导航系的坐标变换矩阵。
[0003]目前，确定姿态信息的方法有方向余弦运动学方程、欧拉
‑
克雷洛夫角运动学方程以及四元数运动学方程。
[0004]在工程中应用较多的四元数参数及其微分方程只有4个，但缺点是该4个参数只是中间变量，还需9个方程以求解出载体坐标系相对导航系的坐标变换矩阵。另外，由四元数描述的坐标变换矩阵与4个参数之间并不是唯一对应的关系，这是因为一个坐标变换矩阵可以对应两组不同的四元数。
[0005]相对而言，欧拉
‑
克雷洛夫角运动学方程只有3个，但在本
《惯性器件(上)》(中国宇航出版社)第46页中，认为用欧拉
‑
克雷洛夫角描述的运动学方程存在奇点，方程会退化。但是，在专利(202010333184.9)中提出了一种基于克雷洛夫角的姿态解算方法，可以实现载体的全姿态运动描述。但面临的问题是，当俯仰角＝90
°
时，进行离散化处理时姿态解算的误差较大，从而导致解算的速度和位置误差较大。
[0006]用方向余弦阵表示两坐标系之间的转动运动关系和姿态矩阵的方法使用方便、直观、易于理解，但缺点是变换矩阵的参数及其微分方程为9个，积分计算量较大。在本
《惯性器件(下)》(中国宇航出版社)第18章中给出了基于方向余弦运动学方程和四元数运动学方程的坐标变换矩阵解算方法。
[0007]在全姿态的前提下，为实现坐标变换矩阵与参数一一对应，同时解决方向余弦阵9个参数过多引起计算量大的问题，需要研究一种新的载体坐标系相对导航系的解算方法，以提高惯性导航和飞行控制的快速性和精度。

技术实现思路

[0008]本专利技术的技术解决问题：克服现有技术的不足，提供惯性导航5参数坐标变换矩阵解算方法，以正交安装于捷联式惯性系统本体上的陀螺仪输出的角速率作为坐标变换矩阵5个参数运动学方程的输入信息，通过积分解算、归一化和正交化处理，实现惯性导航坐标变换矩阵的实时更新，在解算过程中不出现奇异值，保证了本体坐标系相对导航坐标系的全姿态、计算量小的要求。
[0009]本专利技术的技术方案为：
[0010]本专利技术公开了惯性导航5参数坐标变换矩阵解算方法，包括：
[0011]计算得到捷联式导航系统本体坐标系相对导航坐标系在t
k
时刻的坐标变换矩阵；
[0012]计算在t
k
时刻本体坐标系相对于导航坐标系的角速度；
[0013]从所述坐标变换矩阵中选取5个参数；
[0014]根据所述坐标变换矩阵和角速度，对所述5个参数进行更新解算，得到更新后的坐标变换矩阵；
[0015]根据所述更新后的坐标变换矩阵，进行速度更新和位置更新。
[0016]进一步地，在上述解算方法中，所述计算得到捷联式导航系统本体坐标系相对导航坐标系在t
k
时刻的坐标变换矩阵，具体为：
[0017][0018]式中，a
11,k
、a
12,k
、a
13,k
、a
21,k
、a
22,k
、a
23,k
、a
31,k
、a
32,k
和a
33,k
为在t
k
时刻坐标变换矩阵的9个参数。
[0019]进一步地，在上述解算方法中，计算在t
k
时刻本体坐标系相对于导航坐标系的角速度，具体为：
[0020][0021]其中，分别为本体x、y、z轴上的角速度。
[0022]进一步地，在上述解算方法中，所述从坐标变换矩阵中选取9个参数中的5个参数，具体为：
[0023]选取坐标变换矩阵中a
13,k
、a
23,k
和a
33,k
的绝对值中最大值在中对应的行中3个元素，以及最小值在中对应的行中其它2个元素作为5个参数。
[0024]进一步地，在上述解算方法中，根据所述坐标变换矩阵和角速度，对所述5个参数进行更新解算，并解算出更新后的坐标变换矩阵，具体为：
[0025]当|a
13,k
|最大、|a
23,k
|最小时，选取5个参数a
11,k
、a
12,k
、a
13,k
、a
21,k
和a
22,k
；在下一时刻t
k+1
＝t
k
+ΔT经积分后的值b
11,k+1
、b
12,k+1
、b
13,k+1
、b
21,k+1
和b
22,k+1
；
[0026]当|a
13,k
|最大、|a
33,k
|最小时，选取5个参数a
11,k
、a
12,k
、a
13,k
、a
31,k
和a
32,k
；在下一时刻t
k+1
＝t
k
+ΔT经积分后的值b
11,k+1
、b
12,k+1
、b
13,k+1
、b
31,k+1
和b
32,k+1
；
[0027]当|a
23,k
|最大、|a
13,k
|最小时，选取5个参数a
11,k
、a
12,k
、a
21,k
、a
22,k
和a
23,k
；在下一时刻t
k+1
＝t
k
+ΔT经积分后的值b
11,k+1
、b
12,k+1
、b
21,k+1
、b
22,k+1
和b
23,k+1
；
[0028]当|a
23,k
|最大、|a
33,k
|最小时，选取5个参数a
21,k
、a
22,k
、a
23,k
、a
31,k
和a
32,k
；在下一时刻t
k+1
＝t
k
+ΔT经积分后的值b
21,k+1
、b
22,k+1
、b
2本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.惯性导航5参数坐标变换矩阵解算方法，其特征在于，包括：计算得到捷联式导航系统本体坐标系相对导航坐标系在t
k
时刻的坐标变换矩阵；计算在t
k
时刻本体坐标系相对于导航坐标系的角速度；从所述坐标变换矩阵中选取5个参数；根据所述坐标变换矩阵和角速度，对所述5个参数进行更新解算，得到更新后的坐标变换矩阵；根据所述更新后的坐标变换矩阵，进行速度更新和位置更新。2.根据权利要求1所述的惯性导航5参数坐标变换矩阵解算方法，其特征在于：所述计算得到捷联式导航系统本体坐标系相对导航坐标系在t
k
时刻的坐标变换矩阵，具体为：式中，a
11,k
、a
12,k
、a
13,k
、a
21,k
、a
22,k
、a
23,k
、a
31,k
、a
32,k
和a
33,k
为在t
k
时刻坐标变换矩阵的9个参数。3.根据权利要求1所述的惯性导航5参数坐标变换矩阵解算方法，其特征在于：计算在t
k
时刻本体坐标系相对于导航坐标系的角速度，具体为：其中，分别为本体x、y、z轴上的角速度。4.根据权利要求2所述的惯性导航5参数坐标变换矩阵解算方法，其特征在于：所述从坐标变换矩阵中选取9个参数中的5个参数，具体为：选取坐标变换矩阵中a
13,k
、a
23,k
和a
33,k
的绝对值中最大值在中对应的行中3个元素，以及最小值在中对应的行中其它2个元素作为5个参数。5.根据权利要求2所述的惯性导航5参数坐标变换矩阵解算方法，其特征在于：根据所述坐标变换矩阵和角速度，对所述5个参数进行更新解算，并解算出更新后的坐标变换矩阵，具体为：当|a
13,k
|最大、|a
23,k
|最小时，选取5个参数a
11,k
、a
12,k
、a
13,k
、a
21,k
和a
22,k
；在下一时刻t
k+1
＝t
k
+ΔT经积分后的值b
11,k+1
、b
12,k+1
、b
13,k+1
、b
21,k+1
和b
22,k+1
；当|a
13,k
|最大、|a
33,k
|最小时，选取5个参数a
11,k
、a
12,k
、a
13,k
、a
31,k
和a
32,k
；在下一时刻t
k+1
＝t
k
+ΔT经积分后的值b
11,k+1
、b
12,k+1
、b
13,k+1
、b
31,k+1
和b
32,k+1
；当|a
23,k
|最大、|a
13,k
|最小时，选取5个参数a
11,k
、a
12,k
、a
21,k
、a
22,k
和a
23,k
；在下一时刻t
k+1
＝t
k
+ΔT经积分后的值b
11,k+1
、b
12,k+1
、b
21,k+1
、b
22,k+1
和b
23,k+1
；当|a
23,k
|最大、|a
33,k
|最小时，选取5个参数a
21,k
、a
22,k
、a
23,k
、a
31,k
和a
32,k
；在下一时刻t
k+1
＝t
k
+ΔT经积分后的值b
21,k+1
、b
22,k+1
、b
23,k+1
、b
31,k+1
和b
32,k+1
；当|a
33,k
|最大、|a
13,k
|最小时，选取5个参数a
11,k
、a
12,k
、a
31,k
、a
32,k
和a
33,k
；在下一时刻t
k+1
＝t
k
+ΔT经积分后的值b
11,k+1
、b
12,k+1
、b
31,k+1
、b
32,k+1
和b
33,k+1
；当|a
33,k
|最大、|a
23,k
|最小时，选取5个参数a
21,k
、a
22,k
、a
31,k
、a
32,k
和a
33,k
；在下一时刻t
k+1
＝t
k
+ΔT经积分后的值b
21,k+1
、b
22,k+1
、b
31,k+1
、b
32,k+1
和b
33,k+1
；其中，ΔT为采样时间。6.根据权利要求5所述的惯性导航5参数坐标变换矩阵解算方法，其特征在于：当|a
13,k
|最大、|a
23,k
|最小时，选取5个参数a
11,k
、a
12,k
、a
13,k
、a
21,k
和a
22,k
；在下一时刻t
k+1
＝t
k
+ΔT经积分后的值b
11,k+1
、b
12,k+1
、b
13,k+1
、b
21,k+1
和b
22,k+1
，具体计算公式为：把b
11,k+1
、b
12,k+1
、b
13,k+1
、b
21,k+1
和b
22,k+1
代入下式，求解出t
k+1
时刻的a
11,k+1
、a
12,k+1
、a
13,k+1
、a
21,k+1
和a
22,k+1
值，以及从导航坐标系至本体坐标系的坐标变换矩阵为：式中，式中，式中，式中，式中，7.根据权利要求5所述的惯性...

【专利技术属性】
技术研发人员：魏宗康，
申请(专利权)人：北京航天控制仪器研究所，
类型：发明
国别省市：