CN104501835B - 一种面向空间应用异构imu初始对准的地面试验系统及方法 - Google Patents
一种面向空间应用异构imu初始对准的地面试验系统及方法 Download PDFInfo
- Publication number
- CN104501835B CN104501835B CN201410783930.9A CN201410783930A CN104501835B CN 104501835 B CN104501835 B CN 104501835B CN 201410783930 A CN201410783930 A CN 201410783930A CN 104501835 B CN104501835 B CN 104501835B
- Authority
- CN
- China
- Prior art keywords
- mrow
- mtd
- mtr
- msubsup
- msub
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Secondary Cells (AREA)
- Navigation (AREA)
Abstract
一种面向空间应用异构IMU初始对准的地面试验系统及方法,将多套不同体制的异构IMU同时安装在三轴转台上,驱动转台实现IMU所在飞行器的机动过程,使用转台框架角、转台相对于天东北地理坐标系的姿态,天东北地理坐标系相对于瞬时凝固惯性系的姿态,由远程终端计算出飞行器的惯性姿态。在对GNC控制器完成校时后,将惯性姿态实时发送给GNC控制器。GNC控制器采集IMU的输出数据,同时获取惯性姿态数据,运行星上对准程序,进行对准计算,保证GNC控制器获得的数据与实际在轨飞行过程一致。使用外部光学精瞄标定子系统获得对准参数真值,评估星上系统的对准结果。本发明模拟对准过程的真实性高,可适应对多种对准方法的地面试验,工程实现容易。
Description
技术领域
本发明涉及一种面向空间应用异构IMU初始对准的地面试验系统及方法,属于空间惯性导航技术领域。
背景技术
空间飞行器一般都具备捷联惯性导航系统,为保证系统的可靠性,通常使用不同体制的异构IMU组合,随着空间飞行器的发展,轻型结构日益增多,带来安装变形较大的问题,同时任务对导航精度的要求也越来越高,因此大大增加了GNC系统中初始对准的复杂性,给对准导航系统的地面验证提出了新的挑战。
由于IMU的参数具有多次上电重复性误差、不同体制不同构型IMU的性能差异、轻型舱段结构的变形量未知等因素,因此传统一次对准的导航初始化方式精度较差,导致惯导系统初值不准。对此,各种初始对准方法发展起来。这些方法都要求载体进行适当的姿态机动,同时需要获取安装在不同舱段上的其它敏感器的姿态信息,并且具有严格的时序关系,需要对准的参数也相应增多,包括IMU的参数、安装矩阵、姿态数据等。传统的数学仿真试验难以准确对对准过程进行仿真验证,一种既能够实现传统对准方法的模拟,又能够实现新型多参数对准算法的地面试验验证系统及方法成为一个亟待解决的难题。
传统对准方法实现简单,通常仅使用数学仿真就可以进行验证,涉及不同体制异构IMU在未知安装变形等复杂情况下的对准方法时,由于系统复杂性,数学仿真试验无法准确模拟。地面验证系统需要解决的问题有:试验对象新,对象过程复杂,试验时序要求高,试验任务多,试验结果高可信性评估。
发明内容
本发明所要求解决的技术问题是:克服现有技术的不足,提出一种面向空间应用异构IMU初始对准的地面试验系统及方法。
本发明包括如下技术方案:
一种面向空间应用异构IMU初始对准的地面试验系统,包括:三轴转台、IMU、GNC控制器、转台控制柜、远程终端、外部光学精瞄标定子系统、地理基准平面镜和转台载物台立方镜;所述IMU为惯性测量单元;
IMU和转台载物台立方镜均安装在三轴转台上,外部光学精瞄标定子系统通过地理基准平面镜、转台载物台上的立方镜以及IMU上自身携带的立方镜,计算出IMU在转台上的安装矩阵Cjt、转台坐标系与天东北地理坐标系的姿态转换矩阵Ct0e;远程终端对转台控制柜发送采样命令,转台控制柜从三轴转台上获得转台框架角数据,并且提供给远程终端,远程终端根据转台框架角数据和转换矩阵Ct0e计算惯性系姿态数据,并将计算得到的惯性系姿态数据提供给GNC控制器,GNC控制器根据IMU的测量数据以及所述惯性姿态数据,进行对准计算,获得IMU在星体上的安装矩阵Cjt_b,将Cjt_b与Cjt进行比对,从而完成异构IMU初始对准的地面试验。
所述外部光学精瞄标定子系统包括上位机和五个经纬仪;当拟合转台坐标系时,第一经纬仪和第二经纬仪准直所述转台载物台立方镜的两个基准面,第三经纬仪和第四经纬仪准直三轴转台旋转180度之后的转台载物台立方镜的同样位置的两个基准面,第五经纬仪准直地理基准平面镜,第一经纬仪和第二经纬仪之间、第一经纬仪和第五经纬仪之间、第三经纬仪和第五经纬仪之间、第三经纬仪和第四经纬仪之间均互瞄;
当测定安装矩阵Cjt时,第一经纬仪和第二经纬仪准直所述IMU上自身携带的立方镜的两个基准面,第三经纬仪和第四经纬仪准直所述转台载物台立方镜的两个基准面,第二经纬仪和第三经纬仪之间互瞄;
当测定姿态转换矩阵Ct0e时,第一经纬仪和第二经纬仪准直所述转台载物台立方镜的两个基准面,第三经纬仪准直地理基准平面镜,第一经纬仪和第三经纬仪之间互瞄。
所述外部光学精瞄标定子系统通过地理基准平面镜、转台载物台上的立方镜以及IMU上自身携带的立方镜,计算出IMU在转台上的安装矩阵Cjt、转台坐标系与天东北地理坐标系的姿态转换矩阵Ct0e具体为:
(1)拟合转台坐标系,包括:
(1.1)转台坐标系y轴拟合:
将转台外框旋转到任意θ位置,转台载物台立方镜的两个基准面的准直矢量分别记为:
其中:
αab为经纬仪a瞄准经纬仪b的水平角;
αa、νa为经纬仪a准直镜面时的水平角和垂直角;
将两个基准面的准直矢量叉乘,得到立方镜第三基准面的方向矢量:
Yi=DXi×DYi;
将转台外框旋转到θ+180°位置,所述转台载物台立方镜的相同位置基准面的准直矢量分别记为:
其中:
αab为经纬仪a瞄经纬仪b的水平角;
αa、νa为经纬仪a准直镜面时的水平角和垂直角;
将两个基准面的准直矢量叉乘,得到立方镜第三基准面的方向矢量:
Yj=DXj×DYj
将两矢量求均值;
Y=0.5(Yi+Yj);
从而拟合出外框轴,即为转台坐标系y轴在天东北地理坐标系的方向矢量;
(1.2)通过采用与步骤(1.1)相同的方式对转台坐标系x轴进行拟合,得到转台坐标系x轴在天东北地理坐标系的方向矢量;
(1.3)将X和Y矢量叉乘得到转台坐标z轴在天东北地理坐标系的方向矢量:
Z=X×Y
即拟合出转台坐标系z轴;
(2)确定转台坐标系和天东北地理坐标系之间的关系,得到姿态转换矩阵Ct0e;
(3)确定转台坐标系和IMU之间的转换关系,得到IMU在转台上的安装矩阵Cjt。
所述远程终端根据转台框架角数据和转换矩阵Ct0e计算惯性系姿态数据具体为:
(4.1)建立瞬时凝固惯性系oixiyizi:原点oi位于地心;oixi轴在试验开始时刻的平赤道面内,指向IMU所在的子午线与平赤道面的交点;oiyi轴在试验开始时刻的平赤道面内;oizi轴垂直于试验开始时刻的平赤道面,指向地球自转方向;三轴构成右手系;
(4.2)通过公式Cti=Cy(φi)Cx(φm)Cy(φo)Ct0eCy(-φe)Cz(ωet)计算出转台相对于瞬时凝固惯性系的姿态,即所述惯性系姿态数据;其中,φe为当地地理纬度,ωe为地球自转角速度,t为从试验开始时刻累积的时间,φo、φm、φi分别为三轴转台的三个框架角,φo为外框架的框架角,φm为中框架的框架角,φi为内框架的框架角;其中:
一种基于面向空间应用异构IMU初始对准试验系统的试验方法,步骤如下:
(1)将多套不同体制的异构IMU安装在三轴转台上,保证相对安装方式与星上安装方式一致;
(2)通过外部光学精瞄标定子系统获得IMU自身携带的立方镜与转台坐标系的转换矩阵Cjt以及转台坐标系与天东北地理坐标系的转换矩阵Ct0e;
(3)定义瞬时凝固惯性系oixiyizi,根据转台所处的地理纬度φe,地球自转角速度ωe,从试验开始时刻累积的时间t,计算瞬时凝固惯性系到天东北地理坐标系的姿态转换矩阵Cei;
(4)通过转台控制柜驱动三轴转台按照IMU所在星体的运动规律转动;
(5)根据转台控制柜输出的三轴转台框架角φo、φm、φi,计算零位时刻的转台坐标系到任意时刻t转台坐标系的姿态转换矩阵Ctt0;
(6)使用步骤(2)、(3)、(5)的结果计算出转台坐标系的惯性姿态Cti=Ctt0Ct0eCei=Cy(φi)Cx(φm)Cy(φo)Ct0eCy(-φe)Cz(ωet),模拟GNC控制器从其它敏感器获得的星体惯性姿态;
(7)将惯性姿态Cti转换为星载GNC中需要的姿态格式,发送给星载GNC控制器;
(8)星载GNC控制器通过星载对准算法进行对准导航计算,获得IMU在星体上的安装矩阵Cjt_b;
(9)将Cjt_b与Cjt进行比对,从而完成异构IMU初始对准的地面试验。
本发明与现有技术相比的优点在于:
(1)本发明提出基于经纬仪的光学精瞄标定子系统,通过多角度转动拟合的方法,标定出三轴转台坐标系oxt0yt0zt0,从而获得IMU的准确安装矩阵Cjt、转台坐标系与天东北地理坐标系的姿态转换矩阵Ct0e;为试验系统提供必要参数,同时实现准确评估对准结果精度。
(2)本发明定义瞬时凝固惯性系oixiyizi,由试验开始时刻确定,保留了地球自转角速度在各轴上的投影相同,且保证后续姿态系统无需与真实历元对应,提高试验简便性。
(3)本发明提出通过使用转台框架角φo、φm、φi(外、中、内)、转台坐标系相对于天东北地理坐标系的姿态转换矩阵Ct0e、天东北地理坐标系相对于瞬时凝固惯性系的姿态转换矩阵Cei融合计算获得IMU所在飞行器的惯性姿态,保证准确模拟星载GNC控制器所处的数据环境,包括数据噪声、数据时序等特性。
附图说明
图1地面试验系统的组成框图。
图2为转台坐标系示意图。
图3为光学精瞄标定子系统组成示意图。
图4为试验方法流程图。
具体实施方式
下面就结合附图对本发明做进一步介绍。
如图1所示,本发明提供了一种面向空间应用异构IMU初始对准的地面试验系统及方法,包括:三轴转台、IMU、GNC控制器、转台控制柜、远程终端、外部光学精瞄标定子系统、地理基准平面镜和转台载物台立方镜;所述IMU为惯性测量单元;
本发明试验系统的工作原理为:
IMU和转台载物台立方镜均安装在三轴转台上,外部光学精瞄标定子系统通过地理基准平面镜、转台载物台上的立方镜以及IMU上自身携带的立方镜,计算出IMU在转台上的安装矩阵Cjt、转台坐标系与天东北地理坐标系的姿态转换矩阵Ct0e;远程终端对转台控制柜发送采样命令,转台控制柜从三轴转台上获得转台框架角数据,并且提供给远程终端,远程终端根据转台框架角数据和转换矩阵Ct0e计算惯性姿态数据,并将计算得到的惯性姿态数据提供给GNC控制器,GNC控制器根据IMU的测量数据以及所述惯性姿态数据,运行自身装载的初始对准程序进行对准计算,获得对准结果,即IMU在星体上的安装矩阵Cjt_b。将Cjt_b与Cjt进行比对,评估结果精度,从而完成异构IMU初始对准的地面试验;
本发明试验系统中,使用三轴转台模拟出星载对准系统所处的动态环境,使用远程终端模拟出星载对准系统所处的数据和时序环境,对于星上对准系统而言,外部环境与在轨环境完全一致,可有效进行各种工况下的试验验证;对星上对准系统的计算结果的评估,采用基于经纬仪的光学精瞄标定子系统,可实现高精度高可信的评估。
如图3所示,所述外部光学精瞄标定子系统包括上位机和五个经纬仪;当拟合转台坐标系时,第一经纬仪和第二经纬仪准直所述转台载物台立方镜的两个基准面,第三经纬仪和第四经纬仪准直三轴转台旋转180度之后的转台载物台立方镜的同样位置的两个基准面,第五经纬仪准直地理基准平面镜,第一经纬仪和第二经纬仪之间、第一经纬仪和第五经纬仪之间、第三经纬仪和第五经纬仪之间、第三经纬仪和第四经纬仪之间均互瞄;
当测定安装矩阵Cjt时,第一经纬仪和第二经纬仪准直所述IMU上自身携带的立方镜的两个基准面,第三经纬仪和第四经纬仪准直所述转台载物台立方镜的两个基准面,第二经纬仪和第三经纬仪之间互瞄;
当测定姿态转换矩阵Ct0e时,第一经纬仪和第二经纬仪准直所述转台载物台立方镜的两个基准面,第三经纬仪准直地理基准平面镜,第一经纬仪和第三经纬仪之间互瞄;
外部光学精瞄标定子系统通过地理基准平面镜、转台载物台上的立方镜以及IMU上自身携带的立方镜,计算出IMU在转台上的安装矩阵Cjt、转台坐标系与天东北地理坐标系的姿态转换矩阵Ct0e具体为:
(1)拟合转台坐标系,定义如图2所示,原点位于转台回转中心,x轴沿转台中框轴,y轴沿转台外框轴,z轴与x、y轴构成右手系,转台坐标系的拟合包括:
(1.1)转台坐标系y轴拟合:
将转台外框旋转到任意θ位置,中框轴和内框轴回零,使用五台经纬仪的测量数据,计算转台载物台立方镜的两个基准面的准直矢量,分别记为:
其中:
αab为经纬仪a瞄经纬仪b的水平角,ab有12,21,51三种取值;
αa、νa为经纬仪a准直镜面时的水平角和垂直角,a有1,2两种取值;
将两个基准面的准直矢量叉乘,得到立方镜第三基准面的方向矢量:
Yi=DXi×DYi;
将转台外框旋转到θ+180°位置,所述转台载物台立方镜的相同位置基准面的准直矢量分别记为:
其中:
αab为经纬仪a瞄经纬仪b的水平角,ab有34,43,53三种取值;
αa、νa为经纬仪a准直镜面时的水平角和垂直角,a有3,4两种取值;
将两个基准面的准直矢量叉乘,得到立方镜第三基准面的方向矢量:
Yj=DXj×DYj
将两矢量求均值:
Y=0.5(Yi+Yj);
从而拟合出外框轴,即为转台坐标系y轴在天东北地理坐标系的方向矢量;
(1.2)通过采用与步骤(1.1)相同的方式对转台坐标系x轴进行拟合,得到转台坐标系x轴在天东北地理坐标系的方向矢量;
(1.3)将X和Y矢量叉乘得到转台坐标z轴在天东北地理坐标系的方向矢量:
Z=X×Y
即拟合出转台坐标系z轴;
(2)将步骤(1)中获得三个方向矢量X、Y、Z组合,确定转台坐标系和天东北地理坐标系之间的关系,得到姿态转换矩阵
(3)确定转台坐标系和IMU之间的转换关系,使用测量专业中常用的立方镜之间角度关系测量的方法。在步骤(1)(2)中已经得到了转台载物台立方镜、天东北地理系、转台坐标系之间的姿态关系,再通过第一经纬仪和第二经纬仪准直所述IMU上自身携带的立方镜的两个基准面,第三经纬仪和第四经纬仪准直所述转台载物台立方镜的两个基准面,第二经纬仪和第三经纬仪之间互瞄,建立测量坐标系,可计算出转台载物台立方镜、IMU自身携带立方镜两个立方镜基准面法线之间的夹角,从而获得IMU在转台上的安装矩阵Cjt。
所述基于经纬仪的外部光学精瞄标定子系统精度主要由操作瞄准时的系统误差和随机误差组成,在对经纬仪数据进行计算时,同一位置进行多次测量,程序中首先使用格罗布斯准则和狄克逊准则对数据有效性进行判别,然后进行计算,保证标定精度优于20角秒,而实际星载对准系统的精度处于100角秒量级,因此标定子系统结果可对星上对准结果进行有效评估。
所述远程终端根据转台框架角数据和转换矩阵Ct0e计算惯性系姿态数据具体为:
建立瞬时凝固惯性系oixiyizi:原点oi位于地心;oixi轴在试验开始时刻的平赤道面内,指向IMU所在的子午线与平赤道面的交点;oiyi轴在试验开始时刻的平赤道面内;oizi轴垂直于试验开始时刻的平赤道面,指向地球自转方向;三轴构成右手系;
通过公式Cti=Cy(φi)Cx(φm)Cy(φo)Ct0eCy(-φe)Cz(ωet)计算出转台相对于瞬时凝固惯性系的姿态,即所述惯性姿态数据;其中,φe为当地地理纬度,ωe为地球自转角速度,t为从试验开始时刻累积的时间,φo、φm、φi分别为三轴转台的三个框架角,φo为外框架的框架角,φm为中框架的框架角,φi为内框架的框架角;其中:
惯性姿态的计算涉及历元问题,一般情况下使用J2000惯性系,即时间历元参考点为UTC时2000年1月1日零时零分零秒,在试验系统中若使用该参考惯性系,将要求远程终端中必须有准确的UTC时间,这对远程终端的工程实现及试验方法的操作带来很大困难。本方法引入瞬时凝固惯性系,以试验开始时刻为参考基准,避免与真实时间历元系统产生关联,大大降低试验系统的工程研制难度。
如图4所示,本发明基于上述试验系统实现的试验方法,步骤如下:
(1)将多套不同体制的异构IMU安装在三轴转台上,保证相对安装方式与星上安装方式一致;
(2)通过外部光学精瞄标定子系统获得IMU自身携带的立方镜与转台坐标系的转换矩阵Cjt以及转台坐标系与天东北地理坐标系的转换矩阵Ct0e;
(3)定义瞬时凝固惯性系oixiyizi,根据转台所处的地理纬度φe,地球自转角速度ωe,从试验开始时刻累积的时间t,计算瞬时凝固惯性系到天东北地理坐标系的姿态转换矩阵Cei=Cy(-φe)Cz(ωet);
(4)通过转台控制柜驱动三轴转台按照IMU所在星体的运动规律转动;
(5)根据转台控制柜输出的三轴转台框架角φo、φm、φi,计算零位时刻的转台坐标系到任意时刻t转台坐标系的姿态转换矩阵Ctt0=Cy(φi)Cx(φm)Cy(φo);
(6)使用步骤(2)、(3)、(5)的结果计算出转台坐标系的惯性姿态Cti=Ctt0Ct0eCei=Cy(φi)Cx(φm)Cy(φo)Ct0eCy(-φe)Cz(ωet),模拟GNC控制器从其它敏感器获得的星体惯性姿态;
(7)将惯性姿态Cti转换为星载GNC中需要的姿态格式,发送给星载GNC控制器;
(8)星载GNC控制器通过星载对准算法进行对准导航计算,获得IMU在星体上的安装矩阵Cjt_b;
(9)将Cjt_b与Cjt进行比对,从而完成异构IMU初始对准的地面试验。
随着高速再入返回、地外天体进入着陆、交会对接等航天技术的发展,对航天器GNC系统中惯性导航系统的功能、性能提出了更高要求。为满足新形势下任务需求,对各种新型IMU产品、不同构型较大变形安装、复杂对准算法在各种复杂工况下的有效性、适用性、精度性能的验证提出了难题。在具备惯性导航系统的空间飞行器GNC系统的研制过程中,引入所述地面验证系统,对星载初始对准过程进行全物理试验验证,可有效评估星上对准算法、IMU在各种工况下的适应性、精度,解决此类系统无法在地面有效验证的问题,供其他型号借鉴使用,应用范围广泛。
本发明未详细说明部分属本领域技术人员公知常识。
Claims (3)
1.一种面向空间应用异构IMU初始对准的地面试验系统,其特征在于包括:三轴转台、IMU、GNC控制器、转台控制柜、远程终端、外部光学精瞄标定子系统、地理基准平面镜和转台载物台立方镜;所述IMU为惯性测量单元;
IMU和转台载物台立方镜均安装在三轴转台上,外部光学精瞄标定子系统通过地理基准平面镜、转台载物台上的立方镜以及IMU上自身携带的立方镜,计算出IMU在转台上的安装矩阵Cjt、转台坐标系与天东北地理坐标系的姿态转换矩阵Ct0e;远程终端对转台控制柜发送采样命令,转台控制柜从三轴转台上获得转台框架角数据,并且提供给远程终端,远程终端根据转台框架角数据和转换矩阵Ct0e计算惯性系姿态数据,并将计算得到的惯性系姿态数据提供给GNC控制器,GNC控制器根据IMU的测量数据以及所述惯性姿态数据,进行对准计算,获得IMU在星体上的安装矩阵Cjt_b,将Cjt_b与Cjt进行比对,从而完成异构IMU初始对准的地面试验;
所述外部光学精瞄标定子系统通过地理基准平面镜、转台载物台上的立方镜以及IMU上自身携带的立方镜,计算出IMU在转台上的安装矩阵Cjt、转台坐标系与天东北地理坐标系的姿态转换矩阵Ct0e具体为:
(1)拟合转台坐标系,包括:
(1.1)转台坐标系y轴拟合:
将转台外框旋转到任意θ位置,转台载物台立方镜的两个基准面的准直矢量分别记为:
<mrow>
<msup>
<mi>DX</mi>
<mi>i</mi>
</msup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>1</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>12</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>1</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>1</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>12</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>1</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>1</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<msup>
<mi>DY</mi>
<mi>i</mi>
</msup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>2</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>51</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mn>12</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&alpha;</mi>
<mn>21</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>2</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>2</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>51</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mn>12</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&alpha;</mi>
<mn>21</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>2</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>2</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
其中:
αab为经纬仪a瞄准经纬仪b的水平角;
αa、νa为经纬仪a准直镜面时的水平角和垂直角;
将两个基准面的准直矢量叉乘,得到立方镜第三基准面的方向矢量:
Yi=DXi×DYi;
将转台外框旋转到θ+180°位置,所述转台载物台立方镜的相同位置基准面的准直矢量分别记为:
<mrow>
<msup>
<mi>DX</mi>
<mi>j</mi>
</msup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>3</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>34</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>3</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>3</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>34</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>3</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>3</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<msup>
<mi>DY</mi>
<mi>j</mi>
</msup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mo>-</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>4</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>53</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mn>34</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&alpha;</mi>
<mn>43</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>4</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>4</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>53</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mn>34</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&alpha;</mi>
<mn>43</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>4</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>sin</mi>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>4</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中:
αab为经纬仪a瞄经纬仪b的水平角;
αa、νa为经纬仪a准直镜面时的水平角和垂直角;
将两个基准面的准直矢量叉乘,得到立方镜第三基准面的方向矢量:
Yj=DXj×DYj
将两矢量求均值;
Y=0.5(Yi+Yj);
从而拟合出外框轴,即为转台坐标系y轴在天东北地理坐标系的方向矢量;
(1.2)通过采用与步骤(1.1)相同的方式对转台坐标系x轴进行拟合,得到转台坐标系x轴在天东北地理坐标系的方向矢量;
(1.3)将X和Y矢量叉乘得到转台坐标z轴在天东北地理坐标系的方向矢量:
Z=X×Y
即拟合出转台坐标系z轴;
(2)确定转台坐标系和天东北地理坐标系之间的关系,得到姿态转换矩阵Ct0e;
(3)确定转台坐标系和IMU之间的转换关系,得到IMU在转台上的安装矩阵Cjt;
所述远程终端根据转台框架角数据和转换矩阵Ct0e计算惯性系姿态数据具体为:
(a)建立瞬时凝固惯性系oixiyizi:原点oi位于地心;oixi轴在试验开始时刻的平赤道面内,指向IMU所在的子午线与平赤道面的交点;oiyi轴在试验开始时刻的平赤道面内;oizi轴垂直于试验开始时刻的平赤道面,指向地球自转方向;三轴构成右手系;
(b)通过公式Cti=Cy(φi)Cx(φm)Cy(φo)Ct0eCy(-φe)Cz(ωet)计算出转台相对于瞬时凝固惯性系的姿态,即所述惯性系姿态数据;其中,φe为当地地理纬度,ωe为地球自转角速度,t为从试验开始时刻累积的时间,φo、φm、φi分别为三轴转台的三个框架角,φo为外框架的框架角,φm为中框架的框架角,φi为内框架的框架角;其中:
<mrow>
<mi>C</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
<mrow>
<mi>C</mi>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
<mrow>
<mi>C</mi>
<mi>z</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>.</mo>
</mrow>
2.根据权利要求1所述的一种面向空间应用异构IMU初始对准的地面试验系统,其特征在于:所述外部光学精瞄标定子系统包括上位机和五个经纬仪;当拟合转台坐标系时,第一经纬仪和第二经纬仪准直所述转台载物台立方镜的两个基准面,第三经纬仪和第四经纬仪准直三轴转台旋转180度之后的转台载物台立方镜的同样位置的两个基准面,第五经纬仪准直地理基准平面镜,第一经纬仪和第二经纬仪之间、第一经纬仪和第五经纬仪之间、第三经纬仪和第五经纬仪之间、第三经纬仪和第四经纬仪之间均互瞄;
当测定安装矩阵Cjt时,第一经纬仪和第二经纬仪准直所述IMU上自身携带的立方镜的两个基准面,第三经纬仪和第四经纬仪准直所述转台载物台立方镜的两个基准面,第二经纬仪和第三经纬仪之间互瞄;
当测定姿态转换矩阵Ct0e时,第一经纬仪和第二经纬仪准直所述转台载物台立方镜的两个基准面,第三经纬仪准直地理基准平面镜,第一经纬仪和第三经纬仪之间互瞄。
3.一种基于面向空间应用异构IMU初始对准试验系统的试验方法,其特征在于步骤如下:
(1)将多套不同体制的异构IMU安装在三轴转台上,保证相对安装方式与星上安装方式一致;
(2)通过外部光学精瞄标定子系统获得IMU自身携带的立方镜与转台坐标系的转换矩阵Cjt以及转台坐标系与天东北地理坐标系的转换矩阵Ct0e;
具体为:
(a)拟合转台坐标系,包括:
(a.1)转台坐标系y轴拟合:
将转台外框旋转到任意θ位置,转台载物台立方镜的两个基准面的准直矢量分别记为:
<mrow>
<msup>
<mi>DX</mi>
<mi>i</mi>
</msup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>1</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>12</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>1</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>1</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>12</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>1</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>1</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<msup>
<mi>DY</mi>
<mi>i</mi>
</msup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>2</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>51</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mn>12</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&alpha;</mi>
<mn>21</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>2</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>2</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>51</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mn>12</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&alpha;</mi>
<mn>21</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>2</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>2</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
其中:
αab为经纬仪a瞄准经纬仪b的水平角;
αa、νa为经纬仪a准直镜面时的水平角和垂直角;
将两个基准面的准直矢量叉乘,得到立方镜第三基准面的方向矢量:
Yi=DXi×DYi;
将转台外框旋转到θ+180°位置,所述转台载物台立方镜的相同位置基准面的准直矢量分别记为:
<mrow>
<msup>
<mi>DX</mi>
<mi>j</mi>
</msup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mo>-</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>3</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>34</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>3</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>3</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>34</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>3</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>sin</mi>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>3</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<msup>
<mi>DY</mi>
<mi>j</mi>
</msup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mo>-</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>4</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>53</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mn>34</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&alpha;</mi>
<mn>43</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>4</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>4</mn>
<mi>j</mi>
</msubsup>
<mo>)</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>53</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mn>34</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&alpha;</mi>
<mn>43</mn>
</msub>
<mo>-</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>4</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>sin</mi>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mn>4</mn>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中:
αab为经纬仪a瞄经纬仪b的水平角;
αa、νa为经纬仪a准直镜面时的水平角和垂直角;
将两个基准面的准直矢量叉乘,得到立方镜第三基准面的方向矢量:
Yj=DXj×DYj
将两矢量求均值;
Y=0.5(Yi+Yj);
从而拟合出外框轴,即为转台坐标系y轴在天东北地理坐标系的方向矢量;
(a.2)通过采用与步骤(a.1)相同的方式对转台坐标系x轴进行拟合,得到转台坐标系x轴在天东北地理坐标系的方向矢量;
(a.3)将X和Y矢量叉乘得到转台坐标z轴在天东北地理坐标系的方向矢量:
Z=X×Y
即拟合出转台坐标系z轴;
(b)确定转台坐标系和天东北地理坐标系之间的关系,得到姿态转换矩阵Ct0e;
(c)确定转台坐标系和IMU之间的转换关系,得到IMU在转台上的安装矩阵Cjt;
(3)定义瞬时凝固惯性系oixiyizi,根据转台所处的地理纬度φe,地球自转角速度ωe,从试验开始时刻累积的时间t,计算瞬时凝固惯性系到天东北地理坐标系的姿态转换矩阵Cei;
(4)通过转台控制柜驱动三轴转台按照IMU所在星体的运动规律转动;
(5)根据转台控制柜输出的三轴转台框架角φo、φm、φi,计算零位时刻的转台坐标系到任意时刻t转台坐标系的姿态转换矩阵Ctt0;
(6)使用步骤(2)、(3)、(5)的结果计算出转台坐标系的惯性姿态Cti=Ctt0Ct0eCei=Cy(φi)Cx(φm)Cy(φo)Ct0eCy(-φe)Cz(ωet),模拟GNC控制器从其它敏感器获得的星体惯性姿态;
具体为:
(6.1)建立瞬时凝固惯性系oixiyizi:原点oi位于地心;oixi轴在试验开始时刻的平赤道面内,指向IMU所在的子午线与平赤道面的交点;oiyi轴在试验开始时刻的平赤道面内;oizi轴垂直于试验开始时刻的平赤道面,指向地球自转方向;三轴构成右手系;
(6.2)通过公式Cti=Cy(φi)Cx(φm)Cy(φo)Ct0eCy(-φe)Cz(ωet)计算出转台相对于瞬时凝固惯性系的姿态,即所述惯性系姿态数据;其中,φe为当地地理纬度,ωe为地球自转角速度,t为从试验开始时刻累积的时间,φo、φm、φi分别为三轴转台的三个框架角,φo为外框架的框架角,φm为中框架的框架角,φi为内框架的框架角;其中:
<mrow>
<mi>C</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
<mrow>
<mi>C</mi>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
<mrow>
<mi>C</mi>
<mi>z</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
(7)将惯性姿态Cti转换为星载GNC中需要的姿态格式,发送给星载GNC控制器;
(8)星载GNC控制器通过星载对准算法进行对准导航计算,获得IMU在星体上的安装矩阵Cjt_b;
(9)将Cjt_b与Cjt进行比对,从而完成异构IMU初始对准的地面试验。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410783930.9A CN104501835B (zh) | 2014-12-16 | 2014-12-16 | 一种面向空间应用异构imu初始对准的地面试验系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410783930.9A CN104501835B (zh) | 2014-12-16 | 2014-12-16 | 一种面向空间应用异构imu初始对准的地面试验系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104501835A CN104501835A (zh) | 2015-04-08 |
CN104501835B true CN104501835B (zh) | 2018-02-09 |
Family
ID=52943261
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410783930.9A Active CN104501835B (zh) | 2014-12-16 | 2014-12-16 | 一种面向空间应用异构imu初始对准的地面试验系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104501835B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106403993B (zh) * | 2015-07-31 | 2019-09-17 | 北京航天计量测试技术研究所 | 一种瞄准棱镜安装误差测量方法 |
CN108535755B (zh) * | 2018-01-17 | 2021-11-19 | 南昌大学 | 基于mems的gnss/imu车载实时组合导航方法 |
CN108204885B (zh) * | 2018-01-30 | 2019-12-20 | 北京空间机电研究所 | 一种钛合金精密光学支撑结构稳定性验证方法 |
CN111102918B (zh) * | 2018-10-29 | 2021-07-27 | 中国人民解放军战略支援部队信息工程大学 | 一种立方镜坐标系的自动化测量系统 |
CN109470272B (zh) * | 2018-12-05 | 2020-11-03 | 中国科学院长春光学精密机械与物理研究所 | 一种imu测量基准的标定方法 |
CN109945892B (zh) * | 2019-03-15 | 2021-02-19 | 北京航空航天大学 | 一种惯性导航系统复杂算法类需求的在线测试方法 |
CN111044077B (zh) * | 2019-12-25 | 2021-07-30 | 中国科学院国家空间科学中心 | 星敏感器测量坐标系与星敏感器立方镜坐标系间的标定方法 |
CN112197790B (zh) * | 2020-09-10 | 2023-03-07 | 天津津航技术物理研究所 | 一种机载高精度地理指示光电转塔的几何精度校准方法 |
CN113108785B (zh) * | 2021-03-11 | 2022-06-10 | 中国电子科技集团公司第五十四研究所 | 一种面向同构imu的分布式协同互校准定位方法 |
CN113844682B (zh) * | 2021-09-13 | 2023-06-16 | 北京控制工程研究所 | 一种火星edl过程大动态导航试验验证系统及方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102288199A (zh) * | 2011-06-22 | 2011-12-21 | 哈尔滨工业大学 | 一种星敏感器的地面测试方法 |
CN103245364A (zh) * | 2013-05-14 | 2013-08-14 | 哈尔滨工业大学 | 一种星敏感器动态性能测试方法 |
CN103759729A (zh) * | 2014-01-10 | 2014-04-30 | 北京空间飞行器总体设计部 | 采用捷联惯导的月球软着陆地面试验用初始姿态获取方法 |
-
2014
- 2014-12-16 CN CN201410783930.9A patent/CN104501835B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102288199A (zh) * | 2011-06-22 | 2011-12-21 | 哈尔滨工业大学 | 一种星敏感器的地面测试方法 |
CN103245364A (zh) * | 2013-05-14 | 2013-08-14 | 哈尔滨工业大学 | 一种星敏感器动态性能测试方法 |
CN103759729A (zh) * | 2014-01-10 | 2014-04-30 | 北京空间飞行器总体设计部 | 采用捷联惯导的月球软着陆地面试验用初始姿态获取方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104501835A (zh) | 2015-04-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104501835B (zh) | 一种面向空间应用异构imu初始对准的地面试验系统及方法 | |
CN103575299B (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
CN104266649B (zh) | 基于陀螺经纬仪测量基准立方镜姿态角度的方法 | |
Lu et al. | An all-parameter system-level calibration for stellar-inertial navigation system on ground | |
Yao et al. | Transverse Navigation under the Ellipsoidal Earth Model and its Performance in both Polar and Non-polar areas | |
CN102927994A (zh) | 一种斜置冗余捷联惯性导航系统的快速标定方法 | |
CN103852085B (zh) | 一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法 | |
CN105737858A (zh) | 一种机载惯导系统姿态参数校准方法与装置 | |
CN104764463B (zh) | 一种惯性平台调平瞄准误差的自检测方法 | |
CN104374388A (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN105953803A (zh) | 数字式太阳敏感器测量坐标系与棱镜坐标系偏差测量方法 | |
CN105737848B (zh) | 一种系统级星敏感器观星系统及观星方法 | |
CN103925930B (zh) | 一种重力仪双轴陀螺稳定平台航向误差效应的补偿方法 | |
CN107228665A (zh) | 一种混合式惯性平台系统 | |
CN103076025A (zh) | 一种基于双解算程序的光纤陀螺常值误差标定方法 | |
CN109489661B (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
CN110514228A (zh) | 微小型无人机航姿测量系统动态综合性能测试装置及方法 | |
CN106643726B (zh) | 一种统一惯性导航解算方法 | |
Lu et al. | Improved calibration of IMU biases in analytic coarse alignment for AHRS | |
CN105424060B (zh) | 一种飞行器星敏感器与捷联惯组安装误差的测量方法 | |
Lu et al. | In-motion initial alignment and positioning with INS/CNS/ODO integrated navigation system for lunar rovers | |
Wu et al. | The asynchronous gimbal-rotation-based calibration method for lever-arm errors of two rotational inertial navigation systems | |
CN103913169A (zh) | 一种飞行器的捷联惯性/星光折射组合导航方法 | |
CN105758422B (zh) | 一种积分式闭环光纤陀螺的测试方法 | |
Zhao et al. | Integrated navigation error analysis based on Kalman filter of INS error compensation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |