CN103344259B - 一种基于杆臂估计的ins/gps组合导航***反馈校正方法 - Google Patents
一种基于杆臂估计的ins/gps组合导航***反馈校正方法 Download PDFInfo
- Publication number
- CN103344259B CN103344259B CN201310289324.7A CN201310289324A CN103344259B CN 103344259 B CN103344259 B CN 103344259B CN 201310289324 A CN201310289324 A CN 201310289324A CN 103344259 B CN103344259 B CN 103344259B
- Authority
- CN
- China
- Prior art keywords
- error
- lever arm
- gps
- ins
- feedback correction
- 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.)
- Expired - Fee Related
Links
- 238000012937 correction Methods 0.000 title claims abstract description 58
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000001914 filtration Methods 0.000 claims description 30
- 238000005070 sampling Methods 0.000 claims description 29
- 238000005259 measurement Methods 0.000 claims description 28
- 239000011159 matrix material Substances 0.000 claims description 20
- 238000004364 calculation method Methods 0.000 claims description 11
- 230000008569 process Effects 0.000 claims description 7
- 230000009466 transformation Effects 0.000 claims description 3
- 125000004432 carbon atom Chemical group C* 0.000 claims description 2
- 230000009897 systematic effect Effects 0.000 abstract 1
- 230000007704 transition Effects 0.000 description 4
- 238000009825 accumulation Methods 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 230000001568 sexual effect Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Landscapes
- Navigation (AREA)
Abstract
一种基于杆臂估计的INS/GPS组合导航***反馈校正方法,该方法将杆臂误差扩展至***误差状态向量中进行估计,通过比较杆臂估计值与真实值之差是否在误差阈值范围内,来判断惯性器件随机误差是否得到准确估计。当杆臂估计值误差小于设定阈值时惯性器件误差得到有效估计,利用估计出的惯性器件随机常值误差修正陀螺仪及加速度计测量输出,并在组合Kalman滤波时进行全反馈校正,反之,则不对惯性器件误差进行反馈校正。本发明可实现对惯性器件随机常值误差进行有效估计并进行全反馈校正,能够有效提高INS/GPS组合导航***的精度。
Description
技术领域
本发明涉及一种INS/GPS组合导航***的误差估计及反馈校正方法。既可对导航参数误差进行精确估计及反馈校正,又可对惯性器件随机常值误差进行准确估计及反馈校正。
背景技术
INS/GPS组合导航***是一种利用GPS长期定位精度高及INS短期定位定向精度高实现优势互补的组合导航***。通常采用卡尔曼滤波去估计惯性导航***的各误差状态,再用误差状态估值去校正***,达到综合的目的。校正一般有两种方式:输出校正(开环卡尔曼滤波器)和反馈校正(闭环卡尔曼滤波器)。
输出校正与反馈校正的区别在于:在利用导航参数误差的估值校正***输出的导航参数后,输出校正时导航参数误差估计值不归零,而反馈校正时导航参数误差估计值归零。从本质上讲,输出校正与反馈校正精度相同。输出校正时,估计的导航误差参数没有归零,随着计算时间的累计,待估计的导航参数误差变大,导致INS***误差模型变为非线性。由于卡尔曼滤波主要适用于线性***,因此,输出校正时卡尔曼滤波估计的精度随计算时间累计而降低,甚至出现崩溃。因此在INS/GPS组合导航时必须对导航参数误差进行反馈校正。当前的导航参数误差反馈校正方案通常包括两种:一是混合校正方案,在滤波初始阶段,由于各项误差未得到准确估计,采用输出校正的方案,而经过一段时间后,在误差状态得到准确估计后,对导航参数误差进行反馈校正;二是不完全反馈校正方案。该方案仅对惯性导航解算出的位置、速度、姿态误差进行反馈校正,不对惯性器件随机常值误差进行反馈校正;
除导航参数误差外,惯性器件误差也是INS/GPS组合导航***的一个重要误差源,由于无法确定惯性器件随机常值误差是否得到准确估计,在通常的反馈校正方案中,一般不对惯性器件随机常值误差进行反馈校正。这是因为,在一个滤波周期内,由惯性器件随机常值误差引起的INS误差较小。且由于INS误差方程中位置、速度、姿态误差与惯性器件误差的耦合特性,当对导航参数误差进行反馈校正时间接地抑制了惯性器件随机常值误差产生的误差的累积。然而,如果能准确估计出惯性器件的随机常值误差,不仅可有效降低滤波区间内的INS误差,还可提高GPS信号采样点处kalman滤波的估计精度。尤其在GPS信号失锁时,INS/GPS组合导航***无法对INS误差进行校正,惯性器件随机常值误差对***输出影响显著增大,此时必须考虑惯性器件随机常值误差的反馈校正方案。
当前INS/GPS组合导航***的两种校正方案均存在以下不足:1、由于无绝对参考基准,缺乏判断导航***误差参数得到准确估计的条件。2、没有对惯性器件随机常值误差进行反馈校正,降低了INS/GPS组合导航***的精度。
发明内容
本发明的技术解决的问题是:比较杆臂估值与真实值之误差是否达到设定阈值范围内来判断惯性器件随机常值误差是否得到了准确估计,并将此作为INS/GPS组合导航***执行不完全反馈校正和全反馈校正方案的依据。
本发明的技术解决方案为:一种基于杆臂估计的INS/GPS组合导航***反馈校正方法。其特征在于包括下列步骤:
(1)进行飞行试验前,利用激光全站仪测量出INS/GPS组合导航***中IMU至GPS天线间的真实杆臂Rt;
(2)采集飞行试验过程中INS/GPS组合导航***的惯性测量数据及GPS数据,其中惯性测量数据包括三轴陀螺仪数据和三轴加速度计数据x,y,z轴的陀螺仪数据分别表示为x,y,z轴的加速度计数据分别表示为GPS数据包括GPS时间及当地地理系下的位置和速度,其中位置包括纬度Lgps,经度λgps及高度Hgps,速度包括东向速度VEgps,北向速度VNgps,天向速度VUgps,记第i个GPS采样时刻的GPS时间为Tgps(i),i=1,2,…,n,n为一次飞行试验过程中飞机从起飞至降落时的飞行总时间,单位为秒;
(3)根据步骤(1)测量的真实杆臂Rt给定杆臂初值Rini=Rt-[0.5,0.5,0.5]T,并根据C/A码GPS信号中的位置误差精度给定杆臂误差阈值为Rth,采用包括位置误差δP、速度误差δV、失准角误差ψ、陀螺随机常值漂移εg,加速度计随机常值零偏εa及杆臂误差δl在内的18维误差状态作为Kalman滤波器的误差状态向量,在GPS信号未到来时,利用步骤(2)采集到的惯性测量数据进行惯性导航解算;当GPS信号到来时,在GPS采样时刻进行Kalman滤波,对18维误差状态向量进行估计。每次滤波后,利用滤波估计出的位置误差δP、速度误差δV、失准角误差ψ对INS解算结果进行反馈校正,利用杆臂误差δl对杆臂初值Rini进行校正得到杆臂估计值Re,同时用反馈校正后的杆臂估计值Re更新Rini。
(4)将步骤(3)得到的杆臂估计值Re与步骤(1)测量的真实杆臂Rt相比,如果其误差小于步骤(3)给定的杆臂误差阈值Rth时,将此时估计得到的陀螺漂移εg和加速度计零偏εa作为陀螺漂移估计值εge和加速度计零偏估计值εae,在下一个GPS采样时刻,执行步骤(5);否则,在下一个GPS采样时刻,返回执行步骤(3)。
(5)去掉步骤(3)中18维状态向量中的3个杆臂误差,得到15维向量,将该15维状态向量作为Kalman滤波器误差状态向量,利用步骤(4)获取的惯性器件随机常值误差εge和εae校正陀螺和加速度计采样值,利用修正后的陀螺及加速度计数据进行INS解算,在GPS采样时刻,利用步骤(1)的真实杆臂Rt进行杆臂误差补偿,采用15维状态向量的kalman滤波器进行全反馈INS/GPS组合导航。
本发明的原理是:在飞行前,对IMU至GPS天线之间的杆臂值进行精确测量,该值在整个飞行过程中保持不变,将其作为杆臂估值误差的参考基准。当杆臂误差可观测时载体需要进行变化的角机动。变化的角机动使得惯性器件随机常值误差变为可观测状态。因此,利用杆臂估计值与真实值之差是否收敛到预设的误差阈值范围内就可判断出惯性器件随机常值误差是否得到准确估计。本发明分为两个阶段,第一阶段是INS/GPS组合导航不完全反馈校正阶段:此阶段采用包括杆臂误差在内的18维***误差状态向量。在每个GPS采样点进行卡尔曼滤波,对估计得到的位置误差、速度误差、姿态误差和杆臂误差进行反馈校正,不对惯性器件随机常值误差进行反馈校正。当杆臂估计值与真值相比较,如果其误差到达设定阈值范围内,则将此时估计得到的性器件随机常值误差作为其准确估计值,在下一个GPS采样时刻进入第二阶段全反馈校正阶段。否则在下一个GPS采样时刻依然执行第一阶段的不完全反馈校正。第二阶段为INS/GPS组合导航全反馈校正阶段:此时,采用不包括杆臂误差在内的15维***误差模型,在滤波模型中,利用测得的杆臂真值进行杆臂误差补偿。在每个GPS采样时刻,对位置误差、速度误差及姿态误差进行反馈校正,利用第一阶段得到的惯性器件随机常值误差准确估计值校正陀螺及加速度计输出,从而实现INS/GPS组合导航***的全反馈校正。
本发明与现有技术相比的优点在于:本发明中,由于杆臂真实值不随时间及载体动态变化,可作为绝对基准。通过判断杆臂估计值与真实值之差是否在阈值内确定惯性器件随机常值误差是否得到有效估计,既给出了***执行不完全反馈校正和全反馈校正的条件,有利于***实现,又能准确估计出惯性器件随机常值误差进行反馈校正,提高了INS/GPS组合导航***的精度。
附图说明
图1为本发明的基于杆臂估计的INS/GPS组合导航***反馈校正方法流程图;
图2为本发明的步骤3中离散化Kalman滤波示意图。
具体实施方式
一种基于杆臂估计的INS/GPS组合导航***反馈校正方法主要分为两个阶段:第一阶段是基于包含杆臂误差在内的18维***误差状态模型的不完全反馈校正***;第二阶段是不包含杆臂误差在内的15维***误差状态模型全反馈校正阶段。
本发明的具体实施步骤如下:
(1)进行飞行试验前,利用激光全站仪测量出INS/GPS组合导航***中IMU至GPS天线间的真实杆臂Rt;
(2)采集飞行试验过程中INS/GPS组合导航***的惯性测量数据及GPS数据,其中惯性测量数据包括三轴陀螺仪数据和三轴加速度计数据x,y,z轴的陀螺仪数据分别表示为x,y,z轴的加速度计数据分别表示为GPS数据包括GPS时间及当地地理系下的位置和速度,其中位置包括纬度Lgps,经度λgps及高度Hgps,速度包括东向速度VEgps,北向速度VNgps,天向速度VUgps,记第i个GPS采样时刻的GPS时间为Tgps(i),i=1,2,…,n,n为一次飞行试验过程中飞机从起飞至降落时的飞行总时间,单位为秒;
(3)根据步骤(1)测量的真实杆臂Rt给定杆臂初值Rini=Rt-[0.5,0.5,0.5]T,并根据C/A码GPS信号中的位置误差精度给定杆臂误差阈值为Rth,采用包括位置误差δP、速度误差δV、失准角误差ψ、陀螺随机常值漂移εg,加速度计随机常值零偏εa及杆臂误差δl在内的18维误差状态作为Kalman滤波器的误差状态向量,在GPS信号未到来时,利用步骤(2)采集到的惯性测量数据进行惯性导航解算;当GPS信号到来时,在GPS采样时刻进行Kalman滤波,对18维误差状态向量进行估计。每次滤波后,利用滤波估计出的位置误差δP、速度误差δV、失准角误差ψ对INS解算结果进行反馈校正,利用杆臂误差δl对杆臂初值Rini进行校正得到杆臂估计值Re,同时用反馈校正后的杆臂估计值Re更新Rini。
①利用步骤(2)采集的惯性测量数据进行INS解算,捷联解算输出包括位置、速度、和姿态。位置包括纬度Li、经度λi和高度Hi,速度包括东向速度VEi、北向速度VNi及天向速度VUi及姿态:航向角ψi,俯仰角θi,滚动角γi;
②当采集到GPS信号时,利用同一时刻的INS解算输出和GPS信息进行Kalman滤波解算。
a.建立Kalman滤波******方程
其中,x为***误差状态矢量,w为***噪声矢量,F为***状态转移矩阵,G为***噪声转换矩阵:
***误差状态向量x=[xfxaxl]T
xf=[δLδλδHδVEδVNδVUφEφNφU]T
xa=[εgxεgyεgzεaxεayεaz]T
xl=[δlxδlyδlz]T
其中,δL、δλ、δH分别代表惯性导航位置误差中的纬度误差、经度误差和高度误差;δVE、δVN、δVU分别代表惯性导航速度误差中东向速度误差、北向速度误差和天向速度误差;φE、φN、φU分别代表惯性导航失准角误差中的东向失准角、北向失准角、天向失准角;εgx、εgy、εgz分别代表x轴陀螺、y轴陀螺和z轴陀螺的随机常值漂移;εax、εay、εaz分别代表x轴加速度计、y轴加速度计和z轴加速度计的随机常值零偏;δlx、δly和δlz分别代表x轴、y轴、z轴的杆臂误差。
其中, 是载体系到导航系的姿态变换矩阵。
其中,分别为x轴陀螺、y轴陀螺和z轴陀螺的噪声。 和分别为x轴加速度计,y轴加速度计和z轴加速度计的噪声。
***状态转移矩阵中各子矩阵表示如下:
上式中,RM、RN分别为地球的子午圈主曲率半径,卯酉圈主曲率半径,ωie为地球自转角速度。
b.建立Kalman滤波量测方程
IMU至GPS天线间的杆臂引起的位置误差和速度误差表示如下:
其中,
上式中,为载体系至导航系的姿态转换矩阵。
Kalman滤波量测方程为:z=Hx+zR+v
其中,z为量测向量,H为量测矩阵,v为量测噪声。
量测向量为GPS采样时刻的INS与GPS位置、速度之差。
z=[δL′δλ′δH′δV′EδV′NδV′U]T
量测矩阵H=[HPHV]T
HP=[diag([RM+Hi,(RN+Hi)cosLi,1])03×12lc]
其中,
w和v为零均值的高斯白噪声,即满足:
式中:Q∈Rl×l过程噪声方差阵,为非负定阵;R∈Rm×m为量测噪声方差阵,为正定阵;△t为采样时间间隔。
c.Kalman滤波***方程和量测方程离散化
令t=tk-1,t+△t=tk。tk时刻的线性离散型***方程可表示为:
zk=Hkxk+vk
式中:Φk/k-1为状态转移矩阵F的离散化形式。当△t(即滤波周期)较短时,F(t)可近似看作常阵,即
F(t)≈F(tk-1)tk-1≤t<tk
此时,状态转移矩阵Φk/k-1有如下计算式:
离散化的卡尔曼滤波基本算法编排:
状态一步预测方程
状态估值计算方程
滤波增量方程
一步预测均方误差方程
估计均方误差方程
卡尔曼滤波流程图如图2所示,左右侧回路分别为增益计算回路及滤波计算回路。在增益计算回路中,根据***状态转移矩阵Φk/k-1、前一时刻的估计均方误差Pk-1、***噪声方差阵Qk-1得到一步预测均方误差Pk/k-1,由Pk/k-1及观测矩阵Hk和量测噪声方差阵Rk得到滤波增益阵Kk。根据Kk及Pk/k-1得到本次估计均方误差。在滤波计算回路中,由前一时刻状态估值及Φk/k-1得到状态单步预测由量测Zk及滤波增益Kk得到状态估计
经过卡尔曼滤波,得到该时刻的位置误差估计值δL、δλ、δH;速度误差估计值δVE、δVN、δVU;失准角误差估计值为φE、φN、φU;陀螺随机常值漂移估计值εgx、εgy、εgz;加速度计随机常值零偏估计值εax、εay、εaz;杆臂误差估计值δlx、δly、δlz。
d.反馈校正
将Kalman滤波估计的位置误差、速度误差、姿态误差反馈至INS解算输出,对INS解算输出的位置、速度、姿态进行校正。利用杆臂误差δl对杆臂初值Rini进行校正得到杆臂估计值Re,同时用反馈校正后的杆臂估计值Re更新Rini;
位置误差校正:
[LλH]T=[LiλiHi]T-[δLδλδH]T
速度误差校正:
[VEVNVU]T=[VEiVUiVNi]T-[δVEδVNδVU]T
姿态误差校正:
由修正后的可解得航向角Ψ、俯仰角θ和滚动角γ。
杆臂误差反馈校正:
Re=Rini-xl
校正后利用杆臂估计值Re更新杆臂初值,以进行下一次迭代计算。
Rini=Re
反馈后,参与反馈的误差状态归零:
xf=0,xl=0。
(4)将步骤(3)得到的杆臂估计值Re与步骤(1)测量的真实杆臂Rt相比,如果其误差小于步骤(3)给定的杆臂误差阈值Rth时,将此时估计得到的陀螺漂移εg和加速度计零偏εa作为陀螺漂移估计值εge和加速度计零偏估计值εae,在下一个GPS采样时刻,执行步骤(5);否则,在下一个GPS采样时刻,返回执行步骤(3)。
当||Re-Rt||<Rth时,εge=εg,εae=εa;
其中,
(5)去掉步骤(3)中18维状态向量中的3个杆臂误差,得到15维向量,将该15维状态向量作为Kalman滤波器误差状态向量,利用步骤(4)获取的惯性器件随机常值误差εge和εae校正陀螺和加速度计采样值,利用修正后的陀螺及加速度计数据进行INS解算,在GPS采样时刻,利用步骤(1)的真实杆臂Rt进行杆臂误差补偿,采用15维状态向量的kalman滤波器进行全反馈INS/GPS组合导航。步骤如下:
①在每个惯性测量数据采样时刻,利用步骤(4)得到的εge和εae校正陀螺及加速度计输出,利用校正后的值进行INS解算。
②在每次GPS采样时刻进行Kalman滤波时,利用不含杆臂误差的15维状态向量进行Kalman滤波全反馈校正估计。
15维误差状态向量表示为:
x=[xfxa]T
xf=[δLδλδHδVEδVNδVUφEφNφU]T
xa=[εgxεgyεgzεaxεayεaz]T
全反馈Kalman滤波离散化方程表示如下:
状态一步预测方程:
状态估值计算方程:
滤波增量方程:
一步预测均方误差方程:
估计均方误差方程:
全反馈Kalman滤波离散化方程各符号与不完全反馈表示意义相同。
Claims (3)
1.一种基于杆臂估计的INS/GPS组合导航***反馈校正方法,其特征在于包括下列步骤:
(1)进行飞行试验前,利用激光全站仪测量出INS/GPS组合导航***中IMU至GPS天线间的真实杆臂Rt;
(2)采集飞行试验过程中INS/GPS组合导航***的惯性测量数据及GPS数据,其中惯性测量数据包括三轴陀螺仪数据和三轴加速度计数据x,y,z轴的陀螺仪数据分别表示为x,y,z轴的加速度计数据分别表示为GPS数据包括GPS时间及当地地理系下的位置和速度,其中位置包括纬度Lgps,经度λgps及高度Hgps,速度包括东向速度VEgps,北向速度VNgps,天向速度VUgps,记第i个GPS采样时刻的GPS时间为Tgps(i),i=1,2,…,n,其中n为一次飞行试验过程中飞机从起飞至降落时的飞行总时间,单位为秒;
(3)根据步骤(1)测量的真实杆臂Rt给定杆臂初值Rini=Rt-[0.5,0.5,0.5]T,并根据C/A码GPS信号中的位置误差精度给定杆臂误差阈值为Rth,采用包括位置误差δP、速度误差δV、失准角误差ψ、陀螺随机常值漂移εg,加速度计随机常值零偏εa及杆臂误差δl在内的18维误差状态作为Kalman滤波器的误差状态向量,在GPS信号未到来时,利用步骤(2)采集到的惯性测量数据进行惯性导航解算;当GPS信号到来时,在GPS采样时刻进行Kalman滤波,对18维误差状态进行滤波估计;每次滤波后,利用滤波估计出的位置误差δP、速度误差δV、失准角误差ψ对INS解算结果进行反馈校正,利用杆臂误差δl对杆臂初值Rini进行校正得到杆臂估计值Re,同时用反馈校正后的杆臂估计值Re更新Rini;
(4)将步骤(3)得到的杆臂估计值Re与步骤(1)测量的真实杆臂Rt相比,如果其误差小于步骤(3)给定的杆臂误差阈值Rth时,将此时估计得到的陀螺漂移εg和加速度计零偏εa作为陀螺漂移估计值εge和加速度计零偏估计值εae,在下一个GPS采样时刻,执行步骤(5);否则,在下一个GPS采样时刻,返回执行步骤(3);
(5)去掉步骤(3)中18维状态向量中的3个杆臂误差,得到15维向量,将该15维状态向量作为Kalman滤波器误差状态向量,利用步骤(4)获取的惯性器件随机常值误差εge和εae校正陀螺和加速度计采样值,利用修正后的陀螺及加速度计数据进行INS解算,在GPS采样时刻,利用步骤(1)的真实杆臂Rt进行杆臂误差补偿,采用15维状态向量的kalman滤波器进行全反馈INS/GPS组合导航。
2.根据权利要求1所述的一种基于杆臂估计的INS/GPS组合导航***反馈校正方法,其特征在于:步骤(3)所述的杆臂估计值Re的确定方法为:
A、首先计算杆臂初值在量测向量中的分量;
其中,
上式中,为载体系至导航系的姿态转换矩阵,为载体系相对于导航系的角速度在载体系的投影,zPR1(n)(n=1,2,3)中的n代表zPR1向量的第n个元素,以下类同;
B、在量测向量中补偿杆臂初值误差zR;
量测方程为:z=Hx+zR;
其中,z为量测向量,H为量测矩阵,x为***误差状态向量;
量测向量为GPS采样时刻的INS与GPS位置、速度之差;
z=[δL′δλ′δH′δVE′δVN′δVU′]T
其中,Li,λi,Hi分别为由步骤(2)的惯性测量数据进行INS解算得到的在GPS采样时刻的纬度、经度和高度;VEi,VNi,VUi分别为由惯性数据进行INS解算得到的在GPS采样时刻的东向速度,北向速度和天向速度;
量测矩阵H=[HPHV]T
HP=[diag([Rm+Hi,(Rn+Hi)cosLi,1])03×12lc]
其中, diag(R)表示以向量R中的元素为主对角元素的主对角矩阵,代表中第i行,第j列的元素;
***误差状态向量x=[xfxaxl]T
xf=[δLδλδHδVEδVNδVUφEφNφU]T
xa=[εgxεgyεgzεaxεayεaz]T
xl=[δlxδlyδlz]T
其中,δL、δλ、δH分别代表惯性导航位置误差中的纬度误差、经度误差和高度误差;δVE、δVN、δVU分别代表惯性导航速度误差中东向速度误差、北向速度误差和天向速度误差;φE、φN、φU分别代表惯性导航失准角误差中的东向失准角、北向失准角、天向失准角;εgx、εgy、εgz分别代表x轴陀螺、y轴陀螺和z轴陀螺的随机常值漂移;εax、εay、εaz分别代表x轴加速度计、y轴加速度计和z轴加速度计的随机常值零偏;δlx、δly和δlz分别代表x轴、y轴、z轴的杆臂误差;
C、杆臂误差估计反馈校正;
Re=Rini-xl
进行杆臂误差反馈校正后,用杆臂估计值Re更新杆臂初值Rini,以用于后续迭代计算;
Rini=Re。
3.根据权利要求1所述的一种基于杆臂估计的INS/GPS组合导航***反馈校正方法,其特征在于:步骤(4)所述的杆臂误差阈值Rth取定如下:
当采用C/A码GPS信号进行INS/GPS实时组合导航时,杆臂误差阈值Rth取为0.15m,当采用CDGPS信号进行INS/GPS事后组合导航时,杆臂误差阈值Rth取为0.05m。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310289324.7A CN103344259B (zh) | 2013-07-11 | 2013-07-11 | 一种基于杆臂估计的ins/gps组合导航***反馈校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310289324.7A CN103344259B (zh) | 2013-07-11 | 2013-07-11 | 一种基于杆臂估计的ins/gps组合导航***反馈校正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103344259A CN103344259A (zh) | 2013-10-09 |
CN103344259B true CN103344259B (zh) | 2016-01-20 |
Family
ID=49279075
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310289324.7A Expired - Fee Related CN103344259B (zh) | 2013-07-11 | 2013-07-11 | 一种基于杆臂估计的ins/gps组合导航***反馈校正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103344259B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107270893A (zh) * | 2017-05-27 | 2017-10-20 | 东南大学 | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104457789A (zh) * | 2014-11-26 | 2015-03-25 | 深圳市华颖泰科电子技术有限公司 | 基于惯性导航的参数修正方法和装置 |
CN106595705B (zh) * | 2016-11-22 | 2019-12-20 | 北京航天自动控制研究所 | 一种基于gps的飞行中惯性初始基准偏差估计方法 |
CN106767788B (zh) * | 2017-01-04 | 2019-07-19 | 北京航天自动控制研究所 | 一种组合导航方法和*** |
CN108225312B (zh) * | 2017-12-27 | 2020-05-08 | 中国电子科技集团公司第五十四研究所 | 一种gnss/ins松组合中杆臂估计以及补偿方法 |
FR3079026B1 (fr) * | 2018-03-15 | 2021-01-01 | Sysnav | Procede de calibration d'un gyrometre equipant un vehicule |
CN109211230B (zh) * | 2018-09-07 | 2022-02-15 | 东南大学 | 一种基于牛顿迭代法的炮弹姿态和加速度计常值误差估计方法 |
CN110221332B (zh) * | 2019-04-11 | 2023-02-10 | 同济大学 | 一种车载gnss/ins组合导航的动态杆臂误差估计和补偿方法 |
CN110221333B (zh) * | 2019-04-11 | 2023-02-10 | 同济大学 | 一种车载ins/od组合导航***的量测误差补偿方法 |
CN110672124A (zh) * | 2019-09-27 | 2020-01-10 | 北京耐威时代科技有限公司 | 离线杠杆臂估计方法 |
CN111707259B (zh) * | 2020-06-16 | 2022-08-05 | 东南大学 | 一种校正加速度计误差的sins/cns组合导航方法 |
CN112378399B (zh) * | 2020-07-16 | 2023-02-28 | 西安科技大学 | 基于捷联惯导和数字全站仪的煤矿巷道掘进机器人精确定位定向方法 |
CN114076610B (zh) * | 2020-08-12 | 2024-05-28 | 千寻位置网络(浙江)有限公司 | Gnss/mems车载组合导航***的误差标定、导航方法及其装置 |
CN112529384B (zh) * | 2020-12-04 | 2023-06-06 | 中国地质大学(北京) | 一种针对页岩气资源量的误差校正方法及相关装置 |
CN115727843A (zh) * | 2022-11-16 | 2023-03-03 | 北京觉非科技有限公司 | 用于航位推算的轮速确定方法、装置及设备 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0617259B1 (en) * | 1993-03-23 | 1997-03-12 | Litton Systems, Inc. | Method for calibrating aircraft navigation systems |
US6631323B2 (en) * | 2000-05-30 | 2003-10-07 | Northrop Grumman Corporation | Method and apparatus for improving performance of an inertial navigation system having global positioning system corrections |
CN1763475A (zh) * | 2005-11-04 | 2006-04-26 | 北京航空航天大学 | 一种sins/gps组合导航***的空中机动对准方法 |
CN101963513A (zh) * | 2010-09-03 | 2011-02-02 | 哈尔滨工程大学 | 消除水下运载体捷联惯导***杆臂效应误差的对准方法 |
CN102393201A (zh) * | 2011-08-02 | 2012-03-28 | 北京航空航天大学 | 航空遥感用位置和姿态测量***(pos)动态杆臂补偿方法 |
CN102879779A (zh) * | 2012-09-04 | 2013-01-16 | 北京航空航天大学 | 一种基于sar遥感成像的杆臂测量及补偿方法 |
-
2013
- 2013-07-11 CN CN201310289324.7A patent/CN103344259B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0617259B1 (en) * | 1993-03-23 | 1997-03-12 | Litton Systems, Inc. | Method for calibrating aircraft navigation systems |
US6631323B2 (en) * | 2000-05-30 | 2003-10-07 | Northrop Grumman Corporation | Method and apparatus for improving performance of an inertial navigation system having global positioning system corrections |
CN1763475A (zh) * | 2005-11-04 | 2006-04-26 | 北京航空航天大学 | 一种sins/gps组合导航***的空中机动对准方法 |
CN101963513A (zh) * | 2010-09-03 | 2011-02-02 | 哈尔滨工程大学 | 消除水下运载体捷联惯导***杆臂效应误差的对准方法 |
CN102393201A (zh) * | 2011-08-02 | 2012-03-28 | 北京航空航天大学 | 航空遥感用位置和姿态测量***(pos)动态杆臂补偿方法 |
CN102879779A (zh) * | 2012-09-04 | 2013-01-16 | 北京航空航天大学 | 一种基于sar遥感成像的杆臂测量及补偿方法 |
Non-Patent Citations (3)
Title |
---|
GPS/SINS组合导航***混合校正卡尔曼滤波方法;林敏敏等;《中国惯性技术学报》;20030630;第11卷(第3期);29-33 * |
基于GPS观测量和模型预测滤波的机载SINS_GPS空中自对准;刘百奇等;《中国惯性技术学报》;20071031;第15卷(第5期);568-572 * |
弹载SINS_GPS组合导航信息同步与融合技术;陈帅等;《火力与指挥控制》;20091031;第34卷(第10期);69-72 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107270893A (zh) * | 2017-05-27 | 2017-10-20 | 东南大学 | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 |
CN107270893B (zh) * | 2017-05-27 | 2020-11-06 | 东南大学 | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103344259A (zh) | 2013-10-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103344259B (zh) | 一种基于杆臂估计的ins/gps组合导航***反馈校正方法 | |
CN103917850B (zh) | 一种惯性导航***的运动对准方法 | |
CN106990426B (zh) | 一种导航方法和导航装置 | |
CN101949703B (zh) | 一种捷联惯性/卫星组合导航滤波方法 | |
CN103630137B (zh) | 一种用于导航***的姿态及航向角的校正方法 | |
CN103913181B (zh) | 一种基于参数辨识的机载分布式pos传递对准方法 | |
CN103235328B (zh) | 一种gnss与mems组合导航的方法 | |
CN100516775C (zh) | 一种捷联惯性导航***初始姿态确定方法 | |
CN102169184B (zh) | 组合导航***中测量双天线gps安装失准角的方法和装置 | |
CN103364817B (zh) | 一种基于r-t-s平滑的pos***双捷联解算后处理方法 | |
CN105371844B (zh) | 一种基于惯性/天文互助的惯性导航***初始化方法 | |
EP3043148A1 (en) | Heading for a hybrid navigation solution based on magnetically calibrated measurements | |
CN103792561B (zh) | 一种基于gnss通道差分的紧组合降维滤波方法 | |
CN105091907B (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
CN103822633A (zh) | 一种基于二阶量测更新的低成本姿态估计方法 | |
Xue et al. | In-motion alignment algorithm for vehicle carried SINS based on odometer aiding | |
CN102538792A (zh) | 一种位置姿态***的滤波方法 | |
CN102519470A (zh) | 多级嵌入式组合导航***及导航方法 | |
CN103712621B (zh) | 偏振光及红外传感器辅助惯导***定姿方法 | |
CN110849360B (zh) | 面向多机协同编队飞行的分布式相对导航方法 | |
CN103674064B (zh) | 捷联惯性导航***的初始标定方法 | |
CN111220151B (zh) | 载体系下考虑温度模型的惯性和里程计组合导航方法 | |
CN105606093B (zh) | 基于重力实时补偿的惯性导航方法及装置 | |
Zorina et al. | Enhancement of INS/GNSS integration capabilities for aviation-related applications | |
CN104949687A (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20160120 Termination date: 20190711 |
|
CF01 | Termination of patent right due to non-payment of annual fee |