CN104296747A - 基于火箭橇轨道坐标系的惯性测量***一维定位方法 - Google Patents
基于火箭橇轨道坐标系的惯性测量***一维定位方法 Download PDFInfo
- Publication number
- CN104296747A CN104296747A CN201410584814.4A CN201410584814A CN104296747A CN 104296747 A CN104296747 A CN 104296747A CN 201410584814 A CN201410584814 A CN 201410584814A CN 104296747 A CN104296747 A CN 104296747A
- Authority
- CN
- China
- Prior art keywords
- axle
- inertial measurement
- moment
- measurement system
- phi
- 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.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- 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)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
本发明公开了基于火箭橇轨道坐标系的惯性测量***一维定位方法,在火箭橇试验中的每一时刻,通过姿态角更新确定姿态变换矩阵,获得运动方向加速度误差后,通过公式计算得到姿态角、速度、位置误差值,并进行速度和位置的导航解算。在定位结束后,从导航结果中扣除误差,得到真值。通过本发明进行导航解算可以直接获得在实际运行方向上的导航距离值,并通过误差补偿,减少了轨道坐标系Y、Z轴速度和位置导航误差,进而提高了导航精度。
Description
技术领域
本发明涉及一种惯性测量***基于火箭橇轨道坐标系的一维定位方法,应用于火箭橇试验中的惯性导航中。
背景技术
火箭橇试验具有产生大过载、高速度、强振动和冲击等综合条件的能力,可以最逼真地模拟导弹真实飞行环境。通过试验能够考核惯性测量***在综合环境条件下的各项性能指标和精度,验证惯性测量***误差模型在高动态条件下的正确性,特别是在大过载情况下,高次项放大作用,能够确定惯性测量***高次误差项对导航性能的影响,是实现惯性测量***动态性能验证的最佳途径。
捷联式惯导***的最大特点是依靠算法建立起导航坐标系,即平台坐标系以数学平台形式存在,这样就省略了复杂的物理实体平台,一般情况下的导航坐标系是在地理坐标系下进行导航解算。
在惯性测量***火箭橇试验中,目前主要采用基于地理坐标系的导航计算方法,速度信息取东向速度ve、北向速度vn和天向速度vu,位置信息取纬度经度λ和高度h,导航计算公式为
其中,VL=(ve,vn,vu)。
在计算火箭橇橇体运行轨迹时,需要把东向速度和北向速度合成为轨道速度,即
在求取橇体运行距离时,有
从以上计算过程可以看出,在惯性测量***火箭橇试验时,基于理坐标系的导航计算方法存在以下缺点:
(1)由于天向速度vu发散,所以在计算橇体速度时,采用如下简化方法
这种方法适合考虑到曲率半径后与地球水准面平行的轨道,但对直线轨道来说存在高度误差。
(2)由于速度解算存在误差,会引起位置误差。另外,由于是标量运算,没有方向信息,求解得到的位置和速度信息都是一维信息,缺少三维空间的位置误差、速度误差和姿态角误差信息。
因此,需要研究一种适合于火箭橇试验的导航解算方法。
此外,仅是使用轨道坐标系进行导航计算,因为存在误差,会导致轨道坐标系Y、Z轴的速度和位置导航值并不为零,而这与实际不符。为了扣除Y、Z轴速度和位置误差,并凭此误差进行X轴加速度补偿,需要提出一种新的方法。
发明内容
本发明的技术解决问题:克服现有技术的不足,提供基于火箭橇轨道坐标系的惯性测量***一维定位方法,精确解算火箭橇橇体沿轨道运行时的姿态、位置、速度,为最终进行惯性测量***的精度评定和惯性导航落点精度评估提供精确的导航结果。
本发明的技术解决方案:基于火箭橇轨道坐标系的惯性测量***一维定位方法,步骤如下:
(1)将惯性测量***搭载在火箭橇上进行火箭橇试验,并在火箭橇运动的每一时刻采集并记录惯性测量***在捷联本体坐标系三个轴上的加速度和角速度;其中捷联本体坐标系原点为惯性测量***的中心,x、y、z轴按照惯性测量***规定方向定义;
(2)在火箭橇试验完成后,根据t0时刻惯性测量***在捷联本体坐标系三个轴上的加速度和角速度以及惯性测量***的对准类型,计算t0时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角,并根据得到的姿态角计算t0时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵;其中火箭橇轨道坐标系OXlYlZl以火箭橇轨道起始点为原点,OXl轴指向火箭橇橇体运动方向,OZl轴朝上垂直于轨道,OYl轴在水平面内垂直于轨道,且OXl轴、OYl轴和OZl轴满足右手坐标系;
(3)n的初始值取0,执行步骤(4)至步骤(8);
(4)根据地球转速,结合tn时刻惯性测量***在捷联本体坐标系三个轴上的角速度以及惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角,计算tn+1时刻惯性测量***在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴方向上的姿态角;
(5)利用步骤(4)中得到的tn+1时刻惯性测量***在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴方向上的姿态角计算tn+1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵;
(6)根据tn+1时刻惯性测量***在捷联本体坐标系三个轴上的加速度和角速度,以及tn时刻惯性测量***在OYl轴和OZl轴的速度以及位置信息,计算tn+1时刻的以下参数:
(a)惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角误差值;
(b)惯性测量***在OYl轴和OZl轴上的速度误差值;
(c)惯性测量***在OYl轴和OZl轴上的位置误差值;
(d)惯性测量***在OXl轴方向上的一维加速度误差值;
(7)利用重力加速度在火箭橇轨道坐标系下的分量,以及tn+1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵、惯性测量***在捷联本体坐标系三个轴上的加速度、惯性测量***在OXl轴方向上的一维加速度误差值,进行导航解算得到tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度和位置信息;
(8)判断是否完成所有时刻的导航解算,如果是,执行步骤(9),否则,n的值加1,执行步骤(4)至步骤(8);
(9)在导航解算结束后,在每一时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角、速度、位置导航值中扣除对应的误差值,得到每一时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角、速度和位置的真值。
所述步骤(2)的实现方式为:
(2.1)当惯性测量***进行自对准时,利用如下公式得到t0时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角φx、φy、φz:
其中,ax、ay、az分别为t0时刻惯性测量***在捷联本体坐标系三个轴上测量得到的加速度值,ωx、ωy、ωz为t0时刻惯性测量***在捷联本体坐标系三个轴上测量得到的角速度值,ωie为地球转速,为试验地点纬度;
当进行传递对准时,t0时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角φx、φy和φz由外部***给出;
(2.2)根据得到的姿态角利用如下公式计算t0时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵
所述步骤(4)中利用如下公式计算tn+1时刻惯性测量***在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴方向上的姿态角φx(tn+1)、φy(tn+1)和φz(tn+1):
其中,ΔT为更新周期,ΔT=tn+1-tn;φx(tn)、φy(tn)、φz(tn)分别为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角;为tn时刻惯性测量***在捷联本体坐标系三个轴上的角速度,形式为X、Y、Z轴向角速度组成的列向量;为地球转速在火箭橇轨道坐标系下的分量,在导航计算中为固定值。
所述步骤(5)中tn+1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵为:
其中,φx(tn+1)、φy(tn+1)和φz(tn+1)分别为tn+1时刻惯性测量***在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴方向上的姿态角。
所述步骤(6)的实现方式为:
(5.1)在tn+1时刻,利用如下公式计算惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角误差值、在OYl轴和OZl轴上的速度误差值、在OYl轴和OZl轴上的位置误差值:
(1)X(tn|tn+1)=Φ(tn)X(tn)
(2)P(tn|tn+1)=Φ(tn)P(tn)Φ(tn)T+Q·ΔT
(3)Κ(tn)=P(tn|tn+1)HT[HP(tn|tn+1)HT+R]-1
(4)X(tn+1)=X(tn|tn+1)+K(tn)[Y(tn)-HX(tn)]
(5)P(tn+1)=[I7-K(tn)H]P(tn|tn+1)[I7-K(tn)H]T+K(tn)RK(tn)T
其中, 为tn时刻各误差系数组成的向量,δφx、δφy、δφz为惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角误差,δvy、δvz为惯性测量***在OYl轴和OZl轴上的速度误差,δry、δrz为惯性测量***在OYl轴和OZl轴上的位置误差值,在t0时刻,X(t0)=[0 0 0 0 0 0 0]T;
A12=-ωx(tn)sinφy(tn)+ωz(tn)cosφy(tn)
A22=[ωx(tn)cosφy(tn)+ωz(tn)sinφy(tn)]tanφx(tn)
A32=-[ωx(tn)cosφy(tn)+ωz(tn)sinφy(tn)]secφx(tn)
A41=ax(tn)sinφy(tn)cosφx(tn)cosφz(tn)-ay(tn)sinφx(tn)cosφz(tn)
-az(tn)cosφy(tn)cosφx(tn)cosφz(tn)
A42=ax(tn)[-sinφy(tn)sinφz(tn)+cosφy(tn)sinφx(tn)cosφz(tn)]
+az(tn)[cosφy(tn)sinφz(tn)+sinφy(tn)sinφx(tn)cosφz(tn)]
A43=ax(tn)[cosφy(tn)cosφz(tn)-sinφy(tn)sinφx(tn)sinφz(tn)]-ay(tn)cosφx(tn)sinφz(tn)
+az(tn)[sinφy(tn)cosφz(tn)+cosφy(tn)sinφx(tn)sinφz(tn)]
A51=ax(tn)sinφy(tn)sinφx(tn)+ay(tn)cosφx(tn)-az(tn)cosφy(tn)sinφx(tn)
A52=-ax(tn)cosφy(tn)cosφx(tn)-az(tn)sinφy(tn)cosφx(tn)
其中,ΔT为更新周期,ΔT=tn+1-tn;为在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴上的分量;φx(tn)、φy(tn)、φz(tn)分别为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角;ax(tn)、ay(tn)、az(tn)分别为tn时刻惯性测量***在捷联本体坐标系三个轴上测量得到的加速度值;ωx(tn)、ωy(tn)、ωz(tn)为在捷联本体坐标系三个轴上火箭橇橇体经过补偿的角速度,计算公式为:
对于t0时刻, 为tn时刻惯性测量***陀螺仪在捷联本体坐标系三个轴上测量到的角速度值,形式为X、Y、Z轴向角速度组成的列向量;为地球转速在轨道坐标系中的投影分量,在导航计算中为固定值;为tn-1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵;P(tn|tn+1)为一步预测均方误差;P(tn)为估计均方误差;Q为噪声序列方差阵,在导航解算过程中为固定值;Κ(tn)为滤波增益; 为量测阵;R为量测噪声序列的方差阵,在导航解算中为固定值; 其中,vy(tn)、vz(tn)分别为tn时刻惯性导航***在OYl、OZl轴的速度信息,ry(tn)、rz(tn)分别为tn时刻惯性导航***在OYl、OZl轴的位置信息;I7为7阶单位阵;
(5.2)在火箭橇运动的tn+1时刻,利用如下公式计算惯性测量***在OXl轴方向上的一维加速度误差值Δax(tn+1):
Δax(tn+1)
=[-ax(tn+1)sinφy(tn+1)cosφx(tn+1)sinφz(tn+1)+ay(tn+1)sinφx(tn+1)sinφz(tn+1)
+az(tn+1)cosφy(tn+1)cosφx(tn+1)sinφz(tn+1)]δφx(tn+1)
+[-ax(tn+1)(sinφy(tn+1)cosφz(tn+1)+cosφy(tn+1)sinφx(tn+1)sinφz(tn+1))
+az(tn+1)(cosφy(tn+1)cosφz(tn+1)-sinφy(tn+1)sinφx(tn+1)sinφz(tn+1))]δφy(tn+1)
+[-ax(tn+1)(cosφy(tn+1)sinφz(tn+1)+sinφy(tn+1)sinφx(tn+1)cosφz(tn+1))
-ay(tn+1)cosφx(tn+1)cosφz(tn+1)
+az(tn+1)(-sinφy(tn+1)sinφz(tn+1)+cosφy(tn+1)sinφx(tn+1)cosφz(tn+1))]δφz(tn+1)
其中,分别为tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角;ax(tn+1)、ay(tn+1)、az(tn+1)分别为tn+1时刻惯性测量***在捷联本体坐标系三个轴上测量得到的加速度值。
所述步骤(7)中利用如下公式计算重力加速度在火箭橇轨道坐标系下的分量:
其中,a为地球长半轴,e2为地球偏心率,为火箭橇橇体所在点的纬度值;hp为橇体相对水准面的高度;|P0P|=(N+hp)β′,β′为矢量O0P0和O0P的夹角,其中矢量O0P0为地球中心O0到轨道初始点P0的矢量,O0P为O0到P点的矢量,P为轨道与地球表面切点,为火箭橇轨道重力加速度模型,其中rx为橇体沿轨道运行的距离;g0为发射点位置的重力加速度,b1和b2为常值。
所述步骤(7)中计算tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度和位置信息的实现方式为:
(7.1)利用如下公式进行导航解算,得到tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度信息vx(tn+1)、vy(tn+1)和vz(tn+1):
其中,vx(tn)、vy(tn)、vz(tn)为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度信息;为tn+1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵;为地球转速在轨道坐标系投影分量的反对称矩阵;fb(tn)为tn时刻惯性测量***在捷联本体坐标系三个轴上的加速度,形式为X、Y、Z轴向加速度组成的列向量;gl为重力加速度在火箭橇轨道坐标系下的分量;Δax(tn)为tn时刻惯性测量***在OXl轴方向上的一维加速度误差值;ΔT为更新周期,ΔT=tn+1-tn;
(7.2)利用如下公式进行导航解算,得到tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的位置信息rx(tn+1)、ry(tn+1)和rz(tn+1):
其中,rx(tn)、ry(tn)、rz(tn)为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的位置信息。
所述步骤(9)的实现方式为:
(8.1)利用如下公式扣除惯性测量***在OXl轴、OYl轴和OZl轴上的对应姿态角误差值,得到tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角真值
其中,φx(tn)、φy(tn)、φz(tn)分别为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角;δφx(tn)、δφy(tn)、δφz(tn)分别为tn时刻性测量***在OXl轴、OYl轴和OZl轴上的姿态角误差值;
(8.2)利用如下公式扣除惯性测量***在OYl轴和OZl轴上的对应速度误差值,得到tn时刻惯性测量***在OYl轴和OZl轴上的速度真值vx′(tn)、vy′(tn)、vz′(tn):
其中,vx(tn)、vy(tn)、vz(tn)分别为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度;δvy(tn)、δvz(tn)分别为tn时刻惯性测量***在OYl轴和OZl轴上的速度误差值;
(8.3)利用如下公式扣除tn时刻惯性测量***在OYl轴和OZl轴上的对应位置误差值,得到tn时刻惯性测量***在OYl轴和OZl轴上的位置真值rx′(tn)、ry′(tn)、rz′(tn):
其中,rx(tn)、ry(tn)、rz(tn)分别为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的位置;δry(tn)、δrz(tn)分别为tn时刻惯性测量***在OYl轴和OZl轴上的位置误差值。
本发明与现有技术相比的优点如下:
(1)基于火箭撬发射点的轨道坐标系的导航算法中,对于直线轨道来说,基于火箭撬发射点的轨道坐标系OX轴与轨道平行,因此,可以直接得到橇体沿轨道运行的距离信息;对于与地球水平面平行的弯曲轨道,就可在基于火箭撬发射点的轨道坐标系OXZ平面内描述橇体沿轨道运行的距离信息。该计算方法简单,且物理意义明确。
(2)在进行OY、OZ轴导航速度和位置误差进行估计后,可以获得姿态角、速度、位置的补偿值,并据此可以获得OX轴的误差补偿值,补偿后的导航结果具有更高的精度;
(3)基于火箭撬发射点的轨道坐标系的导航算法姿态角更新时只需考虑陀螺仪组合的测量值即可,不需要考虑速度的影响,算法简单。而基于地理坐标系的导航算法在姿态更新时需要考虑速度的影响。
(4)相对于实时运动定位方法,采用本方法的导航解算结果的精度更高,运算速度更快。
附图说明
图1为本发明实现流程图;
图2为火箭橇轨道在大地坐标系中的示意图;
图3为轨道偏航角和俯仰角示意图;
图4为重力加速度仿真比较结果示意图;
图5为未经过误差扣除的导航结果;
图6为经过误差扣除的导航结果。
具体实施方式
下面首先对方法中涉及的坐标系进行说明。
捷联本体坐标系b与橇体固连,原点为橇体中心,x轴指向运动方向,z轴指天,y轴分别与x、z轴垂直,且满足右手准则。
地理坐标系原点为橇体中心,其中x、y、z三轴满足东北天准则。
本发明是基于轨道坐标系的状态空间模型、初始姿态对准、姿态角更新、坐标变换矩阵求取、误差求取、速度和位置更新以及误差扣除等组成,通过在火箭橇试验中采集每一时刻惯性测量***的加速度和角速度,然后在试验结束后根据所采集的数据进行后处理,从而得到每一时刻惯性测量***在火箭橇轨道坐标系中的速度和位置信息。本发明方法步骤如图1所示,具体步骤如下:
(1)将惯性测量***搭载在火箭橇上进行火箭橇试验,并在火箭橇运动的每一时刻采集并记录惯性测量***在捷联本体坐标系三个轴上的加速度和角速度;其中捷联本体坐标系原点为惯性测量***的中心,x、y、z轴按照惯性测量***规定方向定义;
(2)在火箭橇试验完成后,根据t0时刻惯性测量***在捷联本体坐标系三个轴上的加速度和角速度以及惯性测量***的对准类型,计算t0时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角,并根据得到的姿态角计算t0时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵;其中火箭橇轨道坐标系OXlYlZl以火箭橇轨道起始点为原点,OXl轴指向火箭橇橇体运动方向,OZl轴朝上垂直于轨道,OYl轴在水平面内垂直于轨道,且OXl轴、OYl轴和OZl轴满足右手坐标系;
本步实现方式为:
(2.1)当惯性测量***进行自对准时,利用如下公式得到t0时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角φx、φy、φz:
其中,ax、ay、az分别为t0时刻惯性测量***在捷联本体坐标系三个轴上测量得到的加速度值,ωx、ωy、ωz为t0时刻惯性测量***在捷联本体坐标系三个轴上测量得到的角速度值,ωie为地球转速,为试验地点纬度;
当进行传递对准时,t0时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角φx、φy和φz由外部***给出;
(2.2)根据得到的姿态角利用如下公式计算t0时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵
(3)n的初始值取0,执行步骤(4)至步骤(8);;
(4)根据地球转速,结合tn时刻惯性测量***在捷联本体坐标系三个轴上的角速度以及惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角,计算tn+1时刻惯性测量***在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴方向上的姿态角;
tn+1时刻惯性测量***在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴方向上的姿态角φx(tn+1)、φy(tn+1)和φz(tn+1)的计算公式为:
其中,ΔT为更新周期,ΔT=tn+1-tn;φx(tn)、φy(tn)、φz(tn)分别为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角;为tn时刻惯性测量***在捷联本体坐标系三个轴上的角速度,形式为X、Y、Z轴向角速度组成的列向量;为地球转速在火箭橇轨道坐标系下的分量,在导航计算中为固定值。
(5)利用步骤(4)中得到的tn+1时刻惯性测量***在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴方向上的姿态角计算tn+1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵;
tn+1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵为:
其中,φx(tn+1)、φy(tn+1)和φz(tn+1)分别为tn+1时刻惯性测量***在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴方向上的姿态角。
(6)根据tn+1时刻惯性测量***在捷联本体坐标系三个轴上的加速度和角速度,以及tn时刻惯性测量***在OYl轴和OZl轴的速度以及位置信息,计算tn+1时刻的以下参数:
(a)惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角误差值;
(b)惯性测量***在OYl轴和OZl轴上的速度误差值;
(c)惯性测量***在OYl轴和OZl轴上的位置误差值;
(d)惯性测量***在OXl轴方向上的一维加速度误差值;
本步骤的实现方式为:
(6.1)在tn+1时刻,利用如下公式计算惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角误差值、在OYl轴和OZl轴上的速度误差值、在OYl轴和OZl轴上的位置误差值:
(1)X(tn|tn+1)=Φ(tn)X(tn)
(2)P(tn|tn+1)=Φ(tn)P(tn)Φ(tn)T+Q·ΔT
(3)Κ(tn)=P(tn|tn+1)HT[HP(tn|tn+1)HT+R]-1
(4)X(tn+1)=X(tn|tn+1)+K(tn)[Y(tn)-HX(tn)]
(5)P(tn+1)=[I7-K(tn)H]P(tn|tn+1)[I7-K(tn)H]T+K(tn)RK(tn)T
其中, 为tn时刻各误差系数组成的向量,δφx、δφy、δφz为惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角误差,δvy、δvz为惯性测量***在OYl轴和OZl轴上的速度误差,δry、δrz为惯性测量***在OYl轴和OZl轴上的位置误差值,在t0时刻,X(t0)=[0 0 0 0 0 0 0]T;
A12=-ωx(tn)sinφy(tn)+ωz(tn)cosφy(tn)
A22=[ωx(tn)cosφy(tn)+ωz(tn)sinφy(tn)]tanφx(tn)
A32=-[ωx(tn)cosφy(tn)+ωz(tn)sinφy(tn)]secφx(tn)
A41=ax(tn)sinφy(tn)cosφx(tn)cosφz(tn)-ay(tn)sinφx(tn)cosφz(tn)
-az(tn)cosφy(tn)cosφx(tn)cosφz(tn)
A42=ax(tn)[-sinφy(tn)sinφz(tn)+cosφy(tn)sinφx(tn)cosφz(tn)]
+az(tn)[cosφy(tn)sinφz(tn)+sinφy(tn)sinφx(tn)cosφz(tn)]
A43=ax(tn)[cosφy(tn)cosφz(tn)-sinφy(tn)sinφx(tn)sinφz(tn)]-ay(tn)cosφx(tn)sinφz(tn)
+az(tn)[sinφy(tn)cosφz(tn)+cosφy(tn)sinφx(tn)sinφz(tn)]
A51=ax(tn)sinφy(tn)sinφx(tn)+ay(tn)cosφx(tn)-az(tn)cosφy(tn)sinφx(tn)
A52=-ax(tn)cosφy(tn)cosφx(tn)-az(tn)sinφy(tn)cosφx(tn)
其中,ΔT为更新周期,ΔT=tn+1-tn;为在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴上的分量;φx(tn)、φy(tn)、φz(tn)分别为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角;ax(tn)、ay(tn)、az(tn)分别为tn时刻惯性测量***在捷联本体坐标系三个轴上测量得到的加速度值;ωx(tn)、ωy(tn)、ωz(tn)为在捷联本体坐标系三个轴上火箭橇橇体经过补偿的角速度,计算公式为:
对于t0时刻, 为tn时刻惯性测量***陀螺仪在捷联本体坐标系三个轴上测量到的角速度值,形式为X、Y、Z轴向角速度组成的列向量;为地球转速在轨道坐标系中的投影分量,在导航计算中为固定值;为tn-1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵;P(tn|tn+1)为一步预测均方误差;P(tn)为估计均方误差;Q为噪声序列方差阵,在导航解算过程中为固定值;Κ(tn)为滤波增益; 为量测阵;R为量测噪声序列的方差阵,在导航解算中为固定值; 其中,vy(tn)、vz(tn)分别为tn时刻惯性导航***在OYl、OZl轴的速度信息,ry(tn)、rz(tn)分别为tn时刻惯性导航***在OYl、OZl轴的位置信息;I7为7阶单位阵;
(6.2)在火箭橇运动的tn+1时刻,利用如下公式计算惯性测量***在OXl轴方向上的一维加速度误差值Δax(tn+1):
Δax(tn+1)
=[-ax(tn+1)sinφy(tn+1)cosφx(tn+1)sinφz(tn+1)+ay(tn+1)sinφx(tn+1)sinφz(tn+1)
+az(tn+1)cosφy(tn+1)cosφx(tn+1)sinφz(tn+1)]δφx(tn+1)
+[-ax(tn+1)(sinφy(tn+1)cosφz(tn+1)+cosφy(tn+1)sinφx(tn+1)sinφz(tn+1))
+az(tn+1)(cosφy(tn+1)cosφz(tn+1)-sinφy(tn+1)sinφx(tn+1)sinφz(tn+1))]δφy(tn+1)
+[-ax(tn+1)(cosφy(tn+1)sinφz(tn+1)+sinφy(tn+1)sinφx(tn+1)cosφz(tn+1))
-ay(tn+1)cosφx(tn+1)cosφz(tn+1)
+az(tn+1)(-sinφy(tn+1)sinφz(tn+1)+cosφy(tn+1)sinφx(tn+1)cosφz(tn+1))]δφz(tn+1)
其中,分别为tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角;ax(tn+1)、ay(tn+1)、az(tn+1)分别为tn+1时刻惯性测量***在捷联本体坐标系三个轴上测量得到的加速度值。
(7)利用重力加速度在火箭橇轨道坐标系下的分量,以及tn+1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵、惯性测量***在捷联本体坐标系三个轴上的加速度、惯性测量***在OXl轴方向上的一维加速度误差值,进行导航解算得到tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度和位置信息;
本步骤的实现方式为:
(7.1)重力加速度在火箭橇轨道坐标系下的分量为:
其中,a为地球长半轴,e2为地球偏心率,为火箭橇橇体所在点的纬度值;hp为橇体相对水准面的高度;|P0P|=(N+hp)β′,β′为矢量O0P0和O0P的夹角,其中矢量O0P0为地球中心O0到轨道初始点P0的矢量,O0P为O0到P点的矢量,P为轨道与地球表面切点,为火箭橇轨道重力加速度模型,其中rx为橇体沿轨道运行的距离;g0为发射点位置的重力加速度,b1和b2为常值。
(7.2)利用如下公式进行导航解算,得到tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度信息vx(tn+1)、vy(tn+1)和vz(tn+1):
其中,vx(tn)、vy(tn)、vz(tn)为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度信息;为tn+1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵;为地球转速在轨道坐标系投影分量的反对称矩阵;fb(tn)为tn时刻惯性测量***在捷联本体坐标系三个轴上的加速度,形式为X、Y、Z轴向加速度组成的列向量;gl为重力加速度在火箭橇轨道坐标系下的分量;Δax(tn)为tn时刻惯性测量***在OXl轴方向上的一维加速度误差值;ΔT为更新周期,ΔT=tn+1-tn;
(7.3)利用如下公式进行导航解算,得到tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的位置信息rx(tn+1)、ry(tn+1)和rz(tn+1):
其中,rx(tn)、ry(tn)、rz(tn)为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的位置信息。
(8)判断是否完成所有时刻的导航解算,如果是,执行步骤(9),否则,n的值加1,执行步骤(4)至步骤(8);
(9)在导航解算结束后,在每一时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角、速度、位置导航值中扣除对应的误差值,得到每一时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角、速度和位置的真值。
本步骤的实现方式为:
(9.1)利用如下公式计算每一时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角真值φx′、φy′、φz′:
其中,φx、φy、φz分别为对应时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角;
δφx、δφy、δφz分别为步骤(6)中求得的对应时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角误差值。
(9.2)利用如下公式计算每一时刻惯性测量***在OYl轴和OZl轴上的速度真值vx′、vy′、vz′:
其中,vx、vy、vz分别为对应时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度;
δvy、δvz分别为步骤(6)中求得的对应时刻惯性测量***在OYl轴和OZl轴上的速度误差值。
(9.3)利用如下公式计算每一时刻惯性测量***在OYl轴和OZl轴上的位置真值rx′、ry′、rz′:
其中,rx、ry、rz分别为对应时刻惯性测量***在OXl轴、OYl轴和OZl轴上的位置;
δry、δrz分别为步骤(6)中求得的对应时刻惯性测量***在OYl轴和OZl轴上的位置误差值。
实施例
火箭橇试验所用的轨道为一条平直的直线,如图2中P0P1表示火箭橇轨道,其中P点为轨道与地球表面的相切点。图3中描述了轨道坐标系与地理坐标系的关系,从而可以确定轨道坐标系到地理坐标系的转换矩阵图4中分别描述了拟合重力加速度模型和拟合重力加速度残差,由图4中可以看出拟合曲线与实测值之间的差值小于1μGal。采用上述轨道参数和重力加速度模型后的导航解算结果在不进行误差扣除时如图5所示,可以得到三维位置、速度和姿态角信息。进行误差扣除后的导航结果如图6所示,与图5对比可以得到,进行误差扣除后Y、Z轴速度和位置值近似为零,与实际结果相符。
本发明未详细描述内容为本领域技术人员公知技术。
Claims (8)
1.基于火箭橇轨道坐标系的惯性测量***一维定位方法,其特征在于步骤如下:
(1)将惯性测量***搭载在火箭橇上进行火箭橇试验,并在火箭橇运动的每一时刻采集并记录惯性测量***在捷联本体坐标系三个轴上的加速度和角速度;其中捷联本体坐标系原点为惯性测量***的中心,x、y、z轴按照惯性测量***规定方向定义;
(2)在火箭橇试验完成后,根据t0时刻惯性测量***在捷联本体坐标系三个轴上的加速度和角速度以及惯性测量***的对准类型,计算t0时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角,并根据得到的姿态角计算t0时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵;其中火箭橇轨道坐标系OXlYlZl以火箭橇轨道起始点为原点,OXl轴指向火箭橇橇体运动方向,OZl轴朝上垂直于轨道,OYl轴在水平面内垂直于轨道,且OXl轴、OYl轴和OZl轴满足右手坐标系;
(3)n的初始值取0,执行步骤(4)至步骤(8);
(4)根据地球转速,结合tn时刻惯性测量***在捷联本体坐标系三个轴上的角速度以及惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角,计算tn+1时刻惯性测量***在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴方向上的姿态角;
(5)利用步骤(4)中得到的tn+1时刻惯性测量***在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴方向上的姿态角计算tn+1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵;
(6)根据tn+1时刻惯性测量***在捷联本体坐标系三个轴上的加速度和角速度,以及tn时刻惯性测量***在OYl轴和OZl轴的速度以及位置信息,计算tn+1时刻的以下参数:
(a)惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角误差值;
(b)惯性测量***在OYl轴和OZl轴上的速度误差值;
(c)惯性测量***在OYl轴和OZl轴上的位置误差值;
(d)惯性测量***在OXl轴方向上的一维加速度误差值;
(7)利用重力加速度在火箭橇轨道坐标系下的分量,以及tn+1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵、惯性测量***在捷联本体坐标系三个轴上的加速度、惯性测量***在OXl轴方向上的一维加速度误差值,进行导航解算得到tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度和位置信息;
(8)判断是否完成所有时刻的导航解算,如果是,执行步骤(9),否则,n的值加1,执行步骤(4)至步骤(8);
(9)在导航解算结束后,在每一时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角、速度、位置导航值中扣除对应的误差值,得到每一时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角、速度和位置的真值。
2.根据权利要求1所述的基于火箭橇轨道坐标系的惯性测量***一维定位方法,其特征在于:所述步骤(2)的实现方式为:
(2.1)当惯性测量***进行自对准时,利用如下公式得到t0时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角φx、φy、φz:
其中,ax、ay、az分别为t0时刻惯性测量***在捷联本体坐标系三个轴上测量得到的加速度值,ωx、ωy、ωz为t0时刻惯性测量***在捷联本体坐标系三个轴上测量得到的角速度值,ωie为地球转速,为试验地点纬度;
当进行传递对准时,t0时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角φx、φy和φz由外部***给出;
(2.2)根据得到的姿态角利用如下公式计算t0时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵
3.根据权利要求1所述的基于火箭橇轨道坐标系的惯性测量***一维定位方法,其特征在于:所述步骤(4)中利用如下公式计算tn+1时刻惯性测量***在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴方向上的姿态角φx(tn+1)、φy(tn+1)和φz(tn+1):
其中,ΔT为更新周期,ΔT=tn+1-tn;φx(tn)、φy(tn)、φz(tn)分别为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角;为tn时刻惯性测量***在捷联本体坐标系三个轴上的角速度,形式为X、Y、Z轴向角速度组成的列向量;为地球转速在火箭橇轨道坐标系下的分量,在导航计算中为固定值。
4.根据权利要求1所述的基于火箭橇轨道坐标系的惯性测量***一维定位方法,其特征在于:所述步骤(5)中tn+1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵为:
其中,φx(tn+1)、φy(tn+1)和φz(tn+1)分别为tn+1时刻惯性测量***在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴方向上的姿态角。
5.根据权利要求1所述的基于火箭橇轨道坐标系的惯性测量***一维定位方法,其特征在于:所述步骤(6)的实现方式为:
(5.1)在tn+1时刻,利用如下公式计算惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角误差值、在OYl轴和OZl轴上的速度误差值、在OYl轴和OZl轴上的位置误差值:
(1)X(tn|tn+1)=Φ(tn)X(tn)
(2)P(tn|tn+1)=Φ(tn)P(tn)Φ(tn)T+Q·ΔT
(3)Κ(tn)=P(tn|tn+1)HT[HP(tn|tn+1)HT+R]-1
(4)X(tn+1)=X(tn|tn+1)+K(tn)[Y(tn)-HX(tn)]
(5)P(tn+1)=[I7-K(tn)H]P(tn|tn+1)[I7-K(tn)H]T+K(tn)RK(tn)T
其中, 为tn时刻各误差系数组成的向量,δφx、δφy、δφz为惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角误差,δvy、δvz为惯性测量***在OYl轴和OZl轴上的速度误差,δry、δrz为惯性测量***在OYl轴和OZl轴上的位置误差值,在t0时刻,X(t0)=[0 0 0 0 0 0 0]T;
A12=-ωx(tn)sinφy(tn)+ωz(tn)cosφy(tn)
A22=[ωx(tn)cosφy(tn)+ωz(tn)sinφy(tn)]tanφx(tn)
A32=-[ωx(tn)cosφy(tn)+ωz(tn)sinφy(tn)]secφx(tn)
A41=ax(tn)sinφy(tn)cosφx(tn)cosφz(tn)-ay(tn)sinφx(tn)cosφz(tn)
-az(tn)cosφy(tn)cosφx(tn)cosφz(tn)
A42=ax(tn)[-sinφy(tn)sinφz(tn)+cosφy(tn)sinφx(tn)cosφz(tn)]
+az(tn)[cosφy(tn)sinφz(tn)+sinφy(tn)sinφx(tn)cosφz(tn)]
A43=ax(tn)[cosφy(tn)cosφz(tn)-sinφy(tn)sinφx(tn)sinφz(tn)]-ay(tn)cosφx(tn)sinφz(tn)
+az(tn)[sinφy(tn)cosφz(tn)+cosφy(tn)sinφx(tn)sinφz(tn)]
A51=ax(tn)sinφy(tn)sinφx(tn)+ay(tn)cosφx(tn)-az(tn)cosφy(tn)sinφx(tn)
A52=-ax(tn)cosφy(tn)cosφx(tn)-az(tn)sinφy(tn)cosφx(tn)
其中,ΔT为更新周期,ΔT=tn+1-tn;为在火箭橇轨道坐标系OXl轴、OYl轴和OZl轴上的分量;φx(tn)、φy(tn)、φz(tn)分别为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角;ax(tn)、ay(tn)、az(tn)分别为tn时刻惯性测量***在捷联本体坐标系三个轴上测量得到的加速度值;ωx(tn)、ωy(tn)、ωz(tn)为在捷联本体坐标系三个轴上火箭橇橇体经过补偿的角速度,计算公式为:
对于t0时刻, 为tn时刻惯性测量***陀螺仪在捷联本体坐标系三个轴上测量到的角速度值,形式为X、Y、Z轴向角速度组成的列向量;为地球转速在轨道坐标系中的投影分量,在导航计算中为固定值;为tn-1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵;P(tn|tn+1)为一步预测均方误差;P(tn)为估计均方误差;Q为噪声序列方差阵,在导航解算过程中为固定值;Κ(tn)为滤波增益; 为量测阵;R为量测噪声序列的方差阵,在导航解算中为固定值; 其中,vy(tn)、vz(tn)分别为tn时刻惯性导航***在OYl、OZl轴的速度信息,ry(tn)、rz(tn)分别为tn时刻惯性导航***在OYl、OZl轴的位置信息;I7为7阶单位阵;
(5.2)在火箭橇运动的tn+1时刻,利用如下公式计算惯性测量***在OXl轴方向上的一维加速度误差值Δax(tn+1):
Δax(tn+1)
=[-ax(tn+1)sinφy(tn+1)cosφx(tn+1)sinφz(tn+1)+ay(tn+1)sinφx(tn+1)sinφz(tn+1)
+az(tn+1)cosφy(tn+1)cosφx(tn+1)sinφz(tn+1)]δφx(tn+1)
+[-ax(tn+1)(sinφy(tn+1)cosφz(tn+1)+cosφy(tn+1)sinφx(tn+1)sinφz(tn+1))
+az(tn+1)(cosφy(tn+1)cosφz(tn+1)-sinφy(tn+1)sinφx(tn+1)sinφz(tn+1))]δφy(tn+1)
+[-ax(tn+1)(cosφy(tn+1)sinφz(tn+1)+sinφy(tn+1)sinφx(tn+1)cosφz(tn+1))
-ay(tn+1)cosφx(tn+1)cosφz(tn+1)
+az(tn+1)(-sinφy(tn+1)sinφz(tn+1)+cosφy(tn+1)sinφx(tn+1)cosφz(tn+1))]δφz(tn+1)
其中,分别为tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角;ax(tn+1)、ay(tn+1)、az(tn+1)分别为tn+1时刻惯性测量***在捷联本体坐标系三个轴上测量得到的加速度值。
6.根据权利要求1所述的基于火箭橇轨道坐标系的惯性测量***一维定位方法,其特征在于:所述步骤(7)中利用如下公式计算重力加速度在火箭橇轨道坐标系下的分量:
其中,a为地球长半轴,e2为地球偏心率,为火箭橇橇体所在点的纬度值;hp为橇体相对水准面的高度;|P0P|=(N+hp)β′,β′为矢量O0P0和O0P的夹角,其中矢量O0P0为地球中心O0到轨道初始点P0的矢量,O0P为O0到P点的矢量,P为轨道与地球表面切点,为火箭橇轨道重力加速度模型,其中rx为橇体沿轨道运行的距离;g0为发射点位置的重力加速度,b1和b2为常值。
7.根据权利要求1所述的基于火箭橇轨道坐标系的惯性测量***一维定位方法,其特征在于:所述步骤(7)中计算tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度和位置信息的实现方式为:
(7.1)利用如下公式进行导航解算,得到tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度信息vx(tn+1)、vy(tn+1)和vz(tn+1):
其中,vx(tn)、vy(tn)、vz(tn)为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度信息;为tn+1时刻火箭橇轨道坐标系到捷联本体坐标系的姿态变换矩阵;为地球转速在轨道坐标系投影分量的反对称矩阵;fb(tn)为tn时刻惯性测量***在捷联本体坐标系三个轴上的加速度,形式为X、Y、Z轴向加速度组成的列向量;gl为重力加速度在火箭橇轨道坐标系下的分量;Δax(tn)为tn时刻惯性测量***在OXl轴方向上的一维加速度误差值;ΔT为更新周期,ΔT=tn+1-tn;
(7.2)利用如下公式进行导航解算,得到tn+1时刻惯性测量***在OXl轴、OYl轴和OZl轴上的位置信息rx(tn+1)、ry(tn+1)和rz(tn+1):
其中,rx(tn)、ry(tn)、rz(tn)为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的位置信息。
8.根据权利要求1所述的基于火箭橇轨道坐标系的惯性测量***一维定位方法,其特征在于:所述步骤(9)的实现方式为:
(8.1)利用如下公式扣除惯性测量***在OXl轴、OYl轴和OZl轴上的对应姿态角误差值,得到tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角真值
其中,φx(tn)、φy(tn)、φz(tn)分别为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的姿态角;δφx(tn)、δφy(tn)、δφz(tn)分别为tn时刻性测量***在OXl轴、OYl轴和OZl轴上的姿态角误差值;
(8.2)利用如下公式扣除惯性测量***在OYl轴和OZl轴上的对应速度误差值,得到tn时刻惯性测量***在OYl轴和OZl轴上的速度真值vx'(tn)、vy'(tn)、vz'(tn):
其中,vx(tn)、vy(tn)、vz(tn)分别为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的速度;δvy(tn)、δvz(tn)分别为tn时刻惯性测量***在OYl轴和OZl轴上的速度误差值;
(8.3)利用如下公式扣除tn时刻惯性测量***在OYl轴和OZl轴上的对应位置误差值,得到tn时刻惯性测量***在OYl轴和OZl轴上的位置真值rx'(tn)、ry'(tn)、rz'(tn):
其中,rx(tn)、ry(tn)、rz(tn)分别为tn时刻惯性测量***在OXl轴、OYl轴和OZl轴上的位置;δry(tn)、δrz(tn)分别为tn时刻惯性测量***在OYl轴和OZl轴上的位置误差值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410584814.4A CN104296747B (zh) | 2014-10-27 | 2014-10-27 | 基于火箭橇轨道坐标系的惯性测量***一维定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410584814.4A CN104296747B (zh) | 2014-10-27 | 2014-10-27 | 基于火箭橇轨道坐标系的惯性测量***一维定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104296747A true CN104296747A (zh) | 2015-01-21 |
CN104296747B CN104296747B (zh) | 2017-04-19 |
Family
ID=52316583
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410584814.4A Active CN104296747B (zh) | 2014-10-27 | 2014-10-27 | 基于火箭橇轨道坐标系的惯性测量***一维定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104296747B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105894126A (zh) * | 2016-04-25 | 2016-08-24 | 王景国 | 一种火箭残骸的落点预报模型生成及定位方法 |
CN109018452A (zh) * | 2018-07-27 | 2018-12-18 | 北京航天长征飞行器研究所 | 一种火箭舱段落点位置跟踪与搜索*** |
CN109579833A (zh) * | 2018-12-04 | 2019-04-05 | 上海航天控制技术研究所 | 一种对返回式运载火箭的垂直着陆阶段的组合导航方法 |
CN110873563A (zh) * | 2018-08-30 | 2020-03-10 | 杭州海康机器人技术有限公司 | 一种云台姿态估计方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6056238A (en) * | 1994-08-26 | 2000-05-02 | Northrop Grumman Corporation | Supersonic ground vehicle |
US7900874B2 (en) * | 2008-01-22 | 2011-03-08 | Harvey Emanuel Fiala | Device to move an object back and forth |
US8234943B2 (en) * | 2002-03-01 | 2012-08-07 | Ganid Productions, Llc | Apparatus and method for gyroscopic propulsion |
CN102735267A (zh) * | 2012-06-20 | 2012-10-17 | 北京航天控制仪器研究所 | 一种惯性测量装置火箭橇试验测量方法 |
CN103954301A (zh) * | 2014-05-12 | 2014-07-30 | 北京航天控制仪器研究所 | 惯性测量***基于火箭橇轨道坐标系的定位方法 |
-
2014
- 2014-10-27 CN CN201410584814.4A patent/CN104296747B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6056238A (en) * | 1994-08-26 | 2000-05-02 | Northrop Grumman Corporation | Supersonic ground vehicle |
US8234943B2 (en) * | 2002-03-01 | 2012-08-07 | Ganid Productions, Llc | Apparatus and method for gyroscopic propulsion |
US7900874B2 (en) * | 2008-01-22 | 2011-03-08 | Harvey Emanuel Fiala | Device to move an object back and forth |
CN102735267A (zh) * | 2012-06-20 | 2012-10-17 | 北京航天控制仪器研究所 | 一种惯性测量装置火箭橇试验测量方法 |
CN103954301A (zh) * | 2014-05-12 | 2014-07-30 | 北京航天控制仪器研究所 | 惯性测量***基于火箭橇轨道坐标系的定位方法 |
Non-Patent Citations (1)
Title |
---|
刘璠等: "一种惯性测量装置火箭橇试验误差分离方法", 《中国惯性技术学报》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105894126A (zh) * | 2016-04-25 | 2016-08-24 | 王景国 | 一种火箭残骸的落点预报模型生成及定位方法 |
CN105894126B (zh) * | 2016-04-25 | 2019-10-22 | 王景国 | 一种火箭残骸的落点预报模型生成及定位方法 |
CN109018452A (zh) * | 2018-07-27 | 2018-12-18 | 北京航天长征飞行器研究所 | 一种火箭舱段落点位置跟踪与搜索*** |
CN109018452B (zh) * | 2018-07-27 | 2020-10-23 | 北京航天长征飞行器研究所 | 一种火箭舱段落点位置跟踪与搜索*** |
CN110873563A (zh) * | 2018-08-30 | 2020-03-10 | 杭州海康机器人技术有限公司 | 一种云台姿态估计方法及装置 |
CN109579833A (zh) * | 2018-12-04 | 2019-04-05 | 上海航天控制技术研究所 | 一种对返回式运载火箭的垂直着陆阶段的组合导航方法 |
CN109579833B (zh) * | 2018-12-04 | 2020-07-17 | 上海航天控制技术研究所 | 一种对返回式运载火箭的垂直着陆阶段的组合导航方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104296747B (zh) | 2017-04-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102486377B (zh) | 一种光纤陀螺捷联惯导***初始航向的姿态获取方法 | |
CN101949703B (zh) | 一种捷联惯性/卫星组合导航滤波方法 | |
CN103471616B (zh) | 一种动基座sins大方位失准角条件下初始对准方法 | |
CN104880191B (zh) | 一种基于太阳矢量的偏振辅助导航方法 | |
CN103900565B (zh) | 一种基于差分gps的惯导***姿态获取方法 | |
CN101074881B (zh) | 一种月球探测器软着陆阶段惯性导航方法 | |
CN101706284B (zh) | 提高船用光纤陀螺捷联惯导***定位精度的方法 | |
CN103674034B (zh) | 多波束测速测距修正的鲁棒导航方法 | |
EP2985509A1 (en) | Device and method for determining position of pipeline | |
CN104748761B (zh) | 基于最优姿态匹配的动基座传递对准时延补偿方法 | |
CN101261130B (zh) | 一种船用光纤捷联惯导***传递对准精度评估方法 | |
CN103344260B (zh) | 基于rbckf的捷联惯导***大方位失准角初始对准方法 | |
CN101846510A (zh) | 一种基于星敏感器和陀螺的高精度卫星姿态确定方法 | |
CN106507913B (zh) | 用于管道测绘的组合定位方法 | |
CN105318876A (zh) | 一种惯性里程计组合高精度姿态测量方法 | |
CN104764463B (zh) | 一种惯性平台调平瞄准误差的自检测方法 | |
CN104236586B (zh) | 基于量测失准角的动基座传递对准方法 | |
CN104655131A (zh) | 基于istssrckf的惯性导航初始对准方法 | |
CN101900573B (zh) | 一种实现陆用惯性导航***运动对准的方法 | |
CN105806363A (zh) | 基于srqkf的sins/dvl水下大失准角对准方法 | |
CN105698822A (zh) | 基于反向姿态跟踪的自主式惯性导航行进间初始对准方法 | |
CN106767797A (zh) | 一种基于对偶四元数的惯性/gps组合导航方法 | |
CN104374405A (zh) | 一种基于自适应中心差分卡尔曼滤波的mems捷联惯导初始对准方法 | |
CN105157724B (zh) | 一种基于速度加姿态匹配的传递对准时间延迟估计与补偿方法 | |
CN107063245A (zh) | 一种基于5阶ssrckf的sins/dvl组合导航滤波方法 |
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 |