CN102589568A - 车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法 - Google Patents

车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法 Download PDF

Info

Publication number
CN102589568A
CN102589568A CN2012100111147A CN201210011114A CN102589568A CN 102589568 A CN102589568 A CN 102589568A CN 2012100111147 A CN2012100111147 A CN 2012100111147A CN 201210011114 A CN201210011114 A CN 201210011114A CN 102589568 A CN102589568 A CN 102589568A
Authority
CN
China
Prior art keywords
vehicle
delta
navigation system
inertial navigation
strapdown inertial
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
Application number
CN2012100111147A
Other languages
English (en)
Other versions
CN102589568B (zh
Inventor
奔粤阳
吴晓
李倩
高伟
于飞
王秋滢
盛宏媛
刘彬
张磊
南兆君
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Engineering University
Original Assignee
Harbin Engineering University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN201210011114.7A priority Critical patent/CN102589568B/zh
Publication of CN102589568A publication Critical patent/CN102589568A/zh
Application granted granted Critical
Publication of CN102589568B publication Critical patent/CN102589568B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Navigation (AREA)
  • Gyroscopes (AREA)

Abstract

本发明的目的在于提供车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法,包括以下步骤:确定车辆的初始位置,采集陀螺和加速度计输出的数据;进行解析式粗对准;使车辆捷联惯性导航系统的水平回路工作在二阶水平对准过程,方位回路工作在罗经对准过程中,采集车辆捷联惯性导航系统测量的导航坐标系下速度,上一步结束时刻车辆捷联惯性导航系统测量得到的捷联姿态矩阵T1,得到测量中间量
Figure DDA0000130992500000011
Figure DDA0000130992500000012
启动车辆并操纵车辆转弯,制动车辆,熄灭车辆发动机,保持车辆静止状态,再一次上述步骤,结束时刻,车辆捷联惯性导航系统测量得到的捷联姿态矩阵T2,得到测量中间量
Figure DDA0000130992500000013
利用上述值得到三轴陀螺常值漂移的测量值。本发明可操作性强,简单方便。

Description

车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法
技术领域
本发明涉及的是一种捷联惯性导航系统的标定方法。
背景技术
标定是捷联惯性导航系统的关键技术之一,标定的目的就是确定惯性测量组件(三轴陀螺和加速度计)的数学模型或误差数学模型的参数。在标定完成后,就可以在实际的应用环境中对惯性测量组件的输出进行补偿,提高捷联惯性导航系统的精度。
通常情况下的标定是在实验室内,使用精密转台进行的。例如北京航空航天大学富力的专利“挠性陀螺仪静态漂移零次和一次加速度相关项误差模型最优位置标定方法”(申请公布号CN101738203A)。该发明公开了一种挠性陀螺仪静态漂移零次和一次加速度相关项误差模型最优位置标定方法,在最优空间正交十二位置下对获得的最优空间正交十二位置漂移系数与挠性陀螺静态误差补偿模型进行的测量值补偿,有效地提高了挠性陀螺仪的输出,需将挠性陀螺仪安装在高精度三轴位置速率转台上,且三轴与地理系的天北西方向要求严格重合。再例如北京航空航天大学的发明人房建成的专利“一种光纤陀螺惯性测量单元的现场标定方法”(申请公布号CN101021546A)。该发明涉及一种现场精确标定光纤陀螺惯性测量单元误差系数的方法,可在没有精密转台的使用现场,通过光纤陀螺惯性测量单元在驻留12个位置,精确标定出陀螺标度因数、陀螺常值漂移、陀螺安装误差和加速度计常值偏置,该方法需要对光纤陀螺惯性测量单元进行多次翻转操作,这需要对捷联惯性导航系统进行重复拆装,操作繁琐,并且存在重复拆装误差的问题。
相关研究表明,试验室转台标定出的各项误差系数并不是固定不变的,包括陀螺常值漂移、标度因数、安装误差和加速度计常值误差、标度因数、安装误差等。这些参数随着系统的使用和存放时间的推移而变化,时间间隔越长,则变化越大,需要定期标定。同时,根据捷联惯性导航系统的基本工作原理可知:其误差的主要诱因为三轴陀螺常值漂移。由于车辆捷联惯性导航系统普遍为中等精度、或者是低精度的捷联惯性导航系统,因此标定的主要任务即三轴陀螺常值漂移的测量。
发明内容
本发明的目的在于提供提高车辆捷联惯性导航系统的导航精度的车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法。
本发明的目的是这样实现的:
本发明车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法,其特征是:
(1)熄灭车辆发动机,保持车辆静止状态;
(2)通过外部设备确定车辆的初始位置包括经度和纬度,将它们装订至车辆捷联惯性导航系统的导航计算机中;
(3)车辆捷联惯性导航系统进行预热,采集陀螺和加速度计输出的数据;
(4)进行解析式粗对准;
(5)使车辆捷联惯性导航系统的水平回路工作在二阶水平对准过程,方位回路工作在罗经对准过程中,采集车辆捷联惯性导航系统测量的导航坐标系下速度:
Figure BDA0000130992480000021
其中上角标表示导航坐标系n系,下角标E、N、U分别表示导航坐标系的东向轴、北向轴和天向轴,并且有
Figure BDA0000130992480000022
h为车辆捷联惯性导航系统的采样周期;
(6)步骤(5)结束时刻,车辆捷联惯性导航系统测量得到的捷联姿态矩阵T1
Figure BDA0000130992480000023
其中
Figure BDA0000130992480000024
表示T1的第i行、第j列元素;
(7)利用步骤(5)采集到的
Figure BDA0000130992480000025
Figure BDA0000130992480000026
得到测量中间量
Figure BDA0000130992480000027
Figure BDA0000130992480000028
Figure BDA0000130992480000031
Figure BDA0000130992480000032
其中L为车辆所在位置的纬度值,参数设置为
(8)启动车辆并操纵车辆转弯,制动车辆,熄灭车辆发动机,保持车辆静止状态;
(9)重复步骤(5)的过程;
(10)步骤9结束时刻,车辆捷联惯性导航系统测量得到的捷联姿态矩阵T2
Figure BDA0000130992480000034
其中表示T2的第i行、第j列元素;
(11)利用步骤(9)采集到的可得测量中间量
Figure BDA0000130992480000037
Figure BDA0000130992480000038
(12)利用步骤(6)、步骤(7)、步骤(10)、步骤(11)得到三轴陀螺常值漂移的测量值:
x轴陀螺常值漂移的测量值:
Figure BDA0000130992480000039
y轴陀螺常值漂移的测量值:
z轴陀螺常值漂移的测量值:
Figure BDA00001309924800000311
其中
Figure BDA0000130992480000041
本发明还可以包括:
1、进行解析式粗对准的步骤进行30秒。
2、采集车辆捷联惯性导航系统测量的导航坐标系下速度的步骤进行140秒。
本发明的优势在于:本发明车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法具有可操作性强的特点。无需三轴高精度转台,单轴角位置转台等外部辅助设备,仅需操作车辆进行一次转弯,操作简单方便。
附图说明
图1为本发明的流程图;
图2为本发明的捷联惯性导航系统的东向水平回路工作在二阶水平对准过程,对应于步骤5;
图3为本发明的捷联惯性导航系统的北向水平回路工作在二阶水平对准过程,方位回路工作在罗经对准过程,对应于步骤5,其中
Figure BDA0000130992480000042
为导航坐标系等效东向、北向加速度计零位偏差,
Figure BDA0000130992480000043
为东向、北向、天向平台失准角。
具体实施方式
下面结合附图举例对本发明做更详细地描述:
结合图1~3,一种车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法,其特征在于:
步骤1、熄灭车辆发动机,保持车辆静止状态;
步骤2、通过外部设备(如GPS)确定车辆的初始位置(包括经度和纬度),将它们装订至车辆捷联惯性导航系统的导航计算机中;
步骤3、车辆捷联惯性导航系统进行预热(具体预热时间可以参见车辆捷联惯性导航系统的使用说明),然后采集陀螺和加速度计输出的数据;
步骤4、对采集到的陀螺和加速度计数据进行处理,进行解析式粗对准,该步骤进行30秒;
步骤5、使车辆捷联惯性导航系统的水平回路工作在二阶水平对准过程,方位回路工作在罗经对准过程中,采集车辆捷联惯性导航系统测量的导航坐标系下速度
Figure BDA0000130992480000051
其中上角标表示导航坐标系n系,下角标E、N、U分别表示导航坐标系的东向轴、北向轴和天向轴,并且有
Figure BDA0000130992480000052
Figure BDA0000130992480000053
h为车辆捷联惯性导航系统的采样周期,该步骤进行140秒;
步骤6、采集步骤5结束时刻,即第140秒时,车辆捷联惯性导航系统测量得到的捷联姿态矩阵T1
Figure BDA0000130992480000054
其中
Figure BDA0000130992480000055
表示T1的第i行、第j列元素;
步骤7、利用步骤5采集到的
Figure BDA0000130992480000056
Figure BDA0000130992480000057
可得测量中间量
Figure BDA0000130992480000058
Figure BDA0000130992480000059
Figure BDA00001309924800000510
Figure BDA00001309924800000511
其中L为车辆所在位置的纬度值,参数设置为
Figure BDA00001309924800000512
步骤8、启动车辆,并操纵车辆转弯,制动车辆,熄灭车辆发动机,保持车辆静止状态;
步骤9、重复步骤5的过程;
步骤10、采集步骤9结束时刻,车辆捷联惯性导航系统测量得到的捷联姿态矩阵T2
其中
Figure BDA0000130992480000061
表示T2的第i行、第j列元素;
步骤11、利用步骤9采集到的
Figure BDA0000130992480000062
可得测量中间量
Figure BDA0000130992480000063
步骤12、利用步骤6、步骤7以及步骤10、步骤11得到三轴陀螺常值漂移的测量值,其中x轴陀螺常值漂移的测量值
Figure BDA0000130992480000065
并且有
Figure BDA0000130992480000066
y轴陀螺常值漂移的测量值
Figure BDA0000130992480000067
z轴陀螺常值漂移的测量值
Figure BDA0000130992480000068
车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法具有快速性的特点。去除步骤3的预热时间(需要参见车辆捷联惯性导航系统的使用说明),以及步骤8中对于车辆的操纵过程,仅需要300秒。
所述的车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法具有可操作性强的特点。无需三轴高精度转台,单轴角位置转台等外部辅助设备,仅需操作车辆进行一次转弯,操作简单方便。
为了进一步验证所述方法的有益效果,采用一套哈尔滨工程大学研制的光纤陀螺捷联惯性导航系统对所述方法进行车载试验验证。首先在试验室条件下,利用高精度三轴速率转台,通过静态24位置试验测量出三轴陀螺常值漂移,并以此作为基准值,然后,按照所述方法进行车载试验,试验测试值如表1所示。
表1 试验测试结果
Figure BDA0000130992480000071
通过表1可以看出:所述方法进行车载试验,其试验测量值误差小于0.01度/小时,可以达到中等精度光纤陀螺捷联惯性导航系统对于标定的要求,满足车辆捷联惯性导航系统的使用要求。

Claims (3)

1.车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法,其特征是:
(1)熄灭车辆发动机,保持车辆静止状态;
(2)通过外部设备确定车辆的初始位置包括经度和纬度,将它们装订至车辆捷联惯性导航系统的导航计算机中;
(3)车辆捷联惯性导航系统进行预热,采集陀螺和加速度计输出的数据;
(4)进行解析式粗对准;
(5)使车辆捷联惯性导航系统的水平回路工作在二阶水平对准过程,方位回路工作在罗经对准过程中,采集车辆捷联惯性导航系统测量的导航坐标系下速度:
V n ( k ) = V E n ( k ) V N n ( k ) V U n ( k ) ,
其中上角标表示导航坐标系n系,下角标E、N、U分别表示导航坐标系的东向轴、北向轴和天向轴,并且有k=1,2,·,M,
Figure FDA0000130992470000012
h为车辆捷联惯性导航系统的采样周期;
(6)步骤(5)结束时刻,车辆捷联惯性导航系统测量得到的捷联姿态矩阵T1
T 1 = T 1 ( 11 ) T 1 ( 12 ) T 1 ( 13 ) T 1 ( 21 ) T 1 ( 22 ) T 1 ( 23 ) T 1 ( 31 ) T 1 ( 32 ) T 1 ( 33 ) , 其中T1(ij)表示T1的第i行、第j列元素;
(7)利用步骤(5)采集到的
Figure FDA0000130992470000014
Figure FDA0000130992470000015
得到测量中间量Δ1和Δ2
Δ 1 = ( K 2 + 1 ) Σ k = 1 M V N n ( k ) 6378393 , Δ 2 = K z Σ k = 1 M V U n ( k ) 465.1198 cos L ,
其中L为车辆所在位置的纬度值,参数设置为K2=153.5,Kz=0.009446;
(8)启动车辆并操纵车辆转弯,制动车辆,熄灭车辆发动机,保持车辆静止状态;
(9)重复步骤(5)的过程;
(10)步骤9结束时刻,车辆捷联惯性导航系统测量得到的捷联姿态矩阵T2
T 2 = T 2 ( 11 ) T 2 ( 12 ) T 2 ( 13 ) T 2 ( 21 ) T 2 ( 22 ) T 2 ( 23 ) T 2 ( 31 ) T 2 ( 32 ) T 2 ( 33 ) , 其中T2(ij)表示T2的第i行、第j列元素;
(11)利用步骤(9)采集到的
Figure FDA0000130992470000022
得到测量中间量Δ3
Δ 3 = ( K 2 + 1 ) Σ k = 1 M V N n ( k ) 6378393 ;
(12)利用步骤(6)、步骤(7)、步骤(10)、步骤(11)得到三轴陀螺常值漂移的测量值:
x轴陀螺常值漂移的测量值:
ϵ x = T 1 ( 22 ) T 1 ( 33 ) Δ 3 - T 1 ( 22 ) T 2 ( 23 ) Δ 2 + T 1 ( 23 ) T 2 ( 22 ) Δ 2 - T 1 ( 23 ) T 1 ( 32 ) Δ 3 - T 1 ( 33 ) T 2 ( 22 ) Δ 1 + T 1 ( 32 ) T 2 ( 23 ) Δ 1 D
y轴陀螺常值漂移的测量值:
ϵ y = - T 1 ( 21 ) T 1 ( 33 ) Δ 3 - T 1 ( 21 ) T 2 ( 23 ) Δ 2 - T 1 ( 33 ) T 2 ( 21 ) Δ 1 + T 1 ( 31 ) T 2 ( 23 ) Δ 1 - T 1 ( 23 ) T 1 ( 31 ) Δ 3 + T 1 ( 23 ) T 2 ( 21 ) Δ 2 D
z轴陀螺常值漂移的测量值:
ϵ z = T 1 ( 31 ) T 2 ( 22 ) Δ 1 - T 1 ( 21 ) T 2 ( 22 ) Δ 2 + T 1 ( 22 ) T 2 ( 21 ) Δ 2 - T 1 ( 32 ) T 2 ( 21 ) Δ 1 + T 1 ( 21 ) T 1 ( 32 ) Δ 3 - T 1 ( 22 ) T 2 ( 31 ) Δ 3 D
其中
D=T1(21)T2(23)T1(32)-T1(21)T1(33)T2(22)+T1(33)T1(22)T2(21)
-T2(23)T1(22)T1(31)-T1(23)T2(21)T1(32)+T1(23)T1(31)T2(22)。
2.根据权利要求1所述的车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法,其特征是:进行解析式粗对准的步骤进行30秒。
3.根据权利要求1或2所述的车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法,其特征是:采集车辆捷联惯性导航系统测量的导航坐标系下速度的步骤进行140秒。
CN201210011114.7A 2012-01-14 2012-01-14 车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法 Expired - Fee Related CN102589568B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201210011114.7A CN102589568B (zh) 2012-01-14 2012-01-14 车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210011114.7A CN102589568B (zh) 2012-01-14 2012-01-14 车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法

Publications (2)

Publication Number Publication Date
CN102589568A true CN102589568A (zh) 2012-07-18
CN102589568B CN102589568B (zh) 2014-06-11

Family

ID=46478545

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210011114.7A Expired - Fee Related CN102589568B (zh) 2012-01-14 2012-01-14 车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法

Country Status (1)

Country Link
CN (1) CN102589568B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113551688A (zh) * 2021-05-27 2021-10-26 北京航天发射技术研究所 车载定位定向导航设备无依托快速免拆卸标定方法及装置
CN114295149A (zh) * 2021-12-27 2022-04-08 率为科技(北京)有限责任公司 一种适用于无人驾驶mems惯导系统误差自标定方法
CN116358606A (zh) * 2023-05-31 2023-06-30 中国船舶集团有限公司第七〇七研究所 惯导系统的初始粗对准方法、装置、设备及介质

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2000017607A1 (en) * 1998-09-23 2000-03-30 Magellan Dis, Inc. Calibration of multi-axis accelerometer in vehicle navigation system
CN101246023A (zh) * 2008-03-21 2008-08-20 哈尔滨工程大学 微机械陀螺惯性测量组件的闭环标定方法
CN101936745A (zh) * 2010-08-19 2011-01-05 中国航空工业第六一八研究所 平台惯导陀螺常值漂移标定方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2000017607A1 (en) * 1998-09-23 2000-03-30 Magellan Dis, Inc. Calibration of multi-axis accelerometer in vehicle navigation system
CN101246023A (zh) * 2008-03-21 2008-08-20 哈尔滨工程大学 微机械陀螺惯性测量组件的闭环标定方法
CN101936745A (zh) * 2010-08-19 2011-01-05 中国航空工业第六一八研究所 平台惯导陀螺常值漂移标定方法

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113551688A (zh) * 2021-05-27 2021-10-26 北京航天发射技术研究所 车载定位定向导航设备无依托快速免拆卸标定方法及装置
CN114295149A (zh) * 2021-12-27 2022-04-08 率为科技(北京)有限责任公司 一种适用于无人驾驶mems惯导系统误差自标定方法
CN116358606A (zh) * 2023-05-31 2023-06-30 中国船舶集团有限公司第七〇七研究所 惯导系统的初始粗对准方法、装置、设备及介质
CN116358606B (zh) * 2023-05-31 2023-08-29 中国船舶集团有限公司第七〇七研究所 惯导系统的初始粗对准方法、装置、设备及介质

Also Published As

Publication number Publication date
CN102589568B (zh) 2014-06-11

Similar Documents

Publication Publication Date Title
CN103808331B (zh) 一种mems三轴陀螺仪误差标定方法
CN101290326B (zh) 石英挠性加速度计测量组件的参数辨识标定方法
CN103900565B (zh) 一种基于差分gps的惯导系统姿态获取方法
CN106017507B (zh) 一种用于中低精度的光纤惯组快速标定方法
CN104165638B (zh) 一种双轴旋转惯导系统多位置自主标定方法
CN102003968B (zh) 光纤陀螺捷联惯性导航系统的单轴转台标定方法
CN101706284B (zh) 提高船用光纤陀螺捷联惯导系统定位精度的方法
CN103852085B (zh) 一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法
CN100547352C (zh) 适合于光纤陀螺捷联惯性导航系统的地速检测方法
CN103323625B (zh) 一种mems-imu中加速度计动态环境下的误差标定补偿方法
CN103076025B (zh) 一种基于双解算程序的光纤陀螺常值误差标定方法
CN102692239B (zh) 一种基于旋转机构的光纤陀螺八位置标定方法
CN101246023A (zh) 微机械陀螺惯性测量组件的闭环标定方法
CN102607595B (zh) 应用激光多普勒测速仪测试捷联挠性陀螺动态随机漂移的方法
CN100559188C (zh) 一种光纤陀螺惯性测量单元的现场标定方法
CN101571394A (zh) 基于旋转机构的光纤捷联惯性导航系统初始姿态确定方法
CN102607596B (zh) 基于差分gps观测的捷联挠性陀螺动态随机漂移误差测试方法
CN104596543B (zh) 一种基准不确定情况下陀螺仪组合误差系数标定方法
CN107202578B (zh) 一种基于mems技术的捷联式垂直陀螺仪解算方法
CN101738203B (zh) 挠性陀螺仪静态漂移零次和一次加速度相关项误差模型最优位置标定方法
CN102788596B (zh) 一种载体姿态未知的旋转捷联惯导系统现场标定方法
CN102707080B (zh) 一种星敏感器模拟捷联惯导陀螺的方法
CN102706365B (zh) 一种基于导航系统的三波束激光测速仪标定方法
CN102589568B (zh) 车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法
CN104154914A (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: 20140611

Termination date: 20200114

CF01 Termination of patent right due to non-payment of annual fee