CN105841697A - 一种多源惯性导航信息合理性判别方法 - Google Patents
一种多源惯性导航信息合理性判别方法 Download PDFInfo
- Publication number
- CN105841697A CN105841697A CN201610177998.1A CN201610177998A CN105841697A CN 105841697 A CN105841697 A CN 105841697A CN 201610177998 A CN201610177998 A CN 201610177998A CN 105841697 A CN105841697 A CN 105841697A
- Authority
- CN
- China
- Prior art keywords
- navigation information
- inertial navigation
- inertial
- count
- information
- 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/165—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 combined with non-inertial navigation instruments
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种多源惯性导航信息合理性判别方法,属于组合导航技术领域,具体涉及一种应用于惯性‑卫星组合导航技术领域,该方法能够在多套惯性导航信息解算单元配置情况下,对惯性导航信息的合理性进行判别和信息进行决策。本发明的方法通过对单拍数据进行有效性判别,以剔除出现故障的惯性解算单元发送的惯性导航信息,提高惯性导航信息的正确性;本发明的方法能够适应通信故障造成的惯性导航信息部分缺失现象,用通信正常的惯性导航信息进行组合导航计算,提高所使用的惯性导航信息的可靠性。
Description
技术领域
本发明涉及一种多源惯性导航信息合理性判别方法,属于组合导航技术领域,具体涉及一种应用于惯性-卫星组合导航技术领域,该方法能够在多套惯性导航信息解算单元配置情况下,对惯性导航信息的合理性进行判别和信息进行决策。
背景技术
惯性导航信息是指利用惯性测量装置敏感到的视加速度和角速度信息,在惯性解算单元中进行导航计算得到的导航信息,包括:惯性信息解算状态标志、惯性导航时间、惯性系位置、速度、用于载体系向惯性系坐标转换矩阵计算的四元数等。进行组合导航计算时,惯性导航信息用于组合导航的输入。
在传统的组合制导技术应用领域,采用单一的惯性信息解算单元配置,即使用唯一的惯性导航信息用于组合导航的输入。新型运载火箭的发展要求制导系统在执行不同的任务和恶劣环境中具有极强的适应性和较高的容错能力,提高系统可靠性的有效设计措施是对惯性信息解算单元进行冗余配置,即增加惯性信息解算单元的数量,每个解算单元产生一组惯性导航信息。当某一个解算单元的导航信息出现错误时,需要进行甄别,以避免使用错误的惯性导航信息,造成导航错误。因此,需要进行多源惯性导航信息合理性判别,完成信息应用决策,以获得准确、可靠的惯性信息,进而完成组合制导计算,实现高精度的入轨目标。
组合导航技术应用时,组合导航软件是实现惯性信息处理和组合导航相关计算的软件;多个惯性解算单元具有时间同步机制,以时间周期T1向组合导航软件输送惯性信息;组合导航软件中以时间周期T2进行惯性信息处理,T2≥T1。组合导航软件在每个T1周期获取惯性导航信息时根据接收结果设置惯性信息通讯状态是否正常。在惯性导航信息应用时,需要计算组合导航周期起始时刻处的惯性导航信息,该时刻处于一个T1周期起始时刻t1和结束时刻t2之间。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提出一种多源惯性导航信息合理性判别方法。
本发明的技术解决方案是:
一种多源惯性导航信息合理性判别方法,该方法的步骤为:
(1)对由多个惯性解算单元输出的第一拍惯性导航信息进行第一拍数据有效性判别,该有效性判别包括惯性导航信息的整数型一致性比较和惯性导航信息的浮点数一致性比较;
(2)步骤(1)中任意两个第一拍惯性导航信息整数型一致且浮点数一致,则认为此两个第一拍惯性导航信息一致,选取其中任意一个第一拍惯性导航信息作为组合导航输入的惯性导航信息;
(3)对由多个惯性解算单元输出的第二拍惯性导航信息进行第二拍数据有效性判别,该有效性判别包括惯性导航信息的整数型一致性比较和惯性导航信息的浮点数一致性比较;
(4)步骤(3)中任意两个第二拍惯性导航信息整数型一致且浮点数一致,则认为此两个第二拍惯性导航信息一致,选取其中任意一个第二拍惯性导航信息作为组合导航输入的惯性导航信息;
(5)判断步骤(2)得到的第一拍惯性导航信息和步骤(4)得到的第二排惯性导航信息是否来自于同一个惯性解算单元,如果是来自于同一个惯性解算单元则进行步骤(6),如果是来自于不同的惯性解算单元则认为惯性导航信息无效,结束本周期工作,等待进入下一个周期的工作;
(6)首先由组合导航软件记录该起始时刻与第二拍惯性导航信息的时刻的时间间隔tgap,然后计算得到组合导航周期起始时刻处的惯性导航信息,即计算组合导航周期起始时刻惯性导航信息的惯性系位置、惯性系速度和载体系向惯性系坐标转换矩阵。
组合导航软件录取时刻t1的惯性导航信息称为第一拍惯性导航信息,组合导航软件录取时刻t2的惯性导航信息称为第二拍惯性导航信息;第一拍惯性导航信息和第二拍惯性导航信息用于合理性判别和选择决策。
步骤(1)和步骤(3)中所述的惯性导航信息的整数型一致性比较是指:判别其中任意两个惯性导航信息的整数型一致,是指惯性导航信息传递的通讯正确,且惯性导航信息中的整数型信息相等。
步骤(1)和步骤(3)中所述的惯性导航信息的浮点数一致性比较是指:判别其中任意两个惯性导航信息的浮点数一致,是指惯性导航信息的速度和位置信息满足如下公式:
且
式中,(xm,ym,zm)表示任意两个惯性导航信息中的一个惯性导航信息中的惯性系位置,(Vx_m,Vy_m,Vz_m)表示任意两个惯性导航信息中的一个惯性导航信息中的惯性系速度,(xn,yn,zn)表示任意两个惯性导航信息中的另一个惯性导航信息中的惯性系位置,(Vx_n,Vy_n,Vz_n)表示任意两个惯性导航信息中的另一个惯性导航信息中的惯性系速度;εinsp为惯性系位置一致性门限,εinsv为惯性系速度一致性门限。
步骤(2)中选取第一拍惯性导航信息作为组合导航输入的惯性导航信息时,以得到的第一拍惯性导航信息一致性最多的作为组合导航的输入。
作为一致性最多的惯性导航信息有两个以上时,按照惯性解算单元的逻辑编号从前往后选取。
所述的步骤(6)中组合导航周期起始时刻处的惯性导航信息的惯性系位置的计算方法为:
其中,(xa,ya,za)为第一拍惯性导航信息的时刻t1的惯性系位置,(xb,yb,zb)为第二拍惯性导航信息的时刻t2的惯性系位置;Kr为时间比例系数,Kr=(T1-tgap)/T1,T1为多个惯性解算单元向组合导航软件输送惯性信息的周期。
所述的步骤(6)中组合导航周期起始时刻处的惯性导航信息的惯性系速度的计算方法为:
其中,(vx_a,vy_a,vz_a)为第一拍惯性导航信息的时刻t1的惯性系速度,(vx_b,vy_b,vz_b)为第二拍惯性导航信息的时刻t2的惯性系速度,(x,y,z)为组合导航周期起始时刻的惯性导航信息惯性系位置,(vx,vy,vz)为组合导航周期起始时刻的惯性导航信息惯性系速度,Kr为时间比例系数,Kr=(T1-tgap)/T1,T1为多个惯性解算单元向组合导航软件输送惯性信息的周期。
所述的步骤(6)中组合导航周期起始时刻处的惯性导航信息的载体系到惯性系的姿态转换矩阵的计算方法为:
设第一拍惯性导航信息的时刻t1的姿态四元数为:第一拍惯性导航信息的时刻t2的姿态四元数为:则从时刻t1到t2间的转动四元数为:
式中,“о”表示四元数相乘;
从时刻t1到时刻t2间转动的角度(Δθx Δθy Δθz)为:
组合导航周期起始时刻处的姿态四元数为:
其中,(Δθx_tΔθy_tΔθz_t)为从时刻t1到组合导航周期起始时刻转动的角度,Δθx_t=Kr·Δθx,Δθy_t=Kr·Δθy,Δθz_t=Kr·Δθz,Kr为时间比例系数,
组合导航周期起始时刻的载体系到惯性系的姿态转换矩阵为:
经过计算后得到组合导航周期起始时刻的惯性系位置和速度、载体系向惯性系坐标转换矩阵,即得到组合导航周期起始时刻处的惯性导航信息用于后续组合导航计算。
有益效果
(1)本发明的方法通过对单拍数据进行有效性判别,以剔除出现故障的惯性解算单元发送的惯性导航信息,提高惯性导航信息的正确性;
(2)本发明的方法能够适应通信故障造成的惯性导航信息部分缺失现象,用通信正常的惯性导航信息进行组合导航计算,提高所使用的惯性导航信息的可靠性;
(3)本发明的方法通过对经过有效性判别的两拍惯性导航信息的处理,精确求得组合导航周期起始时刻处的惯性导航信息,提升组合导航输入信息的准确性,避免由于组合导航周期起始时刻在T1周期时间段内浮动带来的组合导航输入附加偏差问题。
(4)本发明的方法对冗余配置的惯性结算单元的数量没有限制,通用性强;
附图说明
图1为惯性解算单元与组合导航单元的接口关系示意图,多个惯性结算单元都连接至组合导航单元;
图2为惯性导航信息读取过程示意图,多个惯性解算单元具有时间同步机制,以时间周期T1向组合导航单元输送惯性信息;组合导航单元以时间周期T2进行惯性导航信息处理,T2≥T1,组合导航周期起始时刻处于一个T1周期起始时刻t1和结束时刻t2之间;
图3为本发明的方法流程示意图。
具体实施方式
针对“多惯性信息解算单元+单惯性信息融合单元”的硬件架构配置,本发明提出一种多源惯性导航信息合理性判别方法,完成多源的、周期性的惯性导航信息的合理性判别与决策使用方法。
本方法对连续两拍的惯性导航信息进行合理性判别和信息决策,以提高组合导航系统的可靠性。
根据两拍录取到的惯性导航信息,首先逐拍进行数据有效性判别,其次进行两拍惯性导航参数冗余决策,然后根据冗余决策结果,计算融合周期起始时刻的惯性导航信息,完成惯性导航信息的融合计算。
传递的惯性信息数据包括:惯性信息解算状态标志、惯性导航时间、惯性系位置、速度、用于载体系向惯性系坐标转换矩阵计算的四元数等。
一种多源惯性导航信息合理性判别方法,组合导航软件录取时刻t1的惯性导航信息称为第一拍惯性导航信息,组合导航软件录取时刻t2的惯性导航信息称为第二拍惯性导航信息,第一拍惯性导航信息和第二拍惯性导航信息用于合理性判别和选择决策,如图1、图2和图3所示;
该方法的步骤为:
(1)对由多个惯性解算单元输出的第一拍惯性导航信息进行第一拍数据有效性判别,该有效性判别包括惯性导航信息的整数型一致性比较和惯性导航信息的浮点数一致性比较;
所述的惯性导航信息的整数型一致性比较是指:判别其中任意两个惯性导航信息的整数型一致,是指惯性导航信息传递的通讯正确,且惯性导航信息中的整数型信息相等;
所述的惯性导航信息的浮点数一致性比较是指:判别其中任意两个惯性导航信息的浮点数一致,是指惯性导航信息的速度和位置信息满足如下公式:
且
式中,x,y,z为惯性系位置,vx,vy,vz为惯性系速度,xm,ym,zm,Vx_m,Vy_m,Vz_m表示任意两个惯性导航信息中的一个惯性导航位置与速度,xn,yn,zn,Vx_n,Vy_n,Vz_n表示任意两个惯性导航信息中的另一个惯性导航位置与速度;εinsp为位置一致性门限,εinsv为速度一致性门限;有一式不满足即为不一致;
任意两个惯性导航信息整数型一致性且浮点数一致,则认为此两个惯性导航信息一致。
(2)步骤(1)中得到的惯性导航信息一致性最多的作为组合导航的输入,如果一致性最多的惯性导航信息有两个以上,则按照惯性解算单元的逻辑编号从前往后选取,得到第一拍的作为组合导航输入的惯性导航信息;
(3)对第二怕的惯性导航信息采用步骤(1)-(2)的方法进行判别,得到第二拍的作为组合导航输入的惯性导航信息;
(4)判断步骤(2)得到的惯性导航信息和步骤(3)得到的惯性导航信息是否来自于同一个惯性解算单元,如果是来自于同一个惯性解算单元则进行步骤(5),如果是来自于不同的惯性解算单元则认为惯性导航信息无效,结束本周期工作,等待进入下一个周期的工作;
(5)计算组合导航周期起始时刻处的惯性导航信息,即计算组合导航周期起始时刻的惯性系位置和速度、载体系向惯性系坐标转换矩阵。
组合导航软件记录该起始时刻与时刻t2的间隔时间tgap。
1)惯性系位置、速度计算:
惯性系位置:
惯性系速度:
(xa,ya,za)为时刻t1的惯性系位置,(xb,yb,zb)为时刻t2的惯性系位置,(vx_a,vy_a,vz_a)为时刻t1的惯性系速度,(vx_b,vy_b,vz_b)为时刻t2的惯性系速度,(x,y,z)为组合导航周期起始时刻的惯性系位置,(vx,vy,vz)为组合导航周期起始时刻的惯性系速度,Kr为时间比例系数,Kr=(T1-tgap)/T1。
2)载体系到惯性系的姿态转换矩阵计算:
设时刻t1的姿态四元数为:时刻t2的姿态四元数为:则从时刻t1到t2间的转动四元数为:
式中,“о”表示四元数相乘。
从时刻t1到t2间转动的角度(Δθx Δθy Δθz)为:
组合导航周期起始时刻处的姿态四元数为:
其中,Δθx_tΔθy_tΔθz_t为从时刻t1到组合导航周期起始时刻转动的角度,Δθx_t=Kr·Δθx,Δθy_t=Kr·Δθy,Δθz_t=Kr·Δθz,Kr为时间比例系数,
组合导航周期起始时刻的载体系到惯性系的姿态转换矩阵为:
经过计算后得到组合导航周期起始时刻的惯性系位置和速度、载体系向惯性系坐标转换矩阵,即得到组合导航周期起始时刻处的惯性导航信息用于后续组合导航计算。
实施例
某组合导航系统配置有3个惯性解算单元1~3(Process Unit,简称PU1、PU2、PU3),组合导航单元上运行组合导航软件。
时间周期T1=10ms(毫秒),时间周期T2=100ms,某一T1周期起始时刻t1=0.02s,结束时刻t2=0.03s,tgap=0.006s,可计算出组合导航起始时刻为0.024s。
t1时刻组合导航录取的三个惯性解算单元的惯性导航信息如下:
PU1:
通讯正常;
惯性信息自带状态标志=1(1表示正常);
(xa,ya,za)=(10.0,20.0,30.0)
(Vx_a,Vy_a,Vz_a)=(1.0,2.0,3.0)
PU2:
通讯正常;
惯性信息自带状态标志=1(1表示正常);
(xa,ya,za)=(10.01,20.01,30.01)
(Vx_a,Vy_a,Vz_a)=(1.01,2.01,3.01)
PU3:
通讯正常;
惯性信息自带状态标志=1(1表示正常);
(xa,ya,za)=(11.0,21.0,31.0)
(Vx_a,Vy_a,Vz_a)=(1.5,2.5,3.5)
t2时刻组合导航录取的三个惯性结算单元的惯性导航信息如下:
PU1:
通讯正常;
惯性信息自带状态标志=1(1表示正常);
(xb,yb,zb)=(100.0,200.0,300.0)
(Vx_b,Vy_b,Vz_b)=(10.0,20.0,30.0)
PU2:
通讯正常;
惯性信息自带状态标志=1(1表示正常);
(xb,yb,zb)=(100.01,200.01,300.01)
(Vx_b,Vy_b,Vz_b)=(10.01,20.01,30.01)
PU3:
通讯正常;
惯性信息自带状态标志=0(0表示不正常);
(xb,yb,zb)=(101.0,201.0,301.0)
(Vx_b,Vy_b,Vz_b)=(10.5,20.5,30.5)
位置一致性门限εinsp=0.2,速度一致性门限εinsv=0.1;
步骤(1)结果:
惯性导航信息的整数型一致性比较:
PU1与PU2整数型一致,PU2与PU3整数型一致,PU1与PU3整数型一致;
PU1与PU2浮点数一致,PU2与PU3浮点数不一致,PU1与PU3浮点数不一致;
则PU1与PU2惯性导航信息一致,PU2与PU3惯性导航信息不一致,PU1与PU3惯性导航信息不一致;
步骤(2)结果:
PU1与PU2一致,PU1的一致次数为1,PU2的一致次数为1,PU3的一致次数为0,PU1比PU2逻辑排序,取PU1的惯性导航信息作为第一拍的惯性导航信息;
步骤(3)结果:
PU1与PU2整数型一致,PU2与PU3整数型不一致,PU1与PU3整数型不一致;
PU1与PU2浮点数一致,PU2与PU3浮点数不一致,PU1与PU3浮点数不一致;
则PU1与PU2惯性导航信息一致,PU2与PU3惯性导航信息不一致,PU1与PU3惯性导航信息不一致;
PU1与PU2一致,PU1的一致次数为1,PU2的一致次数为1,PU3的一致次数为0,PU1比PU2逻辑排序靠前,取PU1的惯性导航信息作为第二拍的惯性导航信息;
步骤(4)结果:
步骤(2)得到的惯性导航信息和步骤(3)得到的惯性导航信息来自于同一个惯性解算单元PU1。
步骤(5):
惯性系位置:
惯性系速度:
得到组合导航周期起始时刻处的惯性系位置和速度、载体系向惯性系坐标转换矩阵用于后续组合导航计算。
Claims (9)
1.一种多源惯性导航信息合理性判别方法,其特征在于该方法的步骤为:
(1)对由多个惯性解算单元输出的第一拍惯性导航信息进行第一拍数据有效性判别,该有效性判别包括惯性导航信息的整数型一致性比较和惯性导航信息的浮点数一致性比较;
(2)步骤(1)中任意两个第一拍惯性导航信息整数型一致且浮点数一致,则认为此两个第一拍惯性导航信息一致,选取其中任意一个第一拍惯性导航信息作为组合导航输入的惯性导航信息;
(3)对由多个惯性解算单元输出的第二拍惯性导航信息进行第二拍数据有效性判别,该有效性判别包括惯性导航信息的整数型一致性比较和惯性导航信息的浮点数一致性比较;
(4)步骤(3)中任意两个第二拍惯性导航信息整数型一致且浮点数一致,则认为此两个第二拍惯性导航信息一致,选取其中任意一个第二拍惯性导航信息作为组合导航输入的惯性导航信息;
(5)判断步骤(2)得到的第一拍惯性导航信息和步骤(4)得到的第二排惯性导航信息是否来自于同一个惯性解算单元,如果是来自于同一个惯性解算单元则进行步骤(6),如果是来自于不同的惯性解算单元则认为惯性导航信息无效,结束本周期工作,等待进入下一个周期的工作;
(6)首先由组合导航软件记录该起始时刻与第二拍惯性导航信息的时刻的时间间隔tgap,然后计算得到组合导航周期起始时刻处的惯性导航信息,即计算组合导航周期起始时刻惯性导航信息的惯性系位置、惯性系速度和载体系向惯性系坐标转换矩阵。
2.根据权利要求1所述的一种多源惯性导航信息合理性判别方法,其特征在于:组合导航软件录取时刻t1的惯性导航信息称为第一拍惯性导航信息,组合导航软件录取时刻t2的惯性导航信息称为第二拍惯性导航信息;第一拍惯性导航信息和第二拍惯性导航信息用于合理性判别和选择决策。
3.根据权利要求1所述的一种多源惯性导航信息合理性判别方法,其特征在于:步骤(1)和步骤(3)中所述的惯性导航信息的整数型一致性比较是指:判别其中任意两个惯性导航信息的整数型一致,是指惯性导航信息传递的通讯正确,且惯性导航信息中的整数型信息相等。
4.根据权利要求1所述的一种多源惯性导航信息合理性判别方法,其特征在于:步骤(1)和步骤(3)中所述的惯性导航信息的浮点数一致性比较是指:判别其中任意两个惯性导航信息的浮点数一致,是指惯性导航信息的速度和位置信息满足如下公式:
且
式中,(xm,ym,zm)表示任意两个惯性导航信息中的一个惯性导航信息中的惯性系位置,(Vx_m,Vy_m,Vz_m)表示任意两个惯性导航信息中的一个惯性导航信息中的惯性系速度,(xn,yn,zn)表示任意两个惯性导航信息中的另一个惯性导航信息中的惯性系位置,(Vx_n,Vy_n,Vz_n)表示任意两个惯性导航信息中的另一个惯性导航信息中的惯性系速度;εinsp为惯性系位置一致性门限,εinsv为惯性系速度一致性门限。
5.根据权利要求1所述的一种多源惯性导航信息合理性判别方法,其特征在于:步骤(2)中选取第一拍惯性导航信息作为组合导航输入的惯性导航信息时,以得到的第一拍惯性导航信息一致性最多的作为组合导航的输入。
6.根据权利要求5所述的一种多源惯性导航信息合理性判别方法,其特征在于:作为一致性最多的惯性导航信息有两个以上时,按照惯性解算单元的逻辑编号从前往后选取。
7.根据权利要求1所述的一种多源惯性导航信息合理性判别方法,其特征在于:所述的步骤(6)中组合导航周期起始时刻处的惯性导航信息的惯性系位置的计算方法为:
其中,(xa,ya,za)为第一拍惯性导航信息的时刻t1的惯性系位置,(xb,yb,zb)为第二拍惯性导航信息的时刻t2的惯性系位置;Kr为时间比例系数,Kr=(T1-tgap)/T1,T1为多个惯性解算单元向组合导航软件输送惯性信息的周期。
8.根据权利要求1所述的一种多源惯性导航信息合理性判别方法,其特征在于:所述的步骤(6)中组合导航周期起始时刻处的惯性导航信息的惯性系速度的计算方法为:
其中,(vx_a,vy_a,vz_a)为第一拍惯性导航信息的时刻t1的惯性系速度,(vx_b,vy_b,vz_b)为第二拍惯性导航信息的时刻t2的惯性系速度,(x,y,z)为组合导航周期起始时刻的惯性导航信息惯性系位置,(vx,vy,vz)为组合导航周期起始时刻的惯性导航信息惯性系速度,Kr为时间比例系数,Kr=(T1-tgap)/T1,T1为多个惯性解算单元向组合导航软件输送惯性信息的周期。
9.根据权利要求1所述的一种多源惯性导航信息合理性判别方法,其特征在于:所述的步骤(6)中组合导航周期起始时刻处的惯性导航信息的载体系到惯性系的姿态转换矩阵的计算方法为:
设第一拍惯性导航信息的时刻t1的姿态四元数为:第一拍惯性导航信息的时刻t2的姿态四元数为:则从时刻t1到t2间的转动四元数为:
式中,“ο”表示四元数相乘;
从时刻t1到时刻t2间转动的角度(Δθx Δθy Δθz)为:
组合导航周期起始时刻处的姿态四元数为:
其中,(Δθx_tΔθy_tΔθz_t)为从时刻t1到组合导航周期起始时刻转动的角度,Δθx_t=Kr·Δθx,Δθy_t=Kr·Δθy,Δθz_t=Kr·Δθz,Kr为时间比例系数,
组合导航周期起始时刻的载体系到惯性系的姿态转换矩阵为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610177998.1A CN105841697B (zh) | 2016-03-25 | 2016-03-25 | 一种多源惯性导航信息合理性判别方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610177998.1A CN105841697B (zh) | 2016-03-25 | 2016-03-25 | 一种多源惯性导航信息合理性判别方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105841697A true CN105841697A (zh) | 2016-08-10 |
CN105841697B CN105841697B (zh) | 2018-12-21 |
Family
ID=56583494
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610177998.1A Active CN105841697B (zh) | 2016-03-25 | 2016-03-25 | 一种多源惯性导航信息合理性判别方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105841697B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106813663A (zh) * | 2017-02-24 | 2017-06-09 | 北京航天自动控制研究所 | 一种惯性导航数据与卫星导航数据同步方法 |
CN106997053A (zh) * | 2017-02-24 | 2017-08-01 | 北京航天自动控制研究所 | 一种共支架基座三捷联惯组导航一致性试验方法 |
CN107544466A (zh) * | 2017-09-15 | 2018-01-05 | 北京控制工程研究所 | 一种单框架控制力矩陀螺低速框架故障诊断方法 |
CN109878543A (zh) * | 2019-04-04 | 2019-06-14 | 河南思维轨道交通技术研究院有限公司 | 一种机车头灯智能转向控制方法和系统 |
CN111337963A (zh) * | 2020-05-21 | 2020-06-26 | 蓝箭航天空间科技股份有限公司 | 组合导航用基准信息的判断方法、判断装置及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3872284A (en) * | 1972-09-18 | 1975-03-18 | Us Navy | Ships inertial navigation storage and retrieval system (sinsars) |
CN101738499A (zh) * | 2009-12-24 | 2010-06-16 | 北京航天自动控制研究所 | 一种在加速度表八表配置下的故障诊断方法 |
CN102506857A (zh) * | 2011-11-28 | 2012-06-20 | 北京航空航天大学 | 一种基于双imu/dgps组合的相对姿态测量实时动态滤波方法 |
CN104898678A (zh) * | 2015-03-30 | 2015-09-09 | 北京航天自动控制研究所 | 一种运载火箭飞行控制的冗余诊断方法 |
CN105424035A (zh) * | 2015-10-30 | 2016-03-23 | 北京航天控制仪器研究所 | 惯性测量系统多传感器冗余方法 |
-
2016
- 2016-03-25 CN CN201610177998.1A patent/CN105841697B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3872284A (en) * | 1972-09-18 | 1975-03-18 | Us Navy | Ships inertial navigation storage and retrieval system (sinsars) |
CN101738499A (zh) * | 2009-12-24 | 2010-06-16 | 北京航天自动控制研究所 | 一种在加速度表八表配置下的故障诊断方法 |
CN102506857A (zh) * | 2011-11-28 | 2012-06-20 | 北京航空航天大学 | 一种基于双imu/dgps组合的相对姿态测量实时动态滤波方法 |
CN104898678A (zh) * | 2015-03-30 | 2015-09-09 | 北京航天自动控制研究所 | 一种运载火箭飞行控制的冗余诊断方法 |
CN105424035A (zh) * | 2015-10-30 | 2016-03-23 | 北京航天控制仪器研究所 | 惯性测量系统多传感器冗余方法 |
Non-Patent Citations (1)
Title |
---|
贾鹏等: "基于冗余惯性组件故障诊断方法的比较研究", 《系统仿真学报》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106813663A (zh) * | 2017-02-24 | 2017-06-09 | 北京航天自动控制研究所 | 一种惯性导航数据与卫星导航数据同步方法 |
CN106997053A (zh) * | 2017-02-24 | 2017-08-01 | 北京航天自动控制研究所 | 一种共支架基座三捷联惯组导航一致性试验方法 |
CN106997053B (zh) * | 2017-02-24 | 2019-11-12 | 北京航天自动控制研究所 | 一种共支架基座三捷联惯组导航一致性试验方法 |
CN106813663B (zh) * | 2017-02-24 | 2020-02-14 | 北京航天自动控制研究所 | 一种惯性导航数据与卫星导航数据同步方法 |
CN107544466A (zh) * | 2017-09-15 | 2018-01-05 | 北京控制工程研究所 | 一种单框架控制力矩陀螺低速框架故障诊断方法 |
CN107544466B (zh) * | 2017-09-15 | 2019-08-09 | 北京控制工程研究所 | 一种单框架控制力矩陀螺低速框架故障诊断方法 |
CN109878543A (zh) * | 2019-04-04 | 2019-06-14 | 河南思维轨道交通技术研究院有限公司 | 一种机车头灯智能转向控制方法和系统 |
CN111337963A (zh) * | 2020-05-21 | 2020-06-26 | 蓝箭航天空间科技股份有限公司 | 组合导航用基准信息的判断方法、判断装置及存储介质 |
CN111337963B (zh) * | 2020-05-21 | 2020-08-25 | 蓝箭航天空间科技股份有限公司 | 组合导航用基准信息的判断方法、判断装置及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN105841697B (zh) | 2018-12-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105841697A (zh) | 一种多源惯性导航信息合理性判别方法 | |
CN106325264B (zh) | 一种无人机飞行控制系统的故障可分离性评价方法 | |
WO2021057894A1 (zh) | 一种基于车辆零速检测的惯性导航误差修正方法 | |
Flocchini et al. | Arbitrary pattern formation by asynchronous, anonymous, oblivious robots | |
CN106445130A (zh) | 一种用于手势识别的动作捕捉手套及其校准方法 | |
CN105539883B (zh) | 一种基于矢量匹配的多敏感器星上自主互校验方法 | |
CN110035939A (zh) | 车辆控制装置 | |
CN103256928A (zh) | 一种分布式惯性导航系统及其姿态传递对准方法 | |
CN103868513B (zh) | 一种分布式pos用数据处理计算机系统 | |
RU2424944C1 (ru) | Система управления судном | |
CN107544466B (zh) | 一种单框架控制力矩陀螺低速框架故障诊断方法 | |
CN107168357A (zh) | 一种考虑姿态约束与抗退绕的航天器姿态机动控制方法 | |
CN104331078B (zh) | 一种基于位置映射算法的多机器人协作定位方法 | |
CN102520728B (zh) | 一种采用双天线gps实现可控翼伞精确定点回收的方法 | |
CN105865455A (zh) | 一种利用gps与加速度计计算飞行器姿态角的方法 | |
CN105241319B (zh) | 一种高速自旋制导炮弹空中实时对准方法 | |
CN105698788A (zh) | 产生两个独立不同的姿态解、惯性解或两者的系统和方法 | |
CN101726319A (zh) | 具有参数注入功能的星敏感器模拟方法 | |
CN103968848A (zh) | 一种基于惯性传感器的导航方法及导航系统 | |
CN104764464B (zh) | 一种利用全量信息进行飞行器冗余诊断的方法 | |
CN109163737A (zh) | 一种基于多路子惯导闭环自校验的传递对准方法及装置 | |
US20220283298A1 (en) | Vehicle localization precision enhancement via multi-sensor fusion | |
CN103759740B (zh) | 一种巡视器静态时陀螺故障自主诊断方法 | |
CN117405109A (zh) | 基于四元数球面线性加权的三套惯导系统姿态表决方法 | |
CN110032532A (zh) | 一种基于定时中断触发的主从式串口通讯方法 |
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 |