CN105180929A - 一种车载惯性导航系统中惯性传感器的安装方法 - Google Patents
一种车载惯性导航系统中惯性传感器的安装方法 Download PDFInfo
- Publication number
- CN105180929A CN105180929A CN201510549722.7A CN201510549722A CN105180929A CN 105180929 A CN105180929 A CN 105180929A CN 201510549722 A CN201510549722 A CN 201510549722A CN 105180929 A CN105180929 A CN 105180929A
- Authority
- CN
- China
- Prior art keywords
- car body
- accelerometer
- gyroscope
- axle
- navigation system
- 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.)
- Pending
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
Abstract
本发明公开一种车载用惯性导航系统惯性传感器安装方法,其中所述系统由3个3轴陀螺仪、3个3轴加速度计组成,通过allan方差分析法,分别计算出3个陀螺仪、3个加速度计共18个轴的零偏不稳定性,将6个零偏不稳定性能最优的轴向分别安装指向车体的前向、右向、下向,其余的12个轴的输出分别按照零偏不稳定性能的优劣分配相应的权重,作为本发明所述车载惯性导航系统的备份输入,当最优轴向出现故障时,采用上述变权处理的次优轴向的输出可以作为所述惯性导航系统的备份输入,使得在零偏不稳定性能最优轴出现故障时有其它备份输入,提高了惯性导航系统的可靠性和精度,具有极高的实用性。
Description
技术领域
本发明涉及惯性导航领域,尤其涉及一种车载用惯性导航系统中惯性传感器的安装方法。
背景技术
微机电系统(MEMS)惯性传感器是惯性导航领域内被广泛使用的一种传感器,其具有体积小、重量轻、低成本、高可靠性且寿命长等特点。MEMS惯性器件(陀螺仪、加速度计)普遍存在着精度较低、噪声大等缺点,且惯性传感器各个轴向的性能表现不一致。而惯性传感器本身的误差是影响系统精度的主要因素,因此需要采取必要的措施来提高惯性导航系统的稳定性以及精度。在不更换更高精度传感器的前提下,通过增加惯性器件的个数进行冗余配置,是目前提高系统可靠性和精度的最主流的方法。该方法无法解决由于惯性传感器不同轴向的性能不一致导致的系统精度降低的问题,因此研究惯性导航系统中惯性传感器的最优安装方法对于提高系统的导航精度十分有益。
发明内容
鉴于上述现有技术的不足,本发明的目的在于提供一种车载用惯性导系统中惯性传感器的安装方法,旨在解决现有技术中不考虑惯性传感器不同轴向的性能不一致导致的系统精度降低的问题。
本发明的技术方案如下:
一种车载用惯性导航系统中惯性传感器的安装方法,其中,包括以下步骤:
A、惯性导航的惯性传感器采用3个3轴陀螺仪:第一陀螺仪、第二陀螺仪和第三陀螺仪,以及3个3轴加速度计:第一加速度计、第二加速度计和第三加速度计;通过allan方差分析法,分别计算出每个陀螺仪和加速度计三个轴向上的零偏不稳定性系数,并选取每个陀螺仪和加速度计中最优性能的轴;
B、将第一陀螺仪中性能最优的轴安装指向车体前向,将第一加速度计中性能最优的轴安装指向车体前向;将第二陀螺仪中性能最优的轴安装指向车体右向,将第二加速度计中性能最优的轴安装指向车体右向;将第三陀螺仪中性能最优的轴安装指向车体下向,将第三加速度计中性能最优的轴安装指向车体下向;
C、将每个陀螺仪和加速度计中其余两个性能次优的轴分别按照零偏不稳定性能的优劣安装指向车体的前向、后向或下向,作为惯性导航系统的备份输入。
所述车载惯性导航系统中惯性传感器的安装方法,其中,所述步骤C具体包括:
C1、将第一陀螺仪中其余两个轴分别安装指向车体右向和下向,将第一加速度计中其余两个轴分别安装指向车体右向和下向;
C2、将第二陀螺仪中其余两个轴分别安装指向车体前向和下向,将第二加速度计中其余两个轴分别安装指向车体前向和下向;
C3、将第三陀螺仪中其余两个轴分别安装指向车体前向和右向,将第三加速度计中其余两个轴分别安装指向车体前向和右向。
有益效果:本发明所述一种车载惯性导航系统中惯性传感器的安装方法,其中所述系统由3个3轴陀螺仪、3个3轴加速度计组成,通过allan方差分析法,分别计算出3个陀螺仪、3个加速度计共18个轴的零偏不稳定性,将6个零偏不稳定性能最优的轴向分别设置指向车体的前向、右向、下向,其余的12个轴的输出分别按照零偏不稳定性能的优劣分配相应的权重,作为本发明所述车载惯性导航系统的备份输入,当最优轴向出现故障时,采用上述变权处理的次优轴向的输出可以作为所述惯性导航系统的备份输入,使得在零偏不稳定性能最优轴出现故障时有其它备份输入,保持惯性导航系统的可靠性和精度,具有极高的实用性。
附图说明
图1为本发明所述车载用惯性导航系统惯性传感器安装方法的流程图。
图2为本发明所述车载用惯性导航系统惯性传感器安装方法中步骤S300的具体流程图。
具体实施方式
为使本发明的目的、技术方案及效果更加清楚、明确,以下对本发明进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
请参见图1,如图1所示,本发明提供一种车载惯性导航系统中惯性传感器的安装方法,其包括以下步骤:
S100、惯性导航系统的惯性传感器采用3个3轴陀螺仪:第一陀螺仪、第二陀螺仪和第三陀螺仪,以及3个3轴加速度计:第一加速度计、第二加速度计和第三加速度计;分别计算出3个陀螺仪和3个加速度计各个轴向上的零偏不稳定性系数,并选取每个陀螺仪和加速度计中最优性能的轴;
S200、将第一陀螺仪中性能最优的轴安装指向车体前向,将第一加速度计性能最优的轴安装指向车体前向;将第二陀螺仪性能最优的轴安装指向车体右向,将第二加速度计性能最优的轴安装指向车体右向;将第三陀螺仪性能最优的轴安装指向车体下向,将第三加速度计性能最优的轴安装指向车体下向;
S300、将每个陀螺仪和加速度计中其余两个性能次优的轴分别按照零偏不稳定性能的优劣安装指向车体的前向、后向或下向上,作为指向车体的备份输入。
本发明中惯性导航系统由3个3轴陀螺仪和3个3轴加速度计组成,通过allan方差分析法,分别计算出3个陀螺仪、3个加速度计共18个轴的零偏不稳定性系数,将6个零偏不稳定性能最优的轴向分别安装指向车体的前向、右向、下向,其余的12个轴的输出分别按照零偏不稳定性能的优劣分配相应的权重,作为本发明所述车载惯性导航系统的备份输入,当最优轴向出现故障时,采用上述变权处理的次优轴向的输出可以作为所述惯性导航系统的备份输入,使得在零偏不稳定性能最优轴出现故障时有其它备份输入,提高了惯性导航系统的可靠性和精度,具有极高的实用性。
具体地,在步骤S100中,本实施例采用allan方差分析的方法对3个陀螺仪和3个加速度计进行分析,分别计算出9轴陀螺仪(即每个陀螺仪有3个轴,共有3个陀螺仪)、9轴加速度计(即每个加速度计有3个轴,共有3个加速度计)的零偏不稳定性系数。
进一步地,将第一陀螺仪gyro1的3个轴向分别记为[gx1,gy1,gz1]、将第二陀螺仪gyro2的3个轴向分别记为[gx2,gy2,gz2]、将第三陀螺仪gyro3的3个轴向分别记做[gx3,gy3,gz3];其对应的9个轴的零偏不稳定系数分别记做:[gx_B1,gy_B1,gz_B1]、[gx_B2,gy_B2,gz_B2]、[gx_B3,gy_B3,gz_B3]。
同样地,将所述第一加速度计acc1、第二加速度计acc2和第三加速度计acc3,3个加速度计的9个轴向分别记为[ax1,ay1,az1]、[ax2,ay2,az2]、[ax3,ay3,az3],其对应的9个轴的零偏不稳定系数分别记做:[ax_B1,ay_B1,az_B1]、[ax_B2,ay_B2,az_B2]、[ax_B3,ay_B3,az_B3]。
随后进入步骤S200中,即根据计算出的各个轴向的零偏不稳定系数选取最优性能的轴向并进行安装设置。例如:将[gx_B1,gy_B1,gz_B1]三个系数(指的是零偏不稳定系数,下同)对应的性能最优的轴记作g1_optimal(其中gx_B1,gy_B1,gz_B1中数值最小的为性能最优),其它两个轴记作g1_sub1,g1_sub2(其对应的零偏不稳定系数记作g1_B1,g1_B2);同理得到g2_optimal,g2_sub1,g2_sub2(g2_sub1,g2_sub2对应的零偏不稳地系数记作g2_B1,g2_B2);得到g3_optimal,g3_sub1,g3_sub2(g3_sub1,g3_sub2对应的零偏不稳地系数记作g3_B1,g3_B2)。
同样地,对于加速度计,得到a1_optimal,a1_sub1,a1_sub2(a1_sub1,a1_sub2对应的零偏不稳地系数记作a1_B1,a1_B2);a2_optimal,a2_sub1,a2_sub2(a2_sub1,a2_sub2对应的零偏不稳地系数记作a2_B1,a2_B2);a3_optimal,a3_sub1,a3_sub2(a3_sub1,a3_sub2对应的零偏不稳地系数记作a3_B1,a3_B2)。
根据计算出的各个轴向的零偏不稳定系数选取最优性能的轴向后,将第一陀螺仪gyro1性能最优的轴g1_optimal安装指向车体前向,将第一加速度计acc1性能最优的轴a1_optimal安装指向车体前向;将第二陀螺仪gyro2性能最优的轴g2_optimal安装指向车体右向,将第二加速度计acc2性能最优的轴a2_optimal安装指向车体右向;将第三陀螺仪gyro3性能最优的轴g3_optimal安装指向车体下向,将第三加速度计acc3性能最优的轴a3_optimal安装指向车体下向。
随后进入步骤S300中,如图2所示,即将每个陀螺仪和加速度计中其余两个性能次优的轴分别安装指向车体的前向、后向或下向上,作为指向车体的备份输入。具体地,将第一陀螺仪gyro1性能次优的轴g1_sub1安装指向车体右向,g1_sub2安装指向车体下向,将第一加速度计acc1性能次优的轴a1_sub1安装指向车体右向,a1_sub2安装指向车体下向;将第二陀螺仪gyro2性能次优的轴g2_sub1安装指向车体前向,g2_sub2安装指向车体下向,将第二加速度计acc2性能次优的轴a2_sub1安装指向车体前向,a2_sub2安装指向车体下向;将第三陀螺仪gyro3性能次优的轴g3_sub1安装指向车体前向,g3_sub2安装指向车体右向,将第三加速度计acc3性能次优的轴a3_sub1安装指向车体前向,a3_sub2安装指向车体右向。
本发明实施例中将g1_optimal,g2_optimal,g3_optimal轴向的输出分别作为惯导系统(即本发明中所述车载惯性导航系统,下同)前向、右向、下向陀螺仪的输入,将a1_optimal,a2_optimal,a3_optimal轴向的输出作为惯导系统中前向、右向、下向加速度计的输入。
具体地,将g2_sub1,g3_sub1轴向的输出output_g2_sub1,output_g3_sub1按照其零偏不稳定系数g2_B1,g3_B1做变权处理:使g2_B1/(g2_B1+g3_B1)*output_g2_sub1+g3_B1/(g2_B1+g3_B1)*output_g3_sub1作为惯导系统的前向陀螺仪的备份输入;将g1_sub1,g3_sub2轴向的输出output_g1_sub1,output_g3_sub2按照其零偏不稳定系数g1_B1,g3_B2做变权处理:使g1_B1/(g1_B1+g3_B2)*output_g1_sub1+g3_B2/(g1_B1+g3_B2)*output_g3_sub2作为惯导系统的右向陀螺仪的备份输入;将g1_sub2,g2_sub2轴向的输出output_g1_sub2,output_g2_sub2按照其零偏不稳定系数g1_B2,g2_B2做变权处理:使g1_B2/(g1_B2+g2_B2)*output_g1_sub2+g2_B2/(g1_B2+g2_B2)*output_g2_sub2作为惯导系统的下向陀螺仪的备份输入。
同样地,将a2_sub1,a3_sub1轴向的输出output_a2_sub1,output_a3_sub1按照其零偏不稳定系数a2_B1,a3_B1做变权处理:使a2_B1/(a2_B1+a3_B1)*output_a2_sub1+a3_B1/(a2_B1+a3_B1)*output_a3_sub1作为惯导系统的前向加速度计的备份输入;将a1_sub1,a3_sub2轴向的输出output_a1_sub1,output_a3_sub2按照其零偏不稳定系数a1_B1,a3_B2做变权处理:使a1_B1/(a1_B1+a3_B2)*output_a1_sub1+a3_B2/(a1_B1+a3_B2)*output_a3_sub2作为惯导系统的右向加速度计的备份输入;将a1_sub2,a2_sub2轴向的输出output_a1_sub2,output_a2_sub2按照其零偏不稳定系数a1_B2,a2_B2做变权处理:使a1_B2/(a1_B2+a2_B2)*output_a1_sub2+a2_B2/(a1_B2+a2_B2)*output_a2_sub2作为惯导系统的下向加速度计的备份输入。
另外,本发明还提供一种由上述安装方法安装有惯性传感器的车载用惯性导航系统,具体地,所述系统包括有3个3轴陀螺仪:第一陀螺仪、第二陀螺仪和第三陀螺仪,以及3个3轴加速度计:第一加速度计、第二加速度计和第三加速度计;其中,每个陀螺仪和加速度计的零偏不稳定性性能最优的轴分别安装指向车体的前向、右向、下向,每个陀螺仪和加速度计中其余两个零偏不稳定性性能次优的轴分别安装指向车体的前向、后向或下向上,作为指向车体的备份输入。
进一步地,所述系统具体包括:
所述第一陀螺仪中其余两个轴分别安装指向车体右向和下向,所述第一加速度计中其余两个轴分别安装指向车体右向和下向;所述第二陀螺仪中其余两个轴分别安装指向车体前向和下向,所述第二加速度计中其余两个轴分别安装指向车体前向和下向;所述第三陀螺仪中其余两个轴分别安装指向车体前向和右向,所述第三加速度计中其余两个轴分别安装指向车体前向和右向。
本发明中所述车载用惯性导航系统的实现途径请参见上述车载用惯性导航系统中惯性传感器的安装方法的步骤,在此不再赘述。
综上所述,本发明所述一种车载用惯性导航系统中惯性传感器安装方法,其中所述系统由3个3轴陀螺仪、3个3轴加速度计组成,通过allan方差分析法,分别计算出3个陀螺仪、3个加速度计共18个轴的零偏不稳定性,将6个零偏不稳定性能最优的轴向分别安装指向车体的前向、右向、下向,其余的12个轴的输出分别按照零偏不稳定性能的优劣分配相应的权重,作为本发明所述车载惯性导航系统的备份输入,当最优轴向出现故障时,采用上述变权处理的次优轴向的输出可以作为所述惯性导航系统的备份输入,使得在零偏不稳定性能最优轴出现故障时有其它备份输入,保持惯性导航系统的可靠性和精度,具有极高的实用性。
应当理解的是,本发明的应用不限于上述的举例,对本领域普通技术人员来说,可以根据上述说明加以改进或变换,所有这些改进和变换都应属于本发明所附权利要求的保护范围。
Claims (2)
1.一种车载用惯性导航系统中惯性传感器安装方法,其特征在于,包括以下步骤:
A、惯性导航系统的惯性传感器采用3个3轴陀螺仪:第一陀螺仪、第二陀螺仪和第三陀螺仪,以及3个3轴加速度计:第一加速度计、第二加速度计和第三加速度计;分别计算出每个陀螺仪和加速度计在三个轴向上的零偏不稳定性系数,并选取每个陀螺仪和加速度计中最优性能的轴;
B、将第一陀螺仪中性能最优的轴安装指向车体前向,将第一加速度计中性能最优的轴安装指向车体前向;将第二陀螺仪中性能最优的轴安装指向车体右向,将第二加速度计中性能最优的轴安装指向车体右向;将第三陀螺仪中性能最优的轴安装指向车体下向,将第三加速度计中性能最优的轴安装指向车体下向;
C、将每个陀螺仪和加速度计中其余两个性能次优的轴分别按照零偏不稳定性能的优劣安装指向车体的前向、后向或下向上,作为指向车体的备份输入。
2.根据权利要求1所述车载用惯性导航系统惯性传感器安装方法,其特征在于,所述步骤C具体包括:
C1、将第一陀螺仪中其余两个轴分别安装指向车体右向和下向,将第一加速度计中其余两个轴分别安装指向车体右向和下向;
C2、将第二陀螺仪中其余两个轴分别安装指向车体前向和下向,将第二加速度计中其余两个轴分别安装指向车体前向和下向;
C3、将第三陀螺仪中其余两个轴分别安装指向车体前向和右向,将第三加速度计中其余两个轴分别安装指向车体前向和右向。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510549722.7A CN105180929A (zh) | 2015-09-01 | 2015-09-01 | 一种车载惯性导航系统中惯性传感器的安装方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510549722.7A CN105180929A (zh) | 2015-09-01 | 2015-09-01 | 一种车载惯性导航系统中惯性传感器的安装方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105180929A true CN105180929A (zh) | 2015-12-23 |
Family
ID=54903180
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510549722.7A Pending CN105180929A (zh) | 2015-09-01 | 2015-09-01 | 一种车载惯性导航系统中惯性传感器的安装方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105180929A (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1508408A1 (en) * | 2002-04-26 | 2005-02-23 | Honda Giken Kogyo Kabushiki Kaisha | System for estimating attitude of leg type moving robot itself |
US20070106462A1 (en) * | 2004-09-23 | 2007-05-10 | Michel Blain | Method and apparatus for determining the position of an underwater object in real-time |
CN103411615A (zh) * | 2013-07-26 | 2013-11-27 | 北京航天控制仪器研究所 | 一种双冗余挠性捷联惯性测量系统 |
CN103453904A (zh) * | 2013-09-26 | 2013-12-18 | 哈尔滨工程大学 | 一种惯性测量单元的冗余配置结构 |
CN104457789A (zh) * | 2014-11-26 | 2015-03-25 | 深圳市华颖泰科电子技术有限公司 | 基于惯性导航的参数修正方法和装置 |
CN104596513A (zh) * | 2014-12-26 | 2015-05-06 | 北京爱科迪通信技术股份有限公司 | 一种光纤陀螺与微机械陀螺组合的惯导系统及导航方法 |
-
2015
- 2015-09-01 CN CN201510549722.7A patent/CN105180929A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1508408A1 (en) * | 2002-04-26 | 2005-02-23 | Honda Giken Kogyo Kabushiki Kaisha | System for estimating attitude of leg type moving robot itself |
US20070106462A1 (en) * | 2004-09-23 | 2007-05-10 | Michel Blain | Method and apparatus for determining the position of an underwater object in real-time |
CN103411615A (zh) * | 2013-07-26 | 2013-11-27 | 北京航天控制仪器研究所 | 一种双冗余挠性捷联惯性测量系统 |
CN103453904A (zh) * | 2013-09-26 | 2013-12-18 | 哈尔滨工程大学 | 一种惯性测量单元的冗余配置结构 |
CN104457789A (zh) * | 2014-11-26 | 2015-03-25 | 深圳市华颖泰科电子技术有限公司 | 基于惯性导航的参数修正方法和装置 |
CN104596513A (zh) * | 2014-12-26 | 2015-05-06 | 北京爱科迪通信技术股份有限公司 | 一种光纤陀螺与微机械陀螺组合的惯导系统及导航方法 |
Non-Patent Citations (1)
Title |
---|
秦永元: "《惯性导航》", 31 May 2006 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1932444B (zh) | 适用于高速旋转体的姿态测量方法 | |
CN108827299B (zh) | 一种基于改进四元数二阶互补滤波的飞行器姿态解算方法 | |
US8260477B2 (en) | Method and apparatus for tracking center of gravity of air vehicle | |
CN104090127B (zh) | 一种车载加速传感器的三轴自校准方法 | |
JP2008268214A (ja) | パリティロジックを使用する慣性測定装置の故障検出、分離、再構成 | |
US10101174B2 (en) | Air data aided inertial measurement unit | |
CN109765920B (zh) | 集成故障观测器和控制分配策略的航天器姿态容错的控制方法 | |
CN103017765B (zh) | 应用于微机械组合导航系统的偏航角修正方法和修正装置 | |
CN103389114A (zh) | 基于g敏感性的三轴MEMS陀螺非正交误差标定方法 | |
CN108762069B (zh) | 刚性航天器姿控系统飞轮故障辨识与调节方法 | |
CN108534799B (zh) | 一种利用mems修正三轴光纤陀螺跨条纹输出的方法及装置 | |
CN104777842B (zh) | 一种基于磁悬浮控制敏感陀螺的卫星单轴测控一体化方法 | |
ITMI20111729A1 (it) | Metodo e sistema per il controllo di stabilità di un veicolo a due ruote mediante sospensione elettronicamente modulabile | |
CN109870273A (zh) | 基于动量守恒的航天器在轨质心辨识方法 | |
CN103676918A (zh) | 一种基于未知输入观测器的卫星执行机构故障诊断方法 | |
KR102287994B1 (ko) | 결합형 하이브리드 다이내믹 시스템을 테스트하기 위한 방법 및 시스템 | |
CN103674061B (zh) | 基于浮点温度一致的全液浮陀螺仪浮子质量控制方法 | |
CN105180929A (zh) | 一种车载惯性导航系统中惯性传感器的安装方法 | |
BRPI0617564B1 (pt) | dispositivo de comando da suspensão de um veículo | |
CN110412995B (zh) | 一种基于控制力矩陀螺的车辆防侧翻方法 | |
CN111750897B (zh) | 一种基于龙贝格观测器的横摆角速度陀螺仪偏差估计方法 | |
Lee et al. | Slip angle estimation: Development and experimental evaluation | |
CN108871309B (zh) | 一种光纤陀螺的跨条纹修正方法 | |
Chang et al. | Adaptive control of a hose and drogue system with input nonlinearities and partial state constraints | |
Gorelik et al. | Model and method for a time-efficient analysis of lateral drillstring dynamics |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
AD01 | Patent right deemed abandoned |
Effective date of abandoning: 20190326 |
|
AD01 | Patent right deemed abandoned |