多姿态测量设备相对安装误差标定及补偿方法、系统技术方案

本发明专利技术提供一种多姿态测量设备相对安装误差标定及补偿方法、系统，涉及航天技术领域，包括：步骤S1：测量星敏感器姿态并转换坐标；步骤S2：标定高精度惯导和星敏感器相对安装误差；步骤S3：标定高精度惯导和低精度惯导自对准相对安装误差；步骤S4：补偿相对安装误差。本发明专利技术利用惯性导航静态自对准，星敏感器静态姿态测量在静态时对高精度惯测组合、低精度惯测组合和星敏感器间相对安装误差进行标定和补偿，以实现动态下多源组合导航信息融合时空间姿态基准一致性。姿态基准一致性。姿态基准一致性。

【技术实现步骤摘要】
多姿态测量设备相对安装误差标定及补偿方法、系统


[0001]本专利技术涉及航天
，涉及一种惯导和星敏多姿态测量设备相对安装误差快速标定及补偿方法，具体为一种用于多源组合导航的多个不同类型姿态测量设备通过姿态测量算法实现相对安装误差的快速标定及补偿方法，尤其涉及一种多姿态测量设备相对安装误差标定及补偿方法、系统。

技术介绍

[0002]目前，多源组合导航已经在航天、航空、无人驾驶、水下导航、室内定位等生活中各个场景广泛应用，多源组合时往往需要对多种传感器(高、低精度惯导、星敏感器、磁罗盘)测量的姿态进行融合，然而各个传感器的安装位置和安装基准通常不一致，测量出的姿态无法直接融合，因此，在多源组合导航前，首先需要对不同姿态测量传感器的相对安装误差进行标定和补偿。
[0003]传统的标定方法往往通过在各个传感器上安装棱镜或立方镜，通过经纬仪或光电自准直仪测量相对安装角度误差，这种方法需提前标定棱镜或立方镜与测量坐标系见相对误差，同时，操作较为繁琐，无法快速标定和补偿。

技术实现思路

[0004]针对现有技术中的缺陷，本专利技术提供一种多姿态测量设备相对安装误差标定及补偿方法、系统。
[0005]根据本专利技术提供的一种多姿态测量设备相对安装误差标定及补偿方法、系统，所述方案如下：
[0006]第一方面，提供了一种多姿态测量设备相对安装误差标定及补偿方法，所述方法包括：
[0007]步骤S1：测量星敏感器姿态并转换坐标；
[0008]步骤S2：标定高精度惯导和星敏感器相对安装误差；
[0009]步骤S3：标定高精度惯导和低精度惯导自对准相对安装误差；
[0010]步骤S4：补偿相对安装误差。
[0011]优选地，所述步骤S1包括：
[0012]载体平台X轴垂直朝天，星敏感器在夜间垂直朝天进行姿态测量，获得星敏本体系至J2000惯性系姿态四元数
[0013]根据获得的星敏本体系至J2000惯性系姿态转换为星敏本体系至北天东坐标系姿态阵具体转换过程如下：
[0014]首先，由星敏本体系至J2000惯性系姿态四元数构建姿态阵为：
[0015][0016]式中，q0、q1、q2、q3为星敏本体系至J2000惯性系姿态四元数的四个元素；
[0017]其次，J2000惯性系至地球坐标系转换矩阵为：
[0018][0019]式中，A为准地固坐标系与地球坐标系之间的转换矩阵，B为地球自转转换矩阵，C章动转换矩阵，D为岁差转换矩阵；
[0020]最后，星敏本体系至J2000惯性系姿态阵转换为星敏本体系至北天东坐标系姿态阵转换过程为：
[0021][0022]其中，
[0023]式中，地球系至导航系转换矩阵，λ为载体经度，L为载体纬度。
[0024]优选地，所述步骤S2包括：
[0025]载体平台X轴垂直朝天，星敏感器X3轴和高精度惯导X1轴均垂直朝天；
[0026]星敏感器按照步骤S1完成姿态测量并获取星敏本体系至北天东坐标系姿态阵
[0027]高精度惯导根据装订的地理参数进行自对准，对准好获取高精度惯导本体系相对北天东坐标系的姿态四元数，以此获取姿态阵：
[0028][0029]式中，q
10
、q
11
、q
12
、q
13
为高精度惯导本体系相对北天东坐标系姿态四元数的四个元素；
[0030]获得高精度惯导本体系X1Y1Z1与星敏感器本体系X3Y3Z3相对安装误差矩阵：
[0031][0032]优选地，所述步骤S3包括：载体平台正常水平放置，高精度惯导Y1轴和低精度惯导Y2轴同时垂直朝天，分别自对准获取高精度惯导俯仰角θ
h
、滚动角γ
h
和低精度惯导俯仰角θ
l
、滚动角γ
l
；
[0033]载体平台滚转90
°
水平放置，高精度惯导Z1轴和低精度惯导Z2轴同时垂直朝天，分别自对准获取高精度惯导俯仰角θ
h
'和低精度惯导俯仰角θ
l
'；
[0034]载体平台滚转90
°
水平放置时高、低精度惯导俯仰角为载体平台正常水平放置时的高、低精度惯导偏航角，即：
[0035]ψ
h
＝θ
h
'
[0036]ψ
l
＝θ
l
'
[0037]根据高、低精度惯导俯仰角、滚动角和偏航角计算高、低精度惯导本体系相对北天东坐标系的姿态矩阵：
[0038][0039][0040]根据高、低精度惯导本体系相对北天东坐标系的姿态矩阵计算出高精度惯导本体系X1Y1Z1与低精度惯导本体系X2Y2Z2相对安装误差矩阵：
[0041][0042]优选地，所述步骤S4包括：
[0043]多源组合导航系统以高精度惯导本体坐标系作为坐标基准；
[0044]通过相对安装误差矩阵补偿，将低精度惯导实时动态测量的姿态矩阵投影至高精度惯导本体坐标系相对北天东坐标系的姿态矩阵：
[0045][0046]式中：为补偿安装误差后低精度惯导实时动态测量的姿态矩阵；
[0047]由姿态阵提取补偿后俯仰角、滚动角和偏航角用于多源组合导航信息融合；
[0048]通过相对安装误差矩阵补偿，将星敏感器实时动态测量的姿态矩阵投影至高精度惯导本体坐标系相对北天东坐标系的姿态矩阵：
[0049][0050]式中：为补偿安装误差后星敏感器实时动态测量的姿态矩阵；
[0051]由姿态阵提取补偿后俯仰角、滚动角和偏航角用于多源组合导航信息融合。
[0052]第二方面，提供了一种多姿态测量设备相对安装误差标定及补偿系统，所述系统包括：
[0053]模块M1：测量星敏感器姿态并转换坐标；
[0054]模块M2：标定高精度惯导和星敏感器相对安装误差；
[0055]模块M3：标定高精度惯导和低精度惯导自对准相对安装误差；
[0056]模块M4：补偿相对安装误差。
[0057]优选地，所述模块M1包括：
[0058]载体平台X轴垂直朝天，星敏感器在夜间垂直朝天进行姿态测量，获得星敏本体系至J2000惯性系姿态四元数
[0059]根据获得的星敏本体系至J2000惯性系姿态转换为星敏本体系至北天东坐标系姿态阵具体转换过程如下：
[0060]首先，由星敏本体系至J2000惯性系姿态四元数构建姿态阵为：
[0061][0062]式中，q0、q1、q2、q3为星敏本体系至J2000惯性系姿态四元数的四个元素；
[0063]其次，J2000惯性系至地球坐标系转换矩阵为：
[0064][0065]式中，A为准地固坐标系与地球坐标系之间的转换矩阵，B为地球自转转换矩阵，C章动转换矩阵，D为岁差转换矩阵；本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种多姿态测量设备相对安装误差标定及补偿方法，其特征在于，包括：步骤S1：测量星敏感器姿态并转换坐标；步骤S2：标定高精度惯导和星敏感器相对安装误差；步骤S3：标定高精度惯导和低精度惯导自对准相对安装误差；步骤S4：补偿相对安装误差。2.根据权利要求1所述的多姿态测量设备相对安装误差标定及补偿方法，其特征在于，所述步骤S1包括：载体平台X轴垂直朝天，星敏感器在夜间垂直朝天进行姿态测量，获得星敏本体系至J2000惯性系姿态四元数根据获得的星敏本体系至J2000惯性系姿态转换为星敏本体系至北天东坐标系姿态阵具体转换过程如下：首先，由星敏本体系至J2000惯性系姿态四元数构建姿态阵为：式中，q0、q1、q2、q3为星敏本体系至J2000惯性系姿态四元数的四个元素；其次，J2000惯性系至地球坐标系转换矩阵为：式中，A为准地固坐标系与地球坐标系之间的转换矩阵，B为地球自转转换矩阵，C章动转换矩阵，D为岁差转换矩阵；最后，星敏本体系至J2000惯性系姿态阵转换为星敏本体系至北天东坐标系姿态阵转换过程为：其中，式中，地球系至导航系转换矩阵，λ为载体经度，L为载体纬度。3.根据权利要求1所述的多姿态测量设备相对安装误差标定及补偿方法，其特征在于，所述步骤S2包括：载体平台X轴垂直朝天，星敏感器X3轴和高精度惯导X1轴均垂直朝天；星敏感器按照步骤S1完成姿态测量并获取星敏本体系至北天东坐标系姿态阵高精度惯导根据装订的地理参数进行自对准，对准好获取高精度惯导本体系相对北天东坐标系的姿态四元数，以此获取姿态阵：
式中，q
10
、q
11
、q
12
、q
13
为高精度惯导本体系相对北天东坐标系姿态四元数的四个元素；获得高精度惯导本体系X1Y1Z1与星敏感器本体系X3Y3Z3相对安装误差矩阵：4.根据权利要求3所述的多姿态测量设备相对安装误差标定及补偿方法，其特征在于，所述步骤S3包括：载体平台正常水平放置，高精度惯导Y1轴和低精度惯导Y2轴同时垂直朝天，分别自对准获取高精度惯导俯仰角θ
h
、滚动角γ
h
和低精度惯导俯仰角θ
l
、滚动角γ
l
；载体平台滚转90
°
水平放置，高精度惯导Z1轴和低精度惯导Z2轴同时垂直朝天，分别自对准获取高精度惯导俯仰角θ
h
'和低精度惯导俯仰角θ
l
'；载体平台滚转90
°
水平放置时高、低精度惯导俯仰角为载体平台正常水平放置时的高、低精度惯导偏航角，即：ψ
h
＝θ
h
'ψ
l
＝θ
l
'根据高、低精度惯导俯仰角、滚动角和偏航角计算高、低精度惯导本体系相对北天东坐标系的姿态矩阵：标系的姿态矩阵：根据高、低精度惯导本体系相对北天东坐标系的姿态矩阵计算出高精度惯导本体系X1Y1Z1与低精度惯导本体系X2Y2Z2相对安装误差矩阵：5.根据权利要求4所述的多姿态测量设备相对安装误差标定及补偿方法，其特征在于，所述步骤S4包括：多源组合导航系统以高精度惯导本体坐标系作为坐标基准；通过相对安装误差矩阵补偿，将低精度惯导实时动态测量的姿态矩阵投影至高精度惯导本体坐标系相对北天东坐标系的姿态矩阵：式中：为补偿安装误差后低精度惯导实时动态测量的姿态矩阵；由姿态阵提取补偿后俯仰角、滚动角和偏航角用于多源组合导航信息融合；通过相对安装误差矩阵补偿，将星敏感器实时动态测量的姿态矩阵投影至高精度惯导本体坐标系相对北天东坐标系的姿态矩阵：
式中：为补偿安装误差后星敏感器实时动态测量的姿态矩阵；由姿态阵提取补偿后俯仰角、滚动角和偏航角用于多源组合导航信息融合。6.一种多姿态测量设备相对安装误差标...

【专利技术属性】
技术研发人员：秦峰，王璞，刘伟鹏，崔闪，张迪，袁杰波，
申请(专利权)人：上海机电工程研究所，
类型：发明
国别省市：