CN106403999A - 基于gnss的惯性导航加速度计漂移实时补偿方法 - Google Patents
基于gnss的惯性导航加速度计漂移实时补偿方法 Download PDFInfo
- Publication number
- CN106403999A CN106403999A CN201610846737.4A CN201610846737A CN106403999A CN 106403999 A CN106403999 A CN 106403999A CN 201610846737 A CN201610846737 A CN 201610846737A CN 106403999 A CN106403999 A CN 106403999A
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- navigation system
- ins
- acceleration
- gnss
- 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
- 238000000034 method Methods 0.000 title claims abstract description 16
- 230000001133 acceleration Effects 0.000 claims abstract description 57
- 238000001514 detection method Methods 0.000 abstract description 2
- 238000005259 measurement Methods 0.000 description 11
- 230000010354 integration Effects 0.000 description 6
- 238000012937 correction Methods 0.000 description 4
- 238000009825 accumulation Methods 0.000 description 2
- 230000007812 deficiency Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- DMBHHRLKUKUOEG-UHFFFAOYSA-N diphenylamine Chemical compound C=1C=CC=CC=1NC1=CC=CC=C1 DMBHHRLKUKUOEG-UHFFFAOYSA-N 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000002459 sustained effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Classifications
-
- 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
Abstract
本发明公开了一种基于GNSS的惯性导航加速度计漂移实时补偿方法,主要解决现有技术检测时长和效率低的方法。其技术方案是:1.获取惯性导航系统INS输出的加速度信号,并在上一时刻到当前时刻内对加速度信号进行积分,得到当前时刻惯性导航系统INS测得的速度值;2.获取全球卫星导航系统GNSS当前时刻与上一时刻输出的导航定位信息,推算出由GNSS求得的速度值;3.根据两个系统的速度值计算INS的加速度漂移值,并对下一时刻惯性导航系统加速度计输出值进行补偿。本发明无需频繁地开关机即可对惯性导航系统的速度漂移值进行补偿,具有实时性和精度高的优点,可用对惯性导航系统INS测得的加速度计参数进行校准。
Description
技术领域
本发明属于信号处理技术领域,特别是涉及一种加速度计漂移实时补偿方法,可用于惯性导航系统。
背景技术
全球卫星导航系统GNSS,如北斗BD、GPS、GLONASS等,具有全天候,全球覆盖,定速定时高精度,快速省时高效率,应用广泛等优点。
惯性导航系统INS是一种不依赖于外部信息、也不向外部辐射能量的自主式导航系统。惯性导航系统的基本工作原理是以牛顿力学定律为基础,通过测量载体在惯性参考系的加速度,将它对时间进行积分,且把它变换到导航坐标系中,得到在导航坐标系中的速度、偏航角和位置等信息,具有不依赖环境条件如气象、地形等,导航系统不易受干扰等优点,但是误差会积累,造成输出精度变低,系统产生漂移等。
惯性导航系统的核心器件是加速度计和陀螺仪,利用它们的输出进行坐标变换和积分可解算出航迹。这两种器件的输出都会漂移,而积分运算又会将漂移造成的干扰累积,使得干扰问题进一步严重。
目前比较常用的惯导系统漂移修正方法是零速校正,即确定陀螺仪漂移和加速度计测量误差模型的参数,从而确定在惯导工作时按照陀螺仪漂移和加速度计测量误差模型消除部分误差。但是通过转台等对平台惯导进行标定,步骤繁琐,费时长,效率低,而且标定时反复开关机会造成电机负载波动、有损寿命。
发明内容
本发明的目的在于针对现有技术的不足,提出一种基于GNSS的惯性导航系统的加速度计漂移实时补偿方法,以缩短检测时长,提高效率,延长电机寿命。
技术方案
本发明是根据全球卫星导航系统GNSS输出信息的导航定位信息,对惯性导航系统的加速度计漂移进行实时补偿,其实现步骤包括如下:
S1.获取惯性导航系统INS输出的X轴方向加速度信号ax1和Y轴方向加速度信号ay1,并在上一时刻t0到当前时刻t1内对加速度信号进行积分,计算当前时刻惯性导航系统INS的X轴方向速度值vx1和Y轴方向速度值vy1;
S2.获取全球卫星导航系统GNSS当前时刻t1的定位信息(x1,y1)与上一时刻t0输出的定位信息(x0,y0),计算全球卫星导航系统GNSS的X轴方向速度值vx和Y轴方向速度值vy;
S3.计算惯性导航系统INS的X轴方向加速度漂移值ax与Y轴方向加速度漂移值ay:
S31)根据惯性导航系统INS测得的速度值vx1与vy1和全球卫星导航系统GNSS测得的速度值vx和vy,得到惯性导航系统INS的X轴方向速度变化斜率vxd与Y轴方向速度变化斜率vyd:
S32)对惯性导航系统INS的X轴方向速度变化斜率vxd与Y轴方向速度变化斜率vyd进行求导,计算t0到t1时间段内惯性导航系统INS的X轴方向加速度漂移值ax与Y轴方向加速度漂移值ay;
S4.计算惯性导航系统INS的X轴方向加速度漂移值变化斜率axd与Y轴方向加速度漂移值变化斜率ayd;
S5.利用S4的结果分别对惯性导航系统INS在下一时刻t2的X轴方向加速度值ax2和Y轴方向加速度值ay2进行补偿,得到补偿后的X轴方向加速度值和Y轴方向加速度值
本发明与现有技术相比,具有如下优点:
1、本发明由于通过计算惯性导航系统INS加速度计的漂移值来进行补偿,无需确定加速度计测量误差模型的参数来消除部分误差,步骤简单,效率高;
2、本发明由于通过计算惯性导航系统INS正常持续工作时的参数进行补偿,无需反复开关机,能延长惯性导航系统中的电机的使用寿命;
3、本发明由于引入全球卫星导航系统GNSS的实时导航信息,误差累积小,精度高,实时性好。
附图说明
图1为现有的GNSS的惯性导航系统图;
图2为本发明的实现流程图。
具体实施方式
参照图1,本发明使用的GNSS的惯性导航系统,包括GNSS接收机1,INS惯性测量单元2,速度解算模块3,积分模块4,速度斜率计算模块5,微分模块6,漂移值变化率计算模块7和漂移补偿模块8。GNSS接收机模块1接收卫星的导航定位信息并输出至速度解算模块3;速度解算模块3接收GNSS接收机1输出的导航定位信息,计算GNSS接收机1的当前速度,并输出至速度斜率计算模块5;INS惯性测量单元2将当前时刻的加速度信息输出至积分模块4;积分模块4将INS惯性测量单元2的加速度信息进行积分,计算INS惯性测量单元2的当前速度,并输出至速度斜率计算模块5;速度斜率计算模块5分别接收速度解算模块3和积分模块4输出的速度值,计算INS惯性测量单元2速度变化的斜率,并输出至微分模块6;微分模块6对INS惯性测量单元2速度变化的斜率进行微分,计算出INS惯性测量单元2加速度计的漂移值,并将该漂移值输出至漂移值变化率计算模块7;漂移值变化率计算模块7根据INS惯性测量单元2加速度计的漂移值计算上一时刻到当前时刻内INS惯性测量单元2加速度漂移值的变化率,并输出至漂移补偿模块8;漂移补偿模块8计算当前时刻到下一时刻INS惯性测量单元2加速度的漂移值,输出至INS惯性测量单元2,对下一时刻INS惯性测量单元2的加速度值进行补偿。
参照图2,本发明基于上述系统对惯性导航加速度计漂移进行实时补偿的方法,其实现步骤如下:
步骤1,获取当前时刻惯性导航系统INS的加速度。
分别采集惯性导航系统INS的在X轴方向加速度计和Y轴方向加速度计的输出值,得到惯性导航系统INS输出的X轴方向加速度ax1和Y轴方向加速度ay1。
步骤2,对惯性导航系统INS的加速度进行积分。
2.1)在上一时刻t0到当前时刻t1内,对惯性导航系统INS的X轴方向加速度ax1进行积分,得到当前时刻惯性导航系统INS的X轴方向速度值vx1:
2.2)在上一时刻t0到当前时刻t1内,对惯性导航系统INS的Y轴方向加速度ay1进行积分,得到当前时刻惯性导航系统INS的Y轴方向速度值vy1:
步骤3,获取全球卫星导航系统GNSS的导航定位信息。
采集全球卫星导航系统GNSS输出至惯性导航系统INS经纬度信息,得到全球卫星导航系统GNSS当前时刻t1的导航定位信息(x1,y1)与上一时刻t0的导航定位信息(x0,y0)。
步骤4,计算全球卫星导航系统GNSS的速度值。
4.1)根据将全球卫星导航系统GNSS在当前时刻t1的X轴方向的导航定位信息x1与在上一时刻t0的X轴方向的导航定位信息x0的差值,与当前时刻t1与上一时刻t0的差值,得到全球卫星导航系统GNSS的X轴方向速度值vx:
4.2)根据将全球卫星导航系统GNSS在当前时刻t1的Y轴方向的导航定位信息y1与在上一时刻t0的Y轴方向的导航定位信息y0的差值,及当前时刻t1与上一时刻t0的差值,得到全球卫星导航系统GNSS的Y轴方向速度值vy:
步骤5,计算惯性导航系统INS的速度变化值。
5.1)根据全球卫星导航系统GNSS在当前时刻t1的X轴方向速度值vx与惯性导航系统INS在当前时刻t1的X轴方向速度值vx1的差值,及当前时刻t1与上一时刻t0的差值,得到惯性导航系统INS的X轴方向速度变化斜率vxd:
5.2)根据全球卫星导航系统GNSS在当前时刻t1的Y轴方向速度值vy与惯性导航系统INS在当前时刻t1的Y轴方向速度值vy1之差,及当前时刻t1与上一时刻t0的差值,得到惯性导航系统INS的Y轴方向速度变化斜率vyd:
步骤6,计算惯性导航系统INS的加速度漂移值。
6.1)对惯性导航系统INS的X轴方向速度变化斜率vxd进行微分,得到上一时刻t0到当前时刻t1时间段内惯性导航系统INS的X轴方向加速度漂移值ax:
6.2)对惯性导航系统INS的Y轴方向速度变化斜率vyd进行微分,得到上一时刻t0到当前时刻t1时间段内惯性导航系统INS的Y轴方向加速度漂移值ay:
步骤7,计算当前时刻惯性导航系统INS的加速度漂移值的变化率。
7.1)将惯性导航系统INS的X轴方向加速度漂移值ax,比上当前时刻t1与上一时刻t0的差值,得到惯性导航系统INS的X轴方向加速度漂移值变化斜率axd:
7.2)将惯性导航系统INS的Y轴方向加速度漂移值ay,比上当前时刻t1与上一时刻t0的差值,得到惯性导航系统INS的Y轴方向加速度漂移值变化斜率ayd:
步骤8,计算下一时刻惯性导航系统INS的加速度漂移值。
8.1)根据当前时刻INS的X轴方向加速度漂移值的变化率axd计算出下一时刻t2导航系统INS的X轴方向加速度漂移值
8.2)根据当前时刻INS的Y轴方向加速度漂移值的变化率ayd,计算出下一时刻t2w导航系统INS的Y轴方向加速度漂移值
步骤9,对下一时刻惯性导航系统INS的加速度进行补偿。
9.1)利用步骤8得到的X轴方向加速度漂移值对性导航系统INS在下一时刻t2的X轴方向加速度值ax2进行补偿,得到补偿后的X轴方向加速度值
9.2)利用步骤8得到的Y轴方向加速度漂移值对惯性导航系统INS在下一时刻t2的Y轴方向加速度值ay2进行补偿,得到补偿后的Y轴方向加速度值
以上描述仅是本发明的一个具体实例,显然对于本领域的专业人员来说,在了解了本发明内容和原理后,都可能在不背离本发明原理、结构的情况下,进行形式和细节上的各种修正和改变,但是这些基于本发明思想的修正和改变仍在本发明的权利要求保护范围之内。
Claims (5)
1.一种基于GNSS的惯性导航的加速度计漂移实时补偿方法,包括:
S1.获取惯性导航系统INS输出的X轴方向加速度信号ax1和Y轴方向加速度信号ay1,并在上一时刻t0到当前时刻t1内对加速度信号进行积分,计算当前时刻惯性导航系统INS的X轴方向速度值vx1和Y轴方向速度值vy1;
S2.获取全球卫星导航系统GNSS当前时刻t1的定位信息(x1,y1)与上一时刻t0输出的定位信息(x0,y0),计算全球卫星导航系统GNSS的X轴方向速度值vx和Y轴方向速度值vy;
S3.计算惯性导航系统INS的X轴方向加速度漂移值ax与Y轴方向加速度漂移值ay:
S31)根据惯性导航系统INS测得的速度值vx1与vy1和全球卫星导航系统GNSS测得的速度值vx和vy,得到惯性导航系统INS的X轴方向速度变化斜率vxd与Y轴方向速度变化斜率vyd:
S32)对惯性导航系统INS的X轴方向速度变化斜率vxd与Y轴方向速度变化斜率vyd进行求导,计算t0到t1时间段内惯性导航系统INS的X轴方向加速度漂移值ax与Y轴方向加速度漂移值ay;
S4.计算惯性导航系统INS的X轴方向加速度漂移值变化斜率axd与Y轴方向加速度漂移值变化斜率ayd;
S5.利用S4的结果分别对惯性导航系统INS在下一时刻t2的X轴方向加速度值ax2和Y轴方向加速度值ay2进行补偿,得到补偿后的X轴方向加速度值和Y轴方向加速度值
2.根据权利要求1所述的方法,其特征在于,步骤S1中计算当前时刻惯性导航系统INS的X轴方向速度值vx1和Y轴方向速度值vy1,按如下公式计算:
3.根据权利要求1所述的方法,其特征在于,步骤S2中计算全球卫星导航系统GNSS的X轴方向速度值vx和Y轴方向速度值vy,按如下公式计算:
4.根据权利要求1所述的方法,其特征在于,步骤S3中t0到t1时间段内惯性导航系统INS的X轴方向加速度漂移值ax与Y轴方向加速度漂移值ay,按如下公式计算:
5.根据权利要求1所述的方法,其特征在于,步骤S4中计算惯性导航系统INS的X轴方向加速度漂移值变化斜率axd与Y轴方向加速度漂移值变化斜率ayd,按如下公式计算:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610846737.4A CN106403999B (zh) | 2016-09-23 | 2016-09-23 | 基于gnss的惯性导航加速度计漂移实时补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610846737.4A CN106403999B (zh) | 2016-09-23 | 2016-09-23 | 基于gnss的惯性导航加速度计漂移实时补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106403999A true CN106403999A (zh) | 2017-02-15 |
CN106403999B CN106403999B (zh) | 2019-04-19 |
Family
ID=57997485
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610846737.4A Active CN106403999B (zh) | 2016-09-23 | 2016-09-23 | 基于gnss的惯性导航加速度计漂移实时补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106403999B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110596426A (zh) * | 2019-09-25 | 2019-12-20 | 上海航天控制技术研究所 | 一种加速度计组合数据漂移自主辨识方法 |
CN111435258A (zh) * | 2019-10-23 | 2020-07-21 | 珠海全志科技股份有限公司 | 一种无人机漂移补偿方法、装置以及无人机 |
CN111536996A (zh) * | 2020-05-14 | 2020-08-14 | 北京百度网讯科技有限公司 | 温漂的标定方法、装置、设备和介质 |
CN114413933A (zh) * | 2022-01-17 | 2022-04-29 | 广东星舆科技有限公司 | 一种加速度计动态较准方法、系统及存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030149528A1 (en) * | 2002-02-06 | 2003-08-07 | Ching-Fang Lin | Positioning and navigation method and system thereof |
US20150105943A1 (en) * | 2009-08-14 | 2015-04-16 | IPOZ Systems, LLC | Devices, program products and computer implemented methods for touchless metrology having virtual zero-velocity and position update |
CN105371838A (zh) * | 2014-08-06 | 2016-03-02 | 航天恒星科技有限公司 | 基于ins辅助gnss单天线测姿的组合导航方法及系统 |
CN105737853A (zh) * | 2016-02-04 | 2016-07-06 | 中国科学院电子学研究所 | 一种机器人惯性导航系统的漂移校准方法 |
-
2016
- 2016-09-23 CN CN201610846737.4A patent/CN106403999B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030149528A1 (en) * | 2002-02-06 | 2003-08-07 | Ching-Fang Lin | Positioning and navigation method and system thereof |
US20150105943A1 (en) * | 2009-08-14 | 2015-04-16 | IPOZ Systems, LLC | Devices, program products and computer implemented methods for touchless metrology having virtual zero-velocity and position update |
CN105371838A (zh) * | 2014-08-06 | 2016-03-02 | 航天恒星科技有限公司 | 基于ins辅助gnss单天线测姿的组合导航方法及系统 |
CN105737853A (zh) * | 2016-02-04 | 2016-07-06 | 中国科学院电子学研究所 | 一种机器人惯性导航系统的漂移校准方法 |
Non-Patent Citations (1)
Title |
---|
PATRICK HENKEL: ""Calibration of Magnetic Field Sensors with two mass-market GNSS receivers"", 《2014WPNC》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110596426A (zh) * | 2019-09-25 | 2019-12-20 | 上海航天控制技术研究所 | 一种加速度计组合数据漂移自主辨识方法 |
CN111435258A (zh) * | 2019-10-23 | 2020-07-21 | 珠海全志科技股份有限公司 | 一种无人机漂移补偿方法、装置以及无人机 |
CN111435258B (zh) * | 2019-10-23 | 2023-08-11 | 珠海全志科技股份有限公司 | 一种无人机漂移补偿方法、装置以及无人机 |
CN111536996A (zh) * | 2020-05-14 | 2020-08-14 | 北京百度网讯科技有限公司 | 温漂的标定方法、装置、设备和介质 |
JP2021179420A (ja) * | 2020-05-14 | 2021-11-18 | ベイジン バイドゥ ネットコム サイエンス アンド テクノロジー カンパニー リミテッド | 温度ドリフトの較正方法、装置、デバイス及び媒体 |
EP3910289A3 (en) * | 2020-05-14 | 2021-12-08 | Apollo Intelligent Connectivity (Beijing) Technology Co., Ltd. | Method, apparatus, device and medium for calibrating temperature drift |
CN111536996B (zh) * | 2020-05-14 | 2022-10-11 | 阿波罗智联(北京)科技有限公司 | 温漂的标定方法、装置、设备和介质 |
JP7248643B2 (ja) | 2020-05-14 | 2023-03-29 | 阿波▲羅▼智▲聯▼(北京)科技有限公司 | 温度ドリフトの較正方法、装置、デバイス及び媒体 |
CN114413933A (zh) * | 2022-01-17 | 2022-04-29 | 广东星舆科技有限公司 | 一种加速度计动态较准方法、系统及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN106403999B (zh) | 2019-04-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10877059B2 (en) | Positioning apparatus comprising an inertial sensor and inertial sensor temperature compensation method | |
RU2380656C1 (ru) | Комплексированная бесплатформенная инерциально-спутниковая система навигации на "грубых" чувствительных элементах | |
CN102436004A (zh) | 定位系统及定位方法 | |
CN101858748A (zh) | 高空长航无人机的多传感器容错自主导航方法 | |
CN110631574B (zh) | 一种惯性/里程计/rtk多信息融合方法 | |
CN102645222A (zh) | 一种卫星惯性导航方法和设备 | |
CN106403999B (zh) | 基于gnss的惯性导航加速度计漂移实时补偿方法 | |
Nguyen | Loosely coupled GPS/INS integration with Kalman filtering for land vehicle applications | |
CN110133695B (zh) | 一种双天线gnss位置延迟时间动态估计系统及方法 | |
CN102590842B (zh) | 一种gnss/imu一体化天线 | |
CN108195374A (zh) | 用于轨道自动测量车的组合导航系统及组合导航解算方法 | |
CN103743378A (zh) | 一种管道检测器姿态检测系统 | |
CN104931994A (zh) | 一种基于软件接收机的分布式深组合导航方法及系统 | |
US11585657B2 (en) | Geoid measurement method, geoid measurement apparatus, geoid estimation device, and geoid calculation data collection device | |
CN103308071A (zh) | 一种gps/ins定位导航装置微机电陀螺仪零点电压校正方法 | |
CN202649469U (zh) | 有效全球卫星定位系统所在位置判断的定位装置 | |
RU2382988C1 (ru) | Бесплатформенная инерциальная система ориентации на "грубых" чувствительных элементах | |
US20050119798A1 (en) | Method and apparatus for measuring velocity of land vehicle using accelerometer and route guidance information data | |
CN104567888A (zh) | 基于速度在线修正的惯性导航车辆姿态测量方法 | |
CN111197994B (zh) | 位置数据修正方法、装置、计算机设备和存储介质 | |
CN103557869A (zh) | 一种车载导航仪 | |
US20130085664A1 (en) | Apparatus and method for detecting heading change in mobile terminal | |
CN202837553U (zh) | 距离及方向校正的位置估测装置 | |
RU2539131C1 (ru) | Бесплатформенная интегрированная навигационная система средней точности для мобильного наземного объекта | |
CN103471593B (zh) | 一种基于gps信息的惯性导航系统测量误差修正方法 |
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 | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20231011 Address after: Room 201, Clubhouse Building, Wanhuayuan Linyuan Community, No. 3 Dongyuan West Road, Xincheng District, Xi'an City, Shaanxi Province, 710038 Patentee after: Xi'an Yanjie Electronic Technology Co.,Ltd. Address before: 710071 Taibai South Road, Yanta District, Xi'an, Shaanxi Province, No. 2 Patentee before: XIDIAN University |