CN112254736A - 一种惯导与里程计组合导航的时延误差的补偿方法及*** - Google Patents
一种惯导与里程计组合导航的时延误差的补偿方法及*** Download PDFInfo
- Publication number
- CN112254736A CN112254736A CN202010969508.8A CN202010969508A CN112254736A CN 112254736 A CN112254736 A CN 112254736A CN 202010969508 A CN202010969508 A CN 202010969508A CN 112254736 A CN112254736 A CN 112254736A
- Authority
- CN
- China
- Prior art keywords
- time
- inertial navigation
- navigation
- odometer
- rotation
- 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
- 238000000034 method Methods 0.000 title claims abstract description 32
- 230000008569 process Effects 0.000 claims abstract description 4
- 238000005070 sampling Methods 0.000 claims description 19
- 230000001133 acceleration Effects 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 claims description 7
- 238000005452 bending Methods 0.000 claims description 6
- 230000008859 change Effects 0.000 claims description 6
- 238000004590 computer program Methods 0.000 claims description 6
- 230000005484 gravity Effects 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 4
- 238000004422 calculation algorithm Methods 0.000 description 4
- 238000005259 measurement Methods 0.000 description 3
- 239000002184 metal Substances 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000002360 preparation method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 238000013480 data collection Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Images
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/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
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
技术领域
本发明涉及组合导航领域,尤其涉及一种惯导与自动驾驶车辆上的里程计之间的组合导航的时延误差的补偿方法及***。
背景技术
在自动驾驶车辆上,往往使用惯导与里程计组合来提供更高的导航精度,避免纯惯导误差随时间的增长。惯导与里程计的输出数据由车上的总控计算机采集,然后进行处理,未标定情况下两者存在一定时间延迟,会影响导航精度。
传统的对时延误差的补偿方法主要分为硬件补偿和算法补偿。硬件补偿是增加硬件模块,用脉冲来使两者同步,这种方法需要增加硬件资源,导致线路复杂,并且增加成本;算法补偿使用算法来进行同步,大大增加了计算量与算法复杂度,影响组合导航精度。
另外还有标定的方法,让车从静止启动,从总控计算机采集的数据中分别找到惯导速度和里程计速度不为零的起始点,并将两者的时间戳作差,所得的值即为时延。但里程计对速度不敏感,会出现车动了速度还是零的情况,导致计算误差。
因此需要提出一种经济的、不影响导航精度的时延误差补偿方法。
发明内容
本发明提供了一种惯导与里程计组合导航的时延误差的补偿方法及***,用以解决现有对时延误差的补偿方法成本高、导航精度低的技术问题。
为解决上述技术问题,本发明提出的技术方案为:
一种惯导与里程计组合导航的时延误差的补偿方法,包括以下步骤:
在车辆启动、行驶以及停车的过程中采集随时间变化的惯导数据,和随时间变化的里程计数据;
根据随时间变化的惯导数据,进行速度更新,找出速度最大值对应的时间戳,作为第一时刻;
根据随时间变化的里程计数据,找出速度最大值对应的时间戳,作为第二时刻;
将第一时刻与第二时刻之差的绝对值作为时延误差,进行补偿。
优选地,根据随时间变化的惯导数据,进行速度更新,计算公式为:
其中,表示tm-1/2时刻地球自转引起的导航系旋转;表示tm-1/2时刻惯导***在地球表面附近移动因地球表面弯曲而引起的导航系旋转;表示tm-1/2时刻的惯导***的速度;为tm-1/2时刻的重力加速度,且有tm-1/2=(tm-1+tm)/2,用tm-1/2时刻的值近似替代tm时刻的值。
优选地,惯导***的相关参数随着时间更新,更新公式为:
其中,x可取vn,gn四种变量,为地球自转引起的导航系旋转;为惯导***在地球表面附近移动因地球表面弯曲而引起的导航系旋转;vn为惯导***的速度;gn为重力加速度,下标tm-1/2,m-1,m-2分别表示时刻。
其中,Δθm表示陀螺采样角增量;且,Δθm=Δθm1+Δθm2 (6)
其中,Δθm1为前一次采样的角增量,Δθm2为后一次采样的角增量;
Δvm为加速度计采样比力速度增量;且,
Δvm=Δvm1+Δvm2 (5)
其中,Δvm1前一次采样的速度增量,Δvm2为后一次采样的速度增量。
优选地,加速度计采样比力速度增量和陀螺采样角增量,通过以下步骤得到:
当陀螺仪和加速度计在[tm-1,tm]内均进行两次等间隔采样,采样时刻分别为tm-1/2和tm,且记T=tm-tm-1和h=T/2,则可得采样增量:
本发明还提供一种计算机***,包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,处理器执行计算机程序时实现上述任一方法的步骤。
本发明具有以下有益效果:
本发明的惯导与里程计组合导航的时延误差的补偿方法及***,通过计算惯导速度和里程计速度的最大速度点的时间戳,从而得出时间延时,无需增加硬件资源,可在不增加成本的基础上有效的提高组合导航的精度。
除了上面所描述的目的、特征和优点之外,本发明还有其它的目的、特征和优点。下面将参照附图,对本发明作进一步详细的说明。
附图说明
构成本申请的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1是本发明优选实施例的惯导与里程计组合导航的时延误差的补偿方法的流程示意图。
具体实施方式
以下结合附图对本发明的实施例进行详细说明,但是本发明可以由权利要求限定和覆盖的多种不同方式实施。
参见图1,本发明的惯导与里程计组合导航的时延误差的补偿方法,包括以下步骤:
S1、在车辆启动、行驶以及停车的过程中采集随时间变化的惯导数据,和随时间变化的里程计数据。实施时,为了获取准确的数据,通常需要进行准备步骤、跑车步骤以及测量步骤。准备步骤为:将惯导、里程计和总控计算机与车子固联,电源给其供电,保证总控机能采集到包含时间戳的惯导和里程计的数据;跑车步骤表示完成至少一个阶段:车辆启动、行驶并停车,在此过程中确保车辆有一定速度变化;测量步骤为待车子开启时开始采集惯导和里程计的数据,待数据采集完毕后,进入下一步骤以根据测量得到的里程计与惯导的数据的计算时延。
S2、根据随时间变化的惯导数据,进行速度更新,找出速度最大值对应的时间戳,作为第一时刻t1。实施时,可通过以下步骤进行:
根据随时间变化的惯导数据,进行速度更新,计算公式为:
对运载体而言,在短时间[tm-1,tm]内引起的导航坐标系旋转和重力矢量变化都是很小的,因而一般认为的被积函数是时间的缓慢量,可采用tm-1/2=(tm-1+tm)/2时刻的值进行近似代替,故符合以下公式:
其中,表示tm-1/2时刻地球自转引起的导航系旋转;表示tm-1/2时刻惯导***在地球表面附近移动因地球表面弯曲而引起的导航系旋转;表示tm-1/2时刻的惯导***的速度;为tm-1/2时刻的重力加速度。
tm时刻的导航速度和位置等参数是未知的,惯导***的相关参数随着时间更新,更新公式为:
其中,x可取vn,gn四种变量;下标tm-1/2,m-1,m-2分别表示时刻,xm-1/2为tm时刻的导航位置;xm-1为tm-1时刻的导航位置;xm-2为tm-2时刻的导航位置;为地球自转引起的导航系旋转;为惯导***在地球表面附近移动因地球表面弯曲而引起的导航系旋转;vn为惯导***的速度;gn为重力加速度,且有tm-1/2=(tm-1+tm)/2,用tm-1/2时刻的值近似替代tm时刻的值。
Δvm为加速度计采样比力速度增量;且,
Δvm=Δvm1+Δvm2 (5)
其中,Δvm1前一次采样的速度增量,Δvm2为后一次采样的速度增量。
Δθm表示陀螺采样角增量;且,Δθm=Δθm1+Δθm2 (6)
其中,Δθm1为前一次采样的角增量,Δθm2为后一次采样的角增量。若陀螺仪和加速度计在[tm-1,tm]内均进行两次等间隔采样,采样时刻分别为tm-1/2和tm,且记T=tm-tm-1和h=T/2,则可得采样增量:
S3、根据随时间变化的里程计数据,找出速度最大值对应的时间戳,作为第二时刻t2;
S4、将第一时刻与第二时刻之差的绝对值作为时延误差Δt=|t1-t2|,对Δt进行补偿。
作为另一个实施方式,本发明还提供一种计算机***,包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,处理器执行计算机程序时实现上述任一实施例的步骤。
综上可知,本发明的惯导与里程计组合导航的时延误差的补偿方法及***,通过计算惯导速度和里程计速度的最大速度点的时间戳,从而得出时间延时,无需增加硬件资源,可在不增加成本的基础上有效的提高组合导航的精度。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (7)
1.一种惯导与里程计组合导航的时延误差的补偿方法,其特征在于,包括以下步骤:
在车辆启动、行驶以及停车的过程中采集随时间变化的惯导数据,和随时间变化的里程计数据;
根据所述随时间变化的惯导数据,进行速度更新,找出速度最大值对应的时间戳,作为第一时刻;
根据所述随时间变化的里程计数据,找出速度最大值对应的时间戳,作为第二时刻;
将所述第一时刻与第二时刻之差的绝对值作为时延误差,进行补偿。
其中,Δθm表示陀螺采样角增量;且,Δθm=Δθm1+Δθm2 (6)
其中,Δθm1为前一次采样的角增量,Δθm2为后一次采样的角增量;
Δvm为加速度计采样比力速度增量;且,
Δvm=Δvm1+Δvm2 (5)
其中,Δvm1前一次采样的速度增量,Δvm2为后一次采样的速度增量。
7.一种计算机***,包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现上述权利要求1至6中任一所述方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010969508.8A CN112254736A (zh) | 2020-09-15 | 2020-09-15 | 一种惯导与里程计组合导航的时延误差的补偿方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010969508.8A CN112254736A (zh) | 2020-09-15 | 2020-09-15 | 一种惯导与里程计组合导航的时延误差的补偿方法及*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112254736A true CN112254736A (zh) | 2021-01-22 |
Family
ID=74232564
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010969508.8A Pending CN112254736A (zh) | 2020-09-15 | 2020-09-15 | 一种惯导与里程计组合导航的时延误差的补偿方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112254736A (zh) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110136512A1 (en) * | 2009-12-03 | 2011-06-09 | Sony Corporation | Velocity calculating apparatus, velocity calculating method, navigation apparatus, and mobile phone with navigation function |
US20140057572A1 (en) * | 2012-08-23 | 2014-02-27 | Sony Mobile Communications Ab | Method and system for alignment of sensors in a similar environment |
US20140257730A1 (en) * | 2013-03-11 | 2014-09-11 | Qualcomm Incorporated | Bandwidth and time delay matching for inertial sensors |
CN105157724A (zh) * | 2015-07-30 | 2015-12-16 | 北京航空航天大学 | 一种基于速度加姿态匹配的传递对准时间延迟估计与补偿方法 |
CN108180925A (zh) * | 2017-12-15 | 2018-06-19 | 中国船舶重工集团公司第七0七研究所 | 一种里程计辅助车载动态对准方法 |
CN109163734A (zh) * | 2018-09-18 | 2019-01-08 | 北京机械设备研究所 | 一种基于双轴光纤旋转调制组合导航***的自主标定方法 |
CN110057382A (zh) * | 2019-04-23 | 2019-07-26 | 西北工业大学 | 一种基于发射坐标系的捷联惯导数值更新方法 |
CN110221333A (zh) * | 2019-04-11 | 2019-09-10 | 同济大学 | 一种车载ins/od组合导航***的量测误差补偿方法 |
CN110779521A (zh) * | 2019-11-12 | 2020-02-11 | 成都中科微信息技术研究院有限公司 | 一种多源融合的高精度定位方法与装置 |
CN111288984A (zh) * | 2020-03-04 | 2020-06-16 | 武汉大学 | 一种基于车联网的多车联合绝对定位的方法 |
CN111536972A (zh) * | 2020-06-19 | 2020-08-14 | 立得空间信息技术股份有限公司 | 一种基于里程计刻度系数修正的车载dr导航方法 |
-
2020
- 2020-09-15 CN CN202010969508.8A patent/CN112254736A/zh active Pending
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110136512A1 (en) * | 2009-12-03 | 2011-06-09 | Sony Corporation | Velocity calculating apparatus, velocity calculating method, navigation apparatus, and mobile phone with navigation function |
US20140057572A1 (en) * | 2012-08-23 | 2014-02-27 | Sony Mobile Communications Ab | Method and system for alignment of sensors in a similar environment |
US20140257730A1 (en) * | 2013-03-11 | 2014-09-11 | Qualcomm Incorporated | Bandwidth and time delay matching for inertial sensors |
CN105157724A (zh) * | 2015-07-30 | 2015-12-16 | 北京航空航天大学 | 一种基于速度加姿态匹配的传递对准时间延迟估计与补偿方法 |
CN108180925A (zh) * | 2017-12-15 | 2018-06-19 | 中国船舶重工集团公司第七0七研究所 | 一种里程计辅助车载动态对准方法 |
CN109163734A (zh) * | 2018-09-18 | 2019-01-08 | 北京机械设备研究所 | 一种基于双轴光纤旋转调制组合导航***的自主标定方法 |
CN110221333A (zh) * | 2019-04-11 | 2019-09-10 | 同济大学 | 一种车载ins/od组合导航***的量测误差补偿方法 |
CN110057382A (zh) * | 2019-04-23 | 2019-07-26 | 西北工业大学 | 一种基于发射坐标系的捷联惯导数值更新方法 |
CN110779521A (zh) * | 2019-11-12 | 2020-02-11 | 成都中科微信息技术研究院有限公司 | 一种多源融合的高精度定位方法与装置 |
CN111288984A (zh) * | 2020-03-04 | 2020-06-16 | 武汉大学 | 一种基于车联网的多车联合绝对定位的方法 |
CN111536972A (zh) * | 2020-06-19 | 2020-08-14 | 立得空间信息技术股份有限公司 | 一种基于里程计刻度系数修正的车载dr导航方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108180925B (zh) | 一种里程计辅助车载动态对准方法 | |
CN106969783B (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
CN112697141A (zh) | 基于逆向导航的惯导/里程计动基座姿态与位置对准方法 | |
CN110361031B (zh) | 一种基于回溯理论的imu全参数误差快速标定方法 | |
CN111006675B (zh) | 基于高精度重力模型的车载激光惯导***自标定方法 | |
CN111121766B (zh) | 一种基于星光矢量的天文与惯性组合导航方法 | |
CN113063429B (zh) | 一种自适应车载组合导航定位方法 | |
CN111024074B (zh) | 一种基于递推最小二乘参数辨识的惯导速度误差确定方法 | |
CN108627152B (zh) | 一种微型无人机基于多传感器数据融合的导航方法 | |
CN105910606A (zh) | 一种基于角速度差值的方向修正方法 | |
CN114061619B (zh) | 一种基于在线标定的惯导***姿态补偿方法 | |
CN114964222A (zh) | 一种车载imu姿态初始化方法、安装角估计方法及装置 | |
CN108871323B (zh) | 一种低成本惯性传感器在机动环境下的高精度导航方法 | |
CN108955671B (zh) | 一种基于磁偏角、磁倾角的卡尔曼滤波导航方法 | |
CN114877915B (zh) | 一种激光陀螺惯性测量组件g敏感性误差标定装置及方法 | |
CN113959462A (zh) | 一种基于四元数的惯性导航***自对准方法 | |
CN111307114B (zh) | 基于运动参考单元的水面舰船水平姿态测量方法 | |
CN113916226B (zh) | 一种基于最小方差的组合导航***抗扰滤波方法 | |
CN113008229B (zh) | 一种基于低成本车载传感器的分布式自主组合导航方法 | |
CN112254736A (zh) | 一种惯导与里程计组合导航的时延误差的补偿方法及*** | |
CN109596139B (zh) | 基于mems的车载导航方法 | |
US6085149A (en) | Integrated inertial/VMS navigation solution | |
CN113267183A (zh) | 一种多加速度计惯导***的组合导航方法 | |
CN111189473A (zh) | 一种基于磁传感器和加表的航姿***陀螺误差补偿方法 | |
CN113639766B (zh) | 双轴旋转惯性导航***中包含非正交角的***级标定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210122 |