CN109186601A - 一种基于自适应无迹卡尔曼滤波的激光slam算法 - Google Patents
一种基于自适应无迹卡尔曼滤波的激光slam算法 Download PDFInfo
- Publication number
- CN109186601A CN109186601A CN201810730915.6A CN201810730915A CN109186601A CN 109186601 A CN109186601 A CN 109186601A CN 201810730915 A CN201810730915 A CN 201810730915A CN 109186601 A CN109186601 A CN 109186601A
- Authority
- CN
- China
- Prior art keywords
- laser
- pose
- kalman filtering
- adaptive
- unscented kalman
- 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/20—Instruments for performing navigational calculations
-
- 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/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于自适应无迹卡尔曼滤波的激光SLAM算法。该算法为:首先利用Hector SLAM算法中的匹配方法,基于激光束末端与已知地图的匹配优化实现定位,读取激光数据并滤波转换,得到激光预估位姿;再利用无迹卡尔曼滤波算法,对非线性系统,融合激光预估位姿数据和里程计推算位姿数据,作为实际估计位姿;最后计算自适应向量,更新测量噪声协方差矩阵,使用自适应无迹卡尔曼滤波算法,对非线性系统进行滤波处理。本发明能够在仅依靠激光数据的情况下,得到较高的定位和构图精度,避免了局部极值,减少或消除了激光扫描到的干扰数据,解决了实际系统噪声或量测噪声特性未知或变化的问题,改善了非线性系统的估计效果,提高了定位精度。
Description
技术领域
本发明属于SLAM导航定位算法技术领域,特别是一种基于自适应无迹卡尔曼滤波的激光SLAM算法。
背景技术
即时定位与地图构建(SLAM)技术于1986年的IEEE机器人与自动化会议正式提出,经过曲折而漫长的探索,SLAM技术的发展逐渐成熟。近年来,随着优化理论的引入,SLAM技术进入了新的高速发展期。2011年Stefan Kohlbrecher,Oskar von Stryk等人提出了一种基于优化理论的Hector SLAM算法,Hector SLAM是一款高效快速的在线SLAM算法,在仅依靠激光数据的情况下,也能得到较高的定位和构图精度。但Hector SLAM算法在长廊等特征雷同的环境仍然无法得到准确的定位。此外,激光定位有可能扫描到行人或装饰等干扰特征,此时单纯依靠激光容易产生错误的定位。因此通过卡尔曼滤波算法,融合激光数据与里程计数据,可以消除或减少这些缺陷。
标准的卡尔曼滤波是针对线性系统提出的,但实际机器人系统往往是较为复杂的非线性系统。针对非线性系统,可以使用扩展卡尔曼滤波(EKF)或者无迹卡尔曼滤波(UKF)进行融合估计。前者对非线性部分进行一阶泰勒展开以完成线性化,但对于高阶部分难以忽略,或者求导困难的系统则难以适用。后者则通过无迹变换(UT)来近似得到变量经非线性变换后的概率分布,即对一个随机变量按分布进行sigma点采样,对这些点进行非线性变换,并用得到的结果描述变量非线性变换后的变量的分布。
无迹卡尔曼滤波的最优估计建立在系统噪声和量测噪声特性已知的基础上,而这一点在现实中往往难以满足,系统噪声和量测噪声的统计特性通常未知,甚至可能是变化的。综上,现有技术存在的问题是:实际中的系统噪声和量测噪声的统计特性通常未知,甚至可能是变化的,往往导致陷入局部极值的结果,激光扫描到的干扰数据较多,使最终的滤波结果不理想,定位精度差。
发明内容
本发明的目的在于提供一种基于自适应无迹卡尔曼滤波的激光SLAM算法,能够在线估计系统噪声或者量测噪声,使得非线性系统能得到更好的估计效果。
实现本发明目的的技术解决方案为:一种基于自适应无迹卡尔曼滤波的激光SLAM算法,包括以下步骤:
步骤1、利用Hector SLAM算法,基于激光束末端与已知地图的匹配优化实现定位,读取激光数据,再根据激光传感器坐标系与机器人坐标系的关系,求出机器人在全局坐标中的位姿;
步骤2、利用无迹卡尔曼滤波算法,在非线性系统中,融合激光预估位姿数据和里程计推算位姿数据,作为实际估计位姿;
步骤3、计算自适应向量,更新测量噪声协方差矩阵,然后使用自适应无迹卡尔曼滤波算法,对非线性系统进行滤波处理。
进一步地,步骤1所述的利用Hector SLAM算法,基于激光束末端与已知地图的匹配优化实现定位,读取激光数据,再根据激光传感器坐标系与机器人坐标系的关系,求出机器人在全局坐标中的位姿,具体如下:
步骤1.1、利用Hector SLAM算法,基于激光束末端与已知地图的匹配优化实现定位,将定位问题转换为一个优化问题:在全局坐标系中寻找一个位姿ξ=[x,y,θ]T,使得最小,再根据激光传感器坐标系与机器人坐标系的关系,求出机器人在全局坐标中的位姿;其中x、y是点ξ的横、纵坐标,θ是该点的位姿角度;
步骤1.2、读取激光数据,Si(ξ)表示激光中心在位姿ξ时第i束激光末端在全局坐标系中的位置;设第i束激光末端在激光传感器坐标系中的位置si=[six,siy]T,则:
其中,M(Si(ξ))表示该点的占据概率,ξk、ξk-1分别是k和k-1时刻点ξ的位置;
步骤1.3、根据激光传感器坐标系与机器人坐标系的关系,求出机器人在全局坐标中的位姿。
进一步地,步骤2所述的利用无迹卡尔曼滤波算法,在非线性系统中,融合激光预估位姿数据和里程计推算位姿数据,作为实际估计位姿,具体如下:
步骤2.1、初始化状态量和协方差矩阵:
其中,为估计的状态初值,x0为估计过程中的状态变量,P0为估计的协方差矩阵初值;
步骤2.2、将状态量进行Sigma点采样,并做无迹变换:
其中,即k-1时刻的第i个采样点;λ=α2×(n+κ)-n,n为变量维数,α为决定Sigma点分布状态的变量,调节α使高阶项影响最小,取值范围为0~1;κ取值范围为3~n;L为协方差矩阵P的cholesky分解,P=L×LT,为估计状态k-1时刻的值;
步骤2.3、由时间传播方程得出状态量的时间更新,即依据运动模型,根据上一时刻的状态量和协方差矩阵预估当前时刻的状态:
其中:分别为计算状态量时和计算协方差矩阵时的第i个样本的权重,β取值为2;为第i个样本的预估观测值,zk为计算k时刻的预估观测值,为加权计算的k时刻前的预估观测值,f为非线性函数,是分别将的每一个列向量通过f变换得到的每一个列向量,为估计状态k时刻前的值,为点x在k时刻前的协方差矩阵,Qk系统噪声方差矩阵;类似于变换;Wi (m)是均值的权重,Wi (c)是协方差的权重;
步骤2.4、测量更新方程,根据观测到的传感器数据对预估值进行更新,从而得到最优状态量估计值:
其中,Rk为观测噪声方差矩阵,Pz,k为k时刻的预估协方差矩阵,Pxz,k为x点在k时刻的预估协方差矩阵,K是修正系数。
进一步地,步骤3所述的计算自适应向量,更新测量噪声协方差矩阵,然后使用自适应无迹卡尔曼滤波算法,对非线性系统进行滤波处理,具体如下:
步骤3.1、计算自适应向量:
其中,Dk为n×1的加权系数向量,ones(n,1)表示n×1的全一列向量,B为n×1的遗忘因子向量,Bk表示B中各元素k次方得到的向量;
步骤3.2、更新噪声协方差矩阵:
其中,diag(A)表示取向量A或方阵A的对角向量构成对角矩阵,abs(B)表示对向量B或方阵B内元素取绝对值,为加权的观测噪声方差矩阵,Pz,k-1为k-1时刻的预估协方差矩阵;
步骤3.3、更新测量方程,使用自适应无迹卡尔曼滤波算法,对非线性系统进行滤波。
进一步地,设定系统噪声已知,使用Sage-Husa自适应算法根据系统噪声对量测噪声进行估计。
本发明与现有技术相比,其显著优点为:(1)能够在仅依靠激光数据的情况下,得到较高的定位和构图精度;(2)能够避免陷入局部极值的情况,消除或减少激光扫描到的干扰数据;(3)解决了实际系统噪声或量测噪声特性未知或变化的问题,使非线性系统能得到更好的估计效果,提高了定位的精度。
附图说明
图1为本发明基于自适应无迹卡尔曼滤波的激光SLAM算法的流程示意图。
图2为本发明中的自适应无迹卡尔曼滤波的流程示意图。
具体实施方式
下面结合附图和实施例来详细说明本发明。
如图1所示,本发明基于自适应无迹卡尔曼滤波的激光SLAM算法,包括如下步骤:
步骤1、利用Hector SLAM算法,基于激光束末端与已知地图的匹配优化实现定位,读取激光数据,再根据激光传感器坐标系与机器人坐标系的关系,求出机器人在全局坐标中的位姿;
步骤2、利用无迹卡尔曼滤波算法,在非线性系统中,融合激光预估位姿数据和里程计推算位姿数据,作为实际估计位姿;
步骤3、计算自适应向量,更新测量噪声协方差矩阵,然后使用自适应无迹卡尔曼滤波算法,对非线性系统进行滤波处理。
优选的,步骤1所述的利用Hector SLAM算法,基于激光束末端与已知地图的匹配优化实现定位,读取激光数据,再根据激光传感器坐标系与机器人坐标系的关系,求出机器人在全局坐标中的位姿,具体如下:
步骤1.1、利用Hector SLAM算法,基于激光束末端与已知地图的匹配优化实现定位,将定位问题转换为一个优化问题:在全局坐标系中寻找一个位姿ξ=[x,y,θ]T,使得最小,再根据激光传感器坐标系与机器人坐标系的关系,求出机器人在全局坐标中的位姿;其中x、y是点ξ的横、纵坐标,θ是该点的位姿角度;
步骤1.2、读取激光数据,Si(ξ)表示激光中心在位姿ξ时第i束激光末端在全局坐标系中的位置;设第i束激光末端在激光传感器坐标系中的位置si=[six,siy]T,则:
其中,M(Si(ξ))表示该点的占据概率,ξk、ξk-1分别是k和k-1时刻点ξ的位置;
步骤1.3、根据激光传感器坐标系与机器人坐标系的关系,求出机器人在全局坐标中的位姿。
优选的,步骤2所述的利用无迹卡尔曼滤波算法,在非线性系统中,融合激光预估位姿数据和里程计推算位姿数据,作为实际估计位姿,具体如下:
步骤2.1、初始化状态量和协方差矩阵:
其中,为估计的状态初值,x0为估计过程中的状态变量,P0为估计的协方差矩阵初值;
步骤2.2、将状态量进行Sigma点采样,并做无迹变换:
其中,即k-1时刻的第i个采样点;λ=α2×(n+κ)-n,n为变量维数,α为决定Sigma点分布状态的变量,调节α使高阶项影响最小,取值范围为0~1;κ取值范围为3~n;L为协方差矩阵P的cholesky分解,P=L×LT,为估计状态k-1时刻的值;
步骤2.3、由时间传播方程得出状态量的时间更新,即依据运动模型,根据上一时刻的状态量和协方差矩阵预估当前时刻的状态:
其中:分别为计算状态量时和计算协方差矩阵时的第i个样本的权重,β取值为2;为第i个样本的预估观测值,zk为计算k时刻的预估观测值,为加权计算的k时刻前的预估观测值,f为非线性函数,是分别将的每一个列向量通过f变换得到的每一个列向量,为估计状态k时刻前的值,为点x在k时刻前的协方差矩阵,Qk系统噪声方差矩阵;类似于变换;Wi (m)是均值的权重,Wi (c)是协方差的权重;
步骤2.4、测量更新方程,根据观测到的传感器数据对预估值进行更新,从而得到最优状态量估计值:
其中,Rk为观测噪声方差矩阵,Pz,k为k时刻的预估协方差矩阵,Pxz,k为x点在k时刻的预估协方差矩阵,K是修正系数。
优选的,步骤3所述的计算自适应向量,更新测量噪声协方差矩阵,然后使用自适应无迹卡尔曼滤波算法,对非线性系统进行滤波处理,具体如下:
步骤3.1、计算自适应向量:
其中,Dk为n×1的加权系数向量,ones(n,1)表示n×1的全一列向量,B为n×1的遗忘因子向量,Bk表示B中各元素k次方得到的向量;
步骤3.2、更新噪声协方差矩阵:
其中,diag(A)表示取向量A或方阵A的对角向量构成对角矩阵,abs(B)表示对向量B或方阵B内元素取绝对值,为加权的观测噪声方差矩阵,Pz,k-1为k-1时刻的预估协方差矩阵;
步骤3.3、更新测量方程,使用自适应无迹卡尔曼滤波算法,对非线性系统进行滤波。
优选的,Sage-Husa自适应算法只能在系统噪声和量测噪声已知其一的情况下,估计另一个,由于机器人系统运动学模型和运动环境简单可靠,系统噪声相对稳定,因此设定系统噪声为已知噪声。
优选的,在完成步骤3之后,即在步骤2中加入自适应向量后,只需每次采样重复步骤2.2~步骤2.4即可在线得到最优的估计状态。
综上所述,本发明能够在仅依靠激光数据的情况下,得到较高的定位和构图精度;并且能够避免陷入局部极值的情况,消除或减少激光扫描到的干扰数据;最终解决了实际系统噪声或量测噪声特性未知或变化的问题,使非线性系统能得到更好的估计效果,提高了定位的精度。
Claims (5)
1.一种基于自适应无迹卡尔曼滤波的激光SLAM算法,其特征在于,包括以下步骤:
步骤1、利用Hector SLAM算法,基于激光束末端与已知地图的匹配优化实现定位,读取激光数据,再根据激光传感器坐标系与机器人坐标系的关系,求出机器人在全局坐标中的位姿;
步骤2、利用无迹卡尔曼滤波算法,在非线性系统中,融合激光预估位姿数据和里程计推算位姿数据,作为实际估计位姿;
步骤3、计算自适应向量,更新测量噪声协方差矩阵,然后使用自适应无迹卡尔曼滤波算法,对非线性系统进行滤波处理。
2.根据权利要求1所述的基于自适应无迹卡尔曼滤波的激光SLAM算法,其特征在于,步骤1所述的利用Hector SLAM算法,基于激光束末端与已知地图的匹配优化实现定位,读取激光数据,再根据激光传感器坐标系与机器人坐标系的关系,求出机器人在全局坐标中的位姿,具体如下:
步骤1.1、利用Hector SLAM算法,基于激光束末端与已知地图的匹配优化实现定位,将定位问题转换为一个优化问题:在全局坐标系中寻找一个位姿ξ=[x,y,θ]T,使得最小,再根据激光传感器坐标系与机器人坐标系的关系,求出机器人在全局坐标中的位姿;其中x、y是点ξ的横、纵坐标,θ是该点的位姿角度;
步骤1.2、读取激光数据,Si(ξ)表示激光中心在位姿ξ时第i束激光末端在全局坐标系中的位置;设第i束激光末端在激光传感器坐标系中的位置si=[six,siy]T,则:
其中,M(Si(ξ))表示该点的占据概率,ξk、ξk-1分别是k和k-1时刻点ξ的位置;
步骤1.3、根据激光传感器坐标系与机器人坐标系的关系,求出机器人在全局坐标中的位姿。
3.根据权利要求1所述的基于自适应无迹卡尔曼滤波的激光SLAM算法,其特征在于,步骤2所述的利用无迹卡尔曼滤波算法,在非线性系统中,融合激光预估位姿数据和里程计推算位姿数据,作为实际估计位姿,具体如下:
步骤2.1、初始化状态量和协方差矩阵:
其中,为估计的状态初值,x0为估计过程中的状态变量,P0为估计的协方差矩阵初值;
步骤2.2、将状态量进行Sigma点采样,并做无迹变换:
其中,即k-1时刻的第i个采样点;λ=α2×(n+κ)-n,n为变量维数,α为决定Sigma点分布状态的变量,调节α使高阶项影响最小,取值范围为0~1;κ取值范围为3~n;L为协方差矩阵P的cholesky分解,P=L×LT,为估计状态k-1时刻的值;
步骤2.3、由时间传播方程得出状态量的时间更新,即依据运动模型,根据上一时刻的状态量和协方差矩阵预估当前时刻的状态:
其中:分别为计算状态量时和计算协方差矩阵时的第i个样本的权重,β取值为2;为第i个样本的预估观测值,zk为计算k时刻的预估观测值,为加权计算的k时刻前的预估观测值,f为非线性函数,是分别将的每一个列向量通过f变换得到的每一个列向量,为估计状态k时刻前的值,为点x在k时刻前的协方差矩阵,Qk系统噪声方差矩阵;类似于变换;Wi (m)是均值的权重,Wi (c)是协方差的权重;
步骤2.4、测量更新方程,根据观测到的传感器数据对预估值进行更新,从而得到最优状态量估计值:
其中,Rk为观测噪声方差矩阵,Pz,k为k时刻的预估协方差矩阵,Pxz,k为x点在k时刻的预估协方差矩阵,K是修正系数。
4.根据权利要求1所述的基于自适应无迹卡尔曼滤波的激光SLAM算法,其特征在于,步骤3所述的计算自适应向量,更新测量噪声协方差矩阵,然后使用自适应无迹卡尔曼滤波算法,对非线性系统进行滤波处理,具体如下:
步骤3.1、计算自适应向量:
其中,Dk为n×1的加权系数向量,ones(n,1)表示n×1的全一列向量,B为n×1的遗忘因子向量,Bk表示B中各元素k次方得到的向量;
步骤3.2、更新噪声协方差矩阵:
其中,diag(A)表示取向量A或方阵A的对角向量构成对角矩阵,abs(B)表示对向量B或方阵B内元素取绝对值,为加权的观测噪声方差矩阵,Pz,k-1为k-1时刻的预估协方差矩阵;
步骤3.3、更新测量方程,使用自适应无迹卡尔曼滤波算法,对非线性系统进行滤波。
5.根据权利要求4所述的基于自适应无迹卡尔曼滤波的激光SLAM算法,其特征在于,设定系统噪声已知,使用Sage-Husa自适应算法根据系统噪声对量测噪声进行估计。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810730915.6A CN109186601A (zh) | 2018-07-05 | 2018-07-05 | 一种基于自适应无迹卡尔曼滤波的激光slam算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810730915.6A CN109186601A (zh) | 2018-07-05 | 2018-07-05 | 一种基于自适应无迹卡尔曼滤波的激光slam算法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109186601A true CN109186601A (zh) | 2019-01-11 |
Family
ID=64948890
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810730915.6A Pending CN109186601A (zh) | 2018-07-05 | 2018-07-05 | 一种基于自适应无迹卡尔曼滤波的激光slam算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109186601A (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109919233A (zh) * | 2019-03-12 | 2019-06-21 | 西北工业大学 | 一种基于数据融合的跟踪滤波方法 |
CN110233667A (zh) * | 2019-06-05 | 2019-09-13 | 华南理工大学 | 基于均值漂移与无迹卡尔曼滤波的vlc动态定位方法及系统 |
CN110456785A (zh) * | 2019-06-28 | 2019-11-15 | 广东工业大学 | 一种基于履带机器人的室内自主探索方法 |
CN111044054A (zh) * | 2020-01-06 | 2020-04-21 | 哈尔滨工业大学 | 一种基于单目slam算法利用卡尔曼滤波进行位姿优化的方法 |
CN111578926A (zh) * | 2020-04-16 | 2020-08-25 | 天津大学 | 一种基于自动驾驶平台的地图生成与导航避障的方法 |
WO2020216342A1 (zh) * | 2019-04-25 | 2020-10-29 | 北京嘀嘀无限科技发展有限公司 | 一种位姿数据处理方法和系统 |
CN112444246A (zh) * | 2020-11-06 | 2021-03-05 | 北京易达恩能科技有限公司 | 高精度的数字孪生场景中的激光融合定位方法 |
CN112581616A (zh) * | 2020-12-18 | 2021-03-30 | 杭州电子科技大学 | 基于序贯分块滤波的最近邻ukf-slam方法 |
CN112947481A (zh) * | 2021-03-24 | 2021-06-11 | 南京理工大学泰州科技学院 | 一种家庭服务机器人自主定位控制方法 |
CN113252023A (zh) * | 2021-04-26 | 2021-08-13 | 深圳市优必选科技股份有限公司 | 基于里程计的定位方法、装置及设备 |
CN113280808A (zh) * | 2021-05-25 | 2021-08-20 | 上海大学 | 一种移动机器人定位精度提升方法及系统 |
CN113799127A (zh) * | 2021-09-15 | 2021-12-17 | 华南理工大学 | 光学双目定位系统下六自由度机械臂无标定位姿定位方法 |
CN115079227A (zh) * | 2022-07-26 | 2022-09-20 | 武汉优米捷光电子制造有限责任公司 | 基于改进无迹卡尔曼滤波的自旋弹组合导航方法 |
CN115435775A (zh) * | 2022-09-23 | 2022-12-06 | 福州大学 | 基于拓展卡尔曼滤波的多传感器融合slam方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105606104A (zh) * | 2016-03-17 | 2016-05-25 | 北京工业大学 | 基于航向辅助分布式slam的机器人自主导航方法 |
CN105737832A (zh) * | 2016-03-22 | 2016-07-06 | 北京工业大学 | 基于全局最优数据融合的分布式slam方法 |
CN107239076A (zh) * | 2017-06-28 | 2017-10-10 | 仲训昱 | 基于虚拟扫描与测距匹配的agv激光slam方法 |
CN107463871A (zh) * | 2017-06-19 | 2017-12-12 | 南京航空航天大学 | 一种基于角特征加权的点云匹配方法 |
-
2018
- 2018-07-05 CN CN201810730915.6A patent/CN109186601A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105606104A (zh) * | 2016-03-17 | 2016-05-25 | 北京工业大学 | 基于航向辅助分布式slam的机器人自主导航方法 |
CN105737832A (zh) * | 2016-03-22 | 2016-07-06 | 北京工业大学 | 基于全局最优数据融合的分布式slam方法 |
CN107463871A (zh) * | 2017-06-19 | 2017-12-12 | 南京航空航天大学 | 一种基于角特征加权的点云匹配方法 |
CN107239076A (zh) * | 2017-06-28 | 2017-10-10 | 仲训昱 | 基于虚拟扫描与测距匹配的agv激光slam方法 |
Non-Patent Citations (2)
Title |
---|
STEFAN KOHLBRECHER等: "A flexible and scalable SLAM system with full 3D motion estimation", 《2011 IEEE INTERNATIONAL SYMPOSIUM ON SAFETY, SECURITY, AND RESCUE ROBOTICS》 * |
洪宇等: "基于自适应无迹卡尔曼的机器人室内定位算法", 《计算机测量与控制》 * |
Cited By (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109919233B (zh) * | 2019-03-12 | 2022-04-22 | 西北工业大学 | 一种基于数据融合的跟踪滤波方法 |
CN109919233A (zh) * | 2019-03-12 | 2019-06-21 | 西北工业大学 | 一种基于数据融合的跟踪滤波方法 |
WO2020216342A1 (zh) * | 2019-04-25 | 2020-10-29 | 北京嘀嘀无限科技发展有限公司 | 一种位姿数据处理方法和系统 |
CN110233667A (zh) * | 2019-06-05 | 2019-09-13 | 华南理工大学 | 基于均值漂移与无迹卡尔曼滤波的vlc动态定位方法及系统 |
CN110456785A (zh) * | 2019-06-28 | 2019-11-15 | 广东工业大学 | 一种基于履带机器人的室内自主探索方法 |
CN111044054A (zh) * | 2020-01-06 | 2020-04-21 | 哈尔滨工业大学 | 一种基于单目slam算法利用卡尔曼滤波进行位姿优化的方法 |
CN111578926A (zh) * | 2020-04-16 | 2020-08-25 | 天津大学 | 一种基于自动驾驶平台的地图生成与导航避障的方法 |
CN112444246A (zh) * | 2020-11-06 | 2021-03-05 | 北京易达恩能科技有限公司 | 高精度的数字孪生场景中的激光融合定位方法 |
CN112444246B (zh) * | 2020-11-06 | 2024-01-26 | 北京易达恩能科技有限公司 | 高精度的数字孪生场景中的激光融合定位方法 |
CN112581616A (zh) * | 2020-12-18 | 2021-03-30 | 杭州电子科技大学 | 基于序贯分块滤波的最近邻ukf-slam方法 |
CN112581616B (zh) * | 2020-12-18 | 2024-06-07 | 杭州电子科技大学 | 基于序贯分块滤波的最近邻ukf-slam方法 |
CN112947481A (zh) * | 2021-03-24 | 2021-06-11 | 南京理工大学泰州科技学院 | 一种家庭服务机器人自主定位控制方法 |
CN112947481B (zh) * | 2021-03-24 | 2022-11-15 | 南京理工大学泰州科技学院 | 一种家庭服务机器人自主定位控制方法 |
CN113252023A (zh) * | 2021-04-26 | 2021-08-13 | 深圳市优必选科技股份有限公司 | 基于里程计的定位方法、装置及设备 |
CN113280808A (zh) * | 2021-05-25 | 2021-08-20 | 上海大学 | 一种移动机器人定位精度提升方法及系统 |
CN113799127A (zh) * | 2021-09-15 | 2021-12-17 | 华南理工大学 | 光学双目定位系统下六自由度机械臂无标定位姿定位方法 |
CN113799127B (zh) * | 2021-09-15 | 2023-05-23 | 华南理工大学 | 光学双目定位系统下六自由度机械臂无标定位姿定位方法 |
CN115079227A (zh) * | 2022-07-26 | 2022-09-20 | 武汉优米捷光电子制造有限责任公司 | 基于改进无迹卡尔曼滤波的自旋弹组合导航方法 |
CN115435775A (zh) * | 2022-09-23 | 2022-12-06 | 福州大学 | 基于拓展卡尔曼滤波的多传感器融合slam方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109186601A (zh) | 一种基于自适应无迹卡尔曼滤波的激光slam算法 | |
WO2020087845A1 (zh) | 基于gpr与改进的srckf的sins初始对准方法 | |
CN109459033A (zh) | 一种多重渐消因子的机器人无迹快速同步定位与建图方法 | |
CN107255795B (zh) | 基于ekf/efir混合滤波的室内移动机器人定位方法和装置 | |
CN106772524B (zh) | 一种基于秩滤波的农业机器人组合导航信息融合方法 | |
KR100816269B1 (ko) | 언센티드 필터를 적용한 강인한 동시 위치 추정 및 지도작성 방법 | |
CN108319570B (zh) | 一种异步多传感器空时偏差联合估计与补偿方法及装置 | |
CN110231620B (zh) | 一种噪声相关系统跟踪滤波方法 | |
KR101576424B1 (ko) | 실내 측위를 위한 지자기 센서 자동 보정 방법 | |
CN114061591B (zh) | 一种基于滑动窗数据回溯的等值线匹配方法 | |
CN111964667B (zh) | 一种基于粒子滤波算法的地磁_ins组合导航方法 | |
CN110132287A (zh) | 一种基于极限学习机网络补偿的卫星高精度联合定姿方法 | |
CN109855623A (zh) | 基于Legendre多项式和BP神经网络的地磁模型在线逼近方法 | |
CN108871365A (zh) | 一种航向约束下的状态估计方法及系统 | |
Wang et al. | Pedestrian motion tracking by using inertial sensors on the smartphone | |
CN105701292B (zh) | 一种机动目标转弯角速度的解析辨识方法 | |
Yuzhen et al. | The application of adaptive extended Kalman filter in mobile robot localization | |
CN107843259B (zh) | 一种基于vckf的多机器人协同导航定位方法 | |
CN114608568A (zh) | 一种基于多传感器信息即时融合定位方法 | |
CN111756353B (zh) | 一种基于非线性融合滤波的液位仪噪声优化方法 | |
CN110736459B (zh) | 惯性量匹配对准的角形变测量误差评估方法 | |
CN109655057B (zh) | 一种六推无人机加速器测量值的滤波优化方法及其系统 | |
CN107886058B (zh) | 噪声相关的两阶段容积Kalman滤波估计方法及系统 | |
CN104931932A (zh) | 一种改进的去偏坐标转换卡尔曼滤波方法 | |
CN112683265B (zh) | 一种基于快速iss集员滤波的mimu/gps组合导航方法 |
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: 20190111 |