CN114018254A - 一种激光雷达与旋转惯导一体化构架与信息融合的slam方法 - Google Patents
一种激光雷达与旋转惯导一体化构架与信息融合的slam方法 Download PDFInfo
- Publication number
- CN114018254A CN114018254A CN202111257759.4A CN202111257759A CN114018254A CN 114018254 A CN114018254 A CN 114018254A CN 202111257759 A CN202111257759 A CN 202111257759A CN 114018254 A CN114018254 A CN 114018254A
- Authority
- CN
- China
- Prior art keywords
- state
- inertial navigation
- error
- vector
- wavelet
- 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 31
- 238000001914 filtration Methods 0.000 claims abstract description 13
- 230000033001 locomotion Effects 0.000 claims abstract description 10
- 238000013519 translation Methods 0.000 claims abstract description 10
- 238000000605 extraction Methods 0.000 claims abstract description 5
- 238000004422 calculation algorithm Methods 0.000 claims description 35
- 239000013598 vector Substances 0.000 claims description 26
- 230000006870 function Effects 0.000 claims description 11
- 230000008569 process Effects 0.000 claims description 9
- 239000011159 matrix material Substances 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 claims description 6
- 230000004913 activation Effects 0.000 claims description 5
- 239000000126 substance Substances 0.000 claims description 5
- 238000012545 processing Methods 0.000 claims description 4
- 238000013528 artificial neural network Methods 0.000 claims description 3
- OAICVXFJPJFONN-UHFFFAOYSA-N Phosphorus Chemical compound [P] OAICVXFJPJFONN-UHFFFAOYSA-N 0.000 claims description 2
- 244000286916 Ratibida columnifera Species 0.000 claims description 2
- 235000009413 Ratibida columnifera Nutrition 0.000 claims description 2
- 230000001133 acceleration Effects 0.000 claims description 2
- 230000015572 biosynthetic process Effects 0.000 claims description 2
- 238000010606 normalization Methods 0.000 claims description 2
- 238000003786 synthesis reaction Methods 0.000 claims description 2
- 230000009466 transformation Effects 0.000 claims description 2
- 230000007704 transition Effects 0.000 claims description 2
- 238000005094 computer simulation Methods 0.000 claims 1
- 230000004927 fusion Effects 0.000 abstract description 10
- 238000010276 construction Methods 0.000 abstract 1
- 230000010354 integration Effects 0.000 abstract 1
- 238000013507 mapping Methods 0.000 description 13
- 238000010586 diagram Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 5
- 101000981685 Homo sapiens Protein Lines homolog 1 Proteins 0.000 description 4
- 102100024087 Protein Lines homolog 1 Human genes 0.000 description 4
- 238000012937 correction Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 238000011161 development Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 230000004807 localization Effects 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000001360 synchronised 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/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
- G01C21/165—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 combined with non-inertial navigation instruments
-
- 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/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于激光雷达与旋转惯导一体化构架与信息融合的SLAM方法,所述方法包括:特征提取步骤,通过IMU数据计算激光帧之间的平移与旋转,消除原始点云中的运动畸变,从中提取稳定的边缘与平面特征。LIO步骤,由状态递推子模块和更新子模块组成,进行迭代卡尔曼滤波,输出初始里程以及未失真的特征。建图步骤,用全局地图改进初始里程,输出新的里程,然后使用新的特征更新地图。本发明所提出方法可应用于中低精度的MEMS惯导,有效提高了长时间运行时惯导系统的定位精度,从而提升了建图的准确性和可靠性。
Description
技术领域
本发明涉及同步定位与建图领域,具体涉及一种基于旋转惯导与激光雷达数据融合的SLAM方法。
背景技术
如今SLAM(simultaneous localization and mapping,即时定位与地图构建)技术已在机器人、无人机、AVG等领域拥有广泛的应用,基于多线激光雷达传感器的定位与建图算法是当前SLAM领域的一个热点问题。研究如何提升激光雷达的SLAM系统在长时间运动过程中定位与建图的精度和稳定性,对我国机器人与智能驾驶等行业的发展有重要意义。
随着激光SLAM研究的不断发展,在理论、技术和产品落地上越来越成熟,对机器人和自动驾驶企业来说,激光SLAM仍是目前最稳定、最主流的定位导航方法。由于激光雷达本身测距的精度较高,误差模型简单,在强光直射以外的环境中运行稳定,所以激光SLAM算法在特定的环境中通常能取得比较好的效果。然而,基于运动估计的激光雷达点云存在稀疏性与运动失真的问题,导致仅使用激光雷达的SLAM系统在一些宽阔和开放的环境中表现不佳。最近的研究表明,通过融合惯性传感器IMU来弥补该缺陷是一个很好的解决方案。
目前,融合IMU的激光SLAM算法精度一定程度上仍依赖基于MEMS技术的IMU精度。为了提升其精度,现有的技术手段将IMU安装于旋转平台上并进行对准,从而准确地估计出载体当前的姿态信息和IMU的加速度计零偏与陀螺仪零偏。现有的方法IMU对准耗时较长,也不能达到可靠的精度。
发明内容
本发明索要解决的技术问题是,针对惯性传感器精度低下影响激光雷达/惯性SLAM性能的问题,为了提高IMU对准的速度与精度,本发明将在研究旋转捷联惯导系统的结构特点对导航系统性能影响的基础上,提出基于模糊自适应卡尔曼滤波的旋转惯导系统对准方法,实现惯导系统的快速对准。
本发明为解决上述技术问题采用以下技术方案:
(1)惯导对准:利用RWNN模型处理IMU数据,进行惯导系统动基座对准,对IMU误差进行修正,并输出修正后的惯导系统姿态和惯性信息;
(2)特征提取:使用修正后的惯性信息,计算激光帧之间的平移与旋转,消除原始点云中的运动畸变,从中提取稳定的边缘与平面特征,通过特征匹配计算两帧激光数据间的位姿变换;
(3)采用激光惯性里程计LIO模型进行导航解算:使用修正后的惯性信息进行惯性导航解算,作为滤波器估计值,再利用激光雷达的位姿解算结果作为滤波器的观测值,进行迭代卡尔曼滤波,输出系统在全局坐标系下的位姿以及未失真的特征;
(4)建图:采用基于全局地图的匹配,输出修正后的位姿,然后使用新的特征更新三维点云地图。
本发明采用以上技术方案与现有技术相比,具有以下技术效果:
本发明提出的基于RWNN的惯导动对准方案能有效减小长时间运行下IMU期间的累积误差,提高惯导系统在长时间运行时的导航精度以及可靠性,特别是中低精度的惯性传感器的定位精度;本发明采用的简化的激光惯性里程计(LIO)模型因为输入的加速度计与陀螺仪贬值已经过惯导对准与误差校正,减低了ESKF的维度,提高了滤波运算器的效率;本发明所提出的激光雷达与旋转惯导一体化构架与信息融合的SLAM方法相比于未对IMU做对准的算法,拥有更好的精度与稳定性,在算法在长时间运行的情况下,大幅减少了轨迹的漂移,显著提升了激光惯性里程计的定位精度与稳定性,对激光惯性融合SLAM算法的工程应用具有重要参考价值。
附图说明
图1为本发明设计的激光雷达与旋转惯导融合的SLAM方法流程图。
图2为本发明采用的基于RWNN近似算法的网络结构图。
图3为本发明提出的简化激光雷达里程计(LIO)模型结构图。
图4是实验场景卫星地图。
图5是室外实验场景各算法定位轨迹对比。
图6是建图结果;其中a)是LINS算法建图结果,b)是本发明算法建图结果。
图7是激光雷达与旋转惯导信息融合的SLAM算法流程。
图8是本发明设计的激光雷达与旋转惯导融合的SLAM算法系统框架图。
具体实施方式
下面结合附图对本发明的技术方案做进一步的详细说明:
本技术领域技术人员可以理解的是,除非另外定义,这里使用的所有术语(包括技术术语和科学术语)具有与本发明所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是,诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中的意义一致的意义,并且除非像这里一样定义,不会用理想化或过于正式的含义来解释。
本发明提出一种激光雷达与旋转惯导一体化构架与信息融合的SLAM方法,所述方法包括激光雷达与旋转惯导信息融合的SLAM算法总体框架,基于递归小波神经网络(RWNN)的惯性导航系统动对准方案,一种简化的激光惯性里程计(LIO)模型。
如图1所示,本发明提出了一种激光雷达与旋转惯导一体化构架与信息融合的SLAM方法,参照图8所示,总体框架主要包括惯导对准、特征提取、激光惯性里程计LIO和建图三个主要模块,具体流程为:首先在惯导对准模块对IMU进行误差修正,并输出修正后的惯导系统姿态和惯性信息,特征提取模块利用修正后的IMU数据进行状态更新,通过IMU数据计算激光帧之间的平移与旋转,消除原始点云中的运动畸变,从中提取稳定的边缘与平面特征。LIO模块完成系统在全局坐标系下的位姿以及未失真的特征输出,由状态递推子模块和更新子模块组成,进行迭代卡尔曼滤波,输出初始里程以及未失真的特征。建图模块步骤用全局地图改进初始里程,输出新的里程,然后使用新的特征更新地图。
在惯导系统动基座对准部分,本发明设计了一种基于递归小波神经网络RWNN的惯性导航系统动对准方案,利用基于RWNN的观测器使系统的输出与参考值之间的偏差最小化。其中,基于RWNN的近似算法部分,所采用的RWNN网络主要包含输入层,递归小波层,产生层以及输出层四层结构,具体结构图如图2所示。首先将输入的传感器数据与最新状态向量归一化,使其大小在[0,1]范围内;之后在递归小波层中与母小波推导得到的激活函数进行向量积计算;再进行乘积操作最后求和可以得到RWNN的最终输出。该方案能有效提高惯导系统在长时间运行时的导航精度以及可靠性。
在激光惯性里程计LIO,本发明提出了一种简化的LIO模块,主要包括状态递推子模块和更新子模块,其流程结构图如图3所示。首先,通过惯导系统基座动对准得到的姿态惯性信息进行状态递推;将误差状态代入先验状态可以求解最终观测状态,并在随后的状态更新过程中,根据IMU的测量值,递推得到误差状态、误差状态协方差矩阵和先验状态,再据此进一步进行状态更新,最后完成全局位姿的更新。本方案中使用的LIO模型在定位精度与运算速度上拥有更好的性能。
作为本发明的一个实施例,所述激光雷达与旋转惯导一体化构架与信息融合的SLAM方法的硬件组成是将激光发射器与IMU安装于一个旋转平台上,构成激光雷达与旋转惯导的一体化装置。该装置工作时,旋转平台以10Hz频率旋转,数据与算法处理计算机接收激光发射器与IMU的测量数据,进行导航解算。算法总体框架如图7所示。
进一步地,所述基于RWNN的惯性导航系统动对准方案,其中基于RWNN的观测器系统动力方程为:
其中,和分别表示估计状态向量与估计输出向量。使用估计状态向量以及传感器输出向量u作为RWNN的输入,可以得到不确定向量δu的近似值。在这种近似方法中,τ是输出的权重向量,Ψw表示小波向量,以及分别表示输入反馈权重、小波的缩放和平移量。观测器的增益由L表示,并且满足矩阵为Hurwitz矩阵。采用表示RWNN的近似值。
基于RWNN的近似方法部分,所采用的RWNN网络主要包含输入层,递归小波层,产生层以及输出层四层结构。算法中母小波为Mexican-hat小波形式,如下所示:
式中,μ(s)ε[0,1]是标准化的输入向量,而||μ(s)||2=μT(s)μ(s)。
首先该算法将输入的传感器输出数据与最新状态向量归一化在[0,1]范围内,归一过程如下:
之后在递归小波层中,每个输入信号(μi)都与j索引指定的三个激活函数进行向量积计算。此激活函数是根据公式(2)的母小波推导得到的,具体过程如下:
σd,t(μ(s))=20.5dσ(2dμ(s)-t) (4)
在产生层中,每一个节点在小波层由Π函数表示,乘以来自第二层的输入信号,如下所示:
最后,根据公式(8)计算RWNN的最终输出。
进一步地,所述简化的激光惯性里程计(LIO)模型中,其状态方程如式(9)、(10)所示:
其中,表示相对于的位姿。表示描述从到的相对转换的局部状态。是相对于的位置,是描述从到旋转的单位四元数。和表示从到的平移和旋转。是相对于的速度。ba是加速度偏置,bg是陀螺仪偏置。(用表示)是局部重力。此处的ba、bg经过惯导对准与误差校正,其数量级已足够小,在建模过程中可以略去,从而减低ESKF的维度,提高滤波器运算效率,如式(11)所示:
δx=[δp,δv,δθ,δg] (12)
其中δθ是3DOF姿态误差角。
δxj+1=δxj+Δxj (16)
每次更新完成后,根据式(17)进行状态合成更新全局位姿,完成LIO模块的任务。
以下具体实例可以看出本发明在实际应用中的效果。
将旋转惯导与激光雷达安装于载体上并做好外参标定,运行算法的计算机性能如下:2.8GHz8核CPU,16G内存。所有方法均采用C++实现,并使用Linux中的机器人操作系统(ROS)执行。本发明提出的算法对比对象为未做惯导对准的激光惯性SLAM算法、使用卡尔曼滤波和使用强跟踪滤波的激光惯性融合SLAM算法,以此来说明加入惯导系统动对准算法后对激光惯性SLAM算法的性能提升,以及本发明的对准算法相比于另外两种对准算法的优越性。
为验证本算法定位与建图的性能,选择在图4所示场景进行实验。本实验以RTK的定位结果(在图4中以红线标出)作为标准轨迹,对比各类算法的定位与建图效果,各算法解算出的运动轨迹如图5所示。由图5可以看出,未对IMU进行对准的LINS算法的定位信息在第一个转弯处已经出现一定的漂移,到最后定位误差达到了10m以上;而使用基于卡尔曼滤波的对准算法由于对IMU做了对准处理,惯性信息精度有所提升,但长距离运动后,仍然不免出现了位姿的漂移;使用基于强跟踪滤波的对准算法在定位结果上要更加优于常规卡尔曼滤波,但在第三次转弯后,对姿态的估计出现了较大误差,最终影响到定位结果的准确性;而本发明采用的对准方法,相比于强跟踪滤波与常规卡尔曼滤波,拥有更快的收敛速度和更精确的零偏估计,有效的提高了惯导系统姿态精度以及惯性数据的测量精度,从而提升了LIO模块的定位精度,与此同时,建图效果也随之提升。图6展示了LINS与本文算法的建图结果。在图6的a)中,标出部分为LINS算法由于IMU误差的累积,最终的定位结果并未回到起点,从而导致建图出现重影的部分。而本发明的方法由于会对惯导不断进行对准,并修正误差,所以位姿漂移较小,能够达到较高的建图精度,建图结果并未出现重影,如图6的b)所示。
本实施例仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明保护范围之内。
Claims (4)
1.一种激光雷达与旋转惯导一体化构架与信息融合的SLAM方法,其特征在于,包括:
(1)惯导对准:利用递归小波神经网络RWNN模型处理融合惯性传感器IMU数据,进行惯导系统动基座对准,对IMU误差进行修正,并输出修正后的惯导系统姿态和惯性信息;
(2)特征提取:使用修正后的惯性信息,计算激光帧之间的平移与旋转,消除原始点云中的运动畸变,从中提取稳定的边缘与平面特征,通过特征匹配计算两帧激光数据间的位姿变换;
(3)采用激光惯性里程计LIO模型进行导航解算:使用修正后的惯性信息进行惯性导航解算,作为滤波器估计值,再利用激光雷达的位姿解算结果作为滤波器的观测值,进行迭代卡尔曼滤波,输出系统在全局坐标系下的位姿以及未失真的特征;
(4)建图:采用基于全局地图的匹配,输出修正后的位姿,然后使用新的特征更新三维点云地图。
2.根据权利要求1所述的方法,其特征在于,RWNN模型使系统的输出与参考值之间的偏差最小,系统动力学公式如下:
其中,和分别表示估计状态向量与估计输出向量,使用估计状态向量以及传感器输出向量u作为RWNN的输入,得到不确定向量δu的近似值,τ是输出的权重向量,Ψw表示小波向量,以及分别表示输入反馈权重、小波的缩放和平移量,观测器的增益由L表示,并且满足矩阵为Hurwitz矩阵;采用表示RWNN的近似值,动态模拟状态估计误差量和输出误差量,如公式(2)所示:
其中,τ*TΨ(δx,u,ζ*,t*,d*)+ε是λ(δx,u)的理想近似集,ε表示有界近似误差值,||ε||≤εm且εm为正实数。
3.根据权利要求1所述的方法,其特征在于,RWNN模型所采用的RWNN网络包含输入层,递归小波层,产生层以及输入层四层结构;算法中母小波为Mexican-hat小波形式,如下所示:
式中,μ(s)ε[0,1]是标准化的输入向量,而||μ(s)||2=μT(s)μ(s);
首先该算法将输入的传感器输出数据与最新状态向量归一化在[0,1]范围内,归一过程如下:
接着在递归小波层中,每个输入信号(μi)都与j索引指定的三个激活函数进行向量积计算;此激活函数是根据公式(4)的母小波推导得到的,具体过程如下:
σd,t(μ(s))=20.5dσ(2dμ(s)-t) (6)
其中,d和t分别表示小波函数的缩放和平移量;
在产生层中,每一个节点在小波层由Π函数表示,乘以来自第二层的输入信号,如下所示:
最后,根据公式(10)计算RWNN的最终输出
4.根据权利要求1所述的方法,其特征在于,激光惯性里程计LIO模型包括状态递推子模块和更新子模块,该模块的状态方程如式(11)、(12)所示:
其中,表示相对于的位姿,表示描述从到的相对转换的局部状态,是相对于的位置,是描述从到旋转的单位四元数,和表示从到的平移和旋转,是相对于的速度,ba是加速度偏置,bg是陀螺仪偏置,是局部重力用表示;在建模过程中略去ba、bg,如式(13)所示:
δx=[δp,δv,δθ,δg] (14)
其中δθ是3DOF姿态误差角;
δxj+1=δxj+Δxj (18)
每次更新完成后,根据式(14)进行状态合成更新全局位姿,完成LIO模块的任务
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111257759.4A CN114018254B (zh) | 2021-10-27 | 2021-10-27 | 一种激光雷达与旋转惯导一体化构架与信息融合的slam方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111257759.4A CN114018254B (zh) | 2021-10-27 | 2021-10-27 | 一种激光雷达与旋转惯导一体化构架与信息融合的slam方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114018254A true CN114018254A (zh) | 2022-02-08 |
CN114018254B CN114018254B (zh) | 2024-03-12 |
Family
ID=80058277
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111257759.4A Active CN114018254B (zh) | 2021-10-27 | 2021-10-27 | 一种激光雷达与旋转惯导一体化构架与信息融合的slam方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114018254B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114199240A (zh) * | 2022-02-18 | 2022-03-18 | 武汉理工大学 | 无gps信号下二维码、激光雷达与imu融合定位系统及方法 |
CN116908810A (zh) * | 2023-09-12 | 2023-10-20 | 天津大学四川创新研究院 | 一种无人机搭载激光雷达测量建筑土方的方法和系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110779521A (zh) * | 2019-11-12 | 2020-02-11 | 成都中科微信息技术研究院有限公司 | 一种多源融合的高精度定位方法与装置 |
CN111811506A (zh) * | 2020-09-15 | 2020-10-23 | 中国人民解放军国防科技大学 | 视觉/惯性里程计组合导航方法、电子设备及存储介质 |
CN112923933A (zh) * | 2019-12-06 | 2021-06-08 | 北理慧动(常熟)车辆科技有限公司 | 一种激光雷达slam算法与惯导融合定位的方法 |
CN113066105A (zh) * | 2021-04-02 | 2021-07-02 | 北京理工大学 | 激光雷达和惯性测量单元融合的定位与建图方法及系统 |
-
2021
- 2021-10-27 CN CN202111257759.4A patent/CN114018254B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110779521A (zh) * | 2019-11-12 | 2020-02-11 | 成都中科微信息技术研究院有限公司 | 一种多源融合的高精度定位方法与装置 |
CN112923933A (zh) * | 2019-12-06 | 2021-06-08 | 北理慧动(常熟)车辆科技有限公司 | 一种激光雷达slam算法与惯导融合定位的方法 |
CN111811506A (zh) * | 2020-09-15 | 2020-10-23 | 中国人民解放军国防科技大学 | 视觉/惯性里程计组合导航方法、电子设备及存储介质 |
CN113066105A (zh) * | 2021-04-02 | 2021-07-02 | 北京理工大学 | 激光雷达和惯性测量单元融合的定位与建图方法及系统 |
Non-Patent Citations (1)
Title |
---|
李文豪: "基于ESKF与图优化的轻量级多传感器融合SLAM系统", 《科学技术创新》, pages 15 - 18 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114199240A (zh) * | 2022-02-18 | 2022-03-18 | 武汉理工大学 | 无gps信号下二维码、激光雷达与imu融合定位系统及方法 |
CN116908810A (zh) * | 2023-09-12 | 2023-10-20 | 天津大学四川创新研究院 | 一种无人机搭载激光雷达测量建筑土方的方法和系统 |
CN116908810B (zh) * | 2023-09-12 | 2023-12-12 | 天津大学四川创新研究院 | 一种无人机搭载激光雷达测量建筑土方的方法和系统 |
Also Published As
Publication number | Publication date |
---|---|
CN114018254B (zh) | 2024-03-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111426318B (zh) | 基于四元数-扩展卡尔曼滤波的低成本ahrs航向角补偿方法 | |
CN110243358B (zh) | 多源融合的无人车室内外定位方法及系统 | |
Tardif et al. | A new approach to vision-aided inertial navigation | |
CN102506868B (zh) | 基于联邦滤波的sins/smans/trns组合导航方法及系统 | |
US9766074B2 (en) | Vision-aided inertial navigation | |
CN111288989B (zh) | 一种小型无人机视觉定位方法 | |
CN112649016A (zh) | 一种基于点线初始化的视觉惯性里程计方法 | |
CN109506660B (zh) | 一种用于仿生导航的姿态最优化解算方法 | |
CN114018254A (zh) | 一种激光雷达与旋转惯导一体化构架与信息融合的slam方法 | |
CN112146655B (zh) | 一种BeiDou/SINS紧组合导航系统弹性模型设计方法 | |
CN111189442B (zh) | 基于cepf的无人机多源导航信息状态预测方法 | |
CN114001733A (zh) | 一种基于地图的一致性高效视觉惯性定位算法 | |
CN113551665A (zh) | 一种用于运动载体的高动态运动状态感知系统及感知方法 | |
CN111238469A (zh) | 一种基于惯性/数据链的无人机编队相对导航方法 | |
CN114964276A (zh) | 一种融合惯导的动态视觉slam方法 | |
CN114690229A (zh) | 一种融合gps的移动机器人视觉惯性导航方法 | |
WO2022057350A1 (zh) | 一种基于非线性积分补偿的组合运动测量系统的惯性预积分方法 | |
CN117387604A (zh) | 基于4d毫米波雷达和imu融合的定位与建图方法及系统 | |
CN115930948A (zh) | 一种果园机器人融合定位方法 | |
Emran et al. | A cascaded approach for quadrotor's attitude estimation | |
CN116482735A (zh) | 一种受限空间内外高精度定位方法 | |
CN116295342A (zh) | 一种用于飞行器勘测的多传感状态估计器 | |
CN113503872B (zh) | 一种基于相机与消费级imu融合的低速无人车定位方法 | |
CN115014321A (zh) | 一种基于自适应鲁棒滤波的仿生偏振多源融合定向方法 | |
CN115479605A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |