CN109253727A - 一种基于改进迭代容积粒子滤波算法的定位方法 - Google Patents
一种基于改进迭代容积粒子滤波算法的定位方法 Download PDFInfo
- Publication number
- CN109253727A CN109253727A CN201810650040.9A CN201810650040A CN109253727A CN 109253727 A CN109253727 A CN 109253727A CN 201810650040 A CN201810650040 A CN 201810650040A CN 109253727 A CN109253727 A CN 109253727A
- Authority
- CN
- China
- Prior art keywords
- value
- state
- covariance
- particle
- robot
- 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
- 239000002245 particle Substances 0.000 title claims abstract description 70
- 238000000034 method Methods 0.000 title claims abstract description 39
- 230000004807 localization Effects 0.000 title claims abstract description 15
- 238000001914 filtration Methods 0.000 claims abstract description 31
- 238000005070 sampling Methods 0.000 claims abstract description 9
- 238000005259 measurement Methods 0.000 claims description 36
- 230000008569 process Effects 0.000 claims description 11
- 238000009826 distribution Methods 0.000 claims description 7
- 241000239290 Araneae Species 0.000 claims description 5
- 239000011159 matrix material Substances 0.000 claims description 5
- 238000005457 optimization Methods 0.000 claims description 3
- 230000003190 augmentative effect Effects 0.000 claims 1
- 230000007704 transition Effects 0.000 claims 1
- 230000010354 integration Effects 0.000 abstract 1
- 238000012804 iterative process Methods 0.000 abstract 1
- 238000004364 calculation method Methods 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000012952 Resampling Methods 0.000 description 1
- 230000002776 aggregation Effects 0.000 description 1
- 238000004220 aggregation Methods 0.000 description 1
- 230000015556 catabolic process Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000006731 degradation reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects 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
- 230000011273 social behavior Effects 0.000 description 1
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
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)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于改进迭代容积粒子滤波算法的定位方法,该方法首先产生由多个粒子组成的粒子集,然后基于在已知环境中观测到一个或多个路标来对粒子集进行多次迭代更新,每次迭代过程进行多次状态均值的更新,但状态协方差只在对一个路标的最后一次迭代后更新一次,最后基于得到的经更新的状态均值估计值和状态协方差估计值来完成每个粒子的重要性采样,并实现所述移动机器人的定位。该算法利用容积数值积分原则估计出高斯先验的非线性转移密度,使得粒子集较为集中的分布于观测似然函数的尾部,克服了传统粒子滤波定位算法中粒子集退化的问题,使用较少的粒子即可实现对移动机器人高精度高效率的定姿、定位。
Description
技术领域
本发明涉及一种定位方法,尤其涉及一种基于改进迭代容积粒子滤波算法的定位方法。
背景技术
机器人定位技术是移动机器人利用运动信息和环境观测信息估算自身在环境中所处的位置和姿态,该技术在被广泛应用在路径规划、避障等方面,也是移动机器人自主导航研究中最基本、最重要的问题。其中基于粒子滤波的蒙特卡洛定位(Monte CarloLocalization,MCL)算法是当前学术界研究移动机器人定位问题的主流方法之一,MCL用离散粒子集来近似移动机器人位姿的后验概率分布,适应于任意系统动态、任意噪声分布系统的后验信度估计。在基于粒子滤波的蒙特卡洛定位算法中,粒子提议分布的计算是影响算法性能的关键因素之一。而算法的性能直接影响到定位的准确性和效率。
基于粒子滤波的定位算法中的粒子提议分布的计算常常用到卡尔曼滤波器技术。随着卡尔曼滤波器技术的发展,迭代扩展卡尔曼滤波和容积卡尔曼滤波相继被引入到粒子滤波定位算法中的粒子提议分布的计算中。这些算法在一定程度上克服了基于粒子滤波定位方法的粒子集退化问题,但是仍存在一些问题。例如迭代扩展卡尔曼滤波方法在处理非线性问题时,通过对非线性函数的泰勒展开式进行一阶线性化截断,忽略其余高阶项,从而将非线性问题转化为线性,但是在该过程中引入了截断误差,很可能会导致滤波发;容积卡尔曼滤波利用三阶球面-相径容积规则来近似非线性高斯滤波中的高斯积分,避免了迭代扩展卡尔曼算法对非线性函数的线性化处理,但是在量测方程为非线性函数时,基于容积卡尔曼的粒子滤波定位算法利用基于线性贝叶斯估计量的高斯近似滤波器逼近状态后验概率密度函数时,达到的效果却不理想。
发明内容
发明目的:针对现有技术的不足,本发明提出一种基于改进迭代容积粒子滤波算法的定位方法,以在确保定位准确度的同时提高定位效率。
技术方案:本发明提出的基于改进迭代容积粒子滤波算法的定位方法包括下列步骤:
(1)产生由多个粒子组成的粒子集并初始化,每一粒子包含如下参数:移动机器人的状态均值估计值、状态协方差估计值和该粒子的权重;
(2)基于先前的状态均值估计值和状态协方差估计值、运动信息、噪声控制信息及机器人运动模型来计算当前的状态均值预测值和状态协方差预测值;
(3)如果当前在已知环境中观测到一个或多个路标,针对每个路标对所述粒子集进行M次迭代更新,M为设定的整数;每次迭代的过程包括:
(3.1)基于路标的高斯密度函数、当前的状态均值预测值和状态协方差预测值来计算量测容积点集;
(3.2)将量测容积点集分解为机器人状态分量、路标状态分量和量测分量;
(3.3)基于机器人状态分量、路标状态分量、量测分量和已知的观测模型来计算转换量测容积点集;
(3.4)基于所述转换量测容积点集计算路标量测值的预测值;
(3.5)基于所述转换量测容积点集、路标量测值的预测值、机器人状态分量和当前的状态均值预测值来计算量测新息的协方差、机器人状态和量测值之间的互协方差以及卡尔曼滤波参数;
(3.6)基于量测新息的协方差、机器人状态和量测值之间的互协方差、卡尔曼滤波参数以及已知的路标的量测值完成对当前的状态均值估计值的一次更新,当前的状态协方差估计值保持不变,将更新后的当前的状态均值估计值作为下一次迭代所需的当前的状态均值预测值,将当前的状态协方差估计值作为下一次迭代所需的状态协方差预测值;
基于对当前路标进行的M次迭代后的机器人状态和量测值之间的互协方差、卡尔曼滤波参数和状态协方差预测值来更新每个粒子中的状态协方差估计值;当某一时刻观测到多个路标时,将针对当前路标进行M次迭代后最终得到的经更新的状态均值估计值和状态协方差估计值作为针对下一路标进行第一次迭代前的状态均值预测值和状态协方差预测值;
(4)基于步骤(3)中最终得到的经更新的状态均值估计值和状态协方差估计值来完成每个粒子的重要性采样,并基于采样值来更新每个粒子的权值,以实现所述移动机器人的定位。
有益效果:本发明与现有技术相比,其优点为:
1、采用多个容积点来代替传统迭代扩展卡尔曼滤波线性化截断过程,杜绝了截断误差的引入,进而提高了量测更新过程似然函数的逼近精度。同时,相比于迭代扩展卡尔曼滤波在一个滤波周期内要进行M次状态均值和状态协方差更新,本发明专利方法对状态均值进行了M次计算,而状态协方差只在最后一次迭代过程中更新,从而减小了计算量,提高了运行速率。
2、在对迭代步长因子进行优化时,本发明方法使用了蜘蛛群居算法,该算法模拟群居蜘蛛的协作行为,与大多数群智能算法不同的是,在蜘蛛群算法中搜索个体是按雌、雄性别分为两类的,寻优过程中也依照不同的搜索准则进行。该搜索模式有效避免了个体在优势群体周围的聚集,可快速搜索到迭代步长因子的最优值并保证了该值为全局最优值。
附图说明
图1是本发明的定位方法的流程图。
具体实施方式
下面结合附图对本发明的技术方案做进一步的详细说明:
如图1所示,本发明的基于改进迭代容积粒子滤波算法的定位方法包括以下步骤:
(1)根据粒子集确定机器人的位姿:产生由多个粒子组成的粒子集 并初始化,其中表示k时刻第i个粒子对机器人状态均值的估计值,表示表示k时刻第i个粒子对机器人状态协方差的估计值,表示k时刻第i个粒子的权重。每个粒子中的和的初始值可以是人为设定的。
(2)计算状态均值预测值和状态协方差预测值
首先对机器人的位姿进行增维:结合机器人的运动信息uk-1和控制噪声矩阵Q对粒子中的状态均值估计值和状态协方差估计值进行增维:
其中a和Pa分别表示增维后的机器人状态均值估计值和增维后的状态协方差估计值,Pk-1表第i个粒子k-1时刻对机器人状态协方差的估计值。增维后的机器人位姿状态满足高斯分布:N(a,Pa)。
然后产生移动机器人状态预测过程所需的2(ns+nu)个状态预测容积点
其中状态预测容积点又可分解为机器人位姿分量和控制分量 ns表示机器人位姿的维数,nu表示机器人运动控制信息uk-1的维数,j表示容积点的索引值,且
接下来,根据各状态预测容积点的位姿分量和控制分量计算机器人的状态均值预测值和状态协方差预测值
其中表示预测转换的容积点,f(·)表示机器人运动模型。
(3)多次迭代:如果当前在已知环境中观测到一个或多个路标,针对每个路标对所述粒子集进行M次迭代更新。其中,M的值可以根据需要人为设定,M的值越大,迭代更新次数越多,定位越精确,但计算量也将随之增大。
每次迭代更新的过程大致如下:
(a)对机器人状态均值预测值和状态协方差预测值进行增维
在针对索引值为m的路标进行滤波时,利用该路标的高斯密度函数对机器人的状态均值预测值和状态协方差预测值进行增维:
其中表示增维后的机器人状态均值预测值,表示增维后的状态协方差预测值,nμ表示路标的状态信息维数,nz表示路标真实观测信息的维数。
(b)产生量测容积点
根据增维后的状态均值预测值b的高斯密度N(b,Pb)计算量测容积点集
其中量测容积点又可分解为机器人状态分量路标状态分量和量测分量j*表示测量容积点的索引值,且
根据机器人状态分量路标状态分量和量测分量计算转换量测容积点集
其中h(·)表示观测模型。
再根据得到的转换量测容积点集计算路标量测值的预测值
然后分别计算量测新息,即的协方差机器人状态与量测值之间的互协方差和卡尔曼滤波增益Ks:
(c)机器人状态均值估计值的多次更新、迭代步长因子的更新和状态协方差估计值的一次更新:
首先根据步骤(b)求解出的量测新息的协方差机器人状态与量测值之间的互协方差和卡尔曼滤波增益Ks对机器人状态均值估计值进行更新:
其中l=1,...,M表示滤波过程的迭代次数,al表示迭代步长因子,表示观测到的索引值为m的路标的量测值。每次迭代过程中都使用蜘蛛群居算法对迭代步长因子al进行优化更新。假设al,t为第l次迭代滤波中第t次更新的步长因子,其更新方式为al,t=βal,t直到:
其中,
为的雅克比矩阵,为黑塞矩阵,并且0<β<1,0<γ<0.5。
在针对当前路标进行M次迭代更新后,完成机器人状态协方差估计值的更新:
当机器人某一时刻同时观测到了多个路标特征,针对当前路标进行M次迭代后得到的经更新的状态均值估计值和状态协方差估计值为针对下一路标进行第一次迭代更新前的状态均值预测值和状态协方差预测值。
(f)根据步骤(e)中经过M次迭代后获取的经更新的机器人状态均值估计值和只在最后一次迭代过程后更新获取的状态协方差估计值进行重要性采样,得到第i个粒子对应的经采样状态均值估计值
重要性采样完成后根据以下式子计算每个粒子重采样后对应的权值
然后对各个权值进行归一化,得到归一化后的权值:
最后根据每个粒子对应的经采样状态均值估计值及归一化后的权值便可以最终确定机器人当前的位姿状态sk:
应理解的是,以上所述仅为本发明的具体实施方式而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种基于改进迭代容积粒子滤波算法的定位方法,其特征在于,包括下列步骤:
(1)产生由多个粒子组成的粒子集并初始化,每一粒子包含如下参数:移动机器人的状态均值估计值、状态协方差估计值和该粒子的权重;
(2)基于先前的状态均值估计值和状态协方差估计值、运动信息、噪声控制信息及机器人运动模型来计算当前的状态均值预测值和状态协方差预测值;
(3)如果当前在已知环境中观测到一个或多个路标,针对每个路标对所述粒子集进行M次迭代更新,M为设定的整数;每次迭代更新的过程包括:
(3.1)基于路标的高斯密度函数、当前的状态均值预测值和状态协方差预测值来计算量测容积点集;
(3.2)将量测容积点集分解为机器人状态分量、路标状态分量和量测分量;
(3.3)基于机器人状态分量、路标状态分量、量测分量和已知的观测模型来计算转换量测容积点集;
(3.4)基于所述转换量测容积点集计算路标量测值的预测值;
(3.5)基于所述转换量测容积点集、路标量测值的预测值、机器人状态分量和当前的状态均值预测值来计算量测新息的协方差、机器人状态和量测值之间的互协方差以及卡尔曼滤波参数;
(3.6)基于量测新息的协方差、机器人状态和量测值之间的互协方差、卡尔曼滤波参数以及已知的路标的量测值完成对当前的状态均值估计值的一次更新,当前的状态协方差估计值保持不变,将更新后的当前的状态均值估计值作为下一次迭代所需的当前的状态均值预测值,将当前的状态协方差估计值作为下一次迭代所需的状态协方差预测值;
基于对当前路标进行的M次迭代更新后的机器人状态和量测值之间的互协方差、卡尔曼滤波参数和状态协方差预测值来更新每个粒子中的状态协方差估计值;当某一时刻观测到多个路标时,针对当前路标进行M次迭代后最终得到的经更新的状态均值估计值和状态协方差估计值为针对下一路标进行第一次迭代更新前的状态均值预测值和状态协方差预测值;
(4)基于步骤(3)中最终得到的经更新的状态均值估计值和状态协方差估计值来完成每个粒子的重要性采样,并基于采样值来更新每个粒子的权值,以实现所述移动机器人的定位。
2.根据权利要求1所述的基于改进迭代容积粒子滤波算法的定位方法,其特征在于,步骤(2)包括如下步骤:
(2.1)基于运动信息uk-1和噪声控制信息Q对先前的状态均值估计值和状态协方差估计值进行增维:
其中,和Pk-1分别表示第i个粒子中先前的状态均值估计值和状态协方差估计值,a和Pa分别表示增维后的机器人状态均值估计值和增维后的状态协方差估计值,增维后的机器人位姿状态满足高斯分布:N(a,Pa);
(2.2)基于增维后的状态均值估计值和状态协方差估计值产生包含2(ns+nu)个容积点的状态预测容积点集
其中,ns表示机器人位姿的维数,nu表示机器人运动控制信息uk-1的维数,j表示容积点的索引值,且
(2.3)基于所述状态预测容积点集和机器人运动模型计算移动机器人当前的状态均值预测值和状态协方差预测值:
将容积点分解为机器人位姿分量和控制分量 根据各容积点的位姿分量和控制分量计算当前的状态均值预测值和状态协方差预测值
其中表示预测转换的容积点,f(·)为机器人运动模型。
3.根据权利要求1所述的基于改进迭代容积粒子滤波算法的定位方法,其特征在于,步骤(3.1)包括如下步骤:
(3.1.1)基于当前路标的高斯密度函数对状态均值预测值和状态协方差预测值,分别记为和进行增维:
其中表示增维后的状态均值预测值,表示增维后的状态协方差预测值,nμ表示路标的状态信息维数,nz表示路标真实观测信息的维数;
(3.1.2)基于增维后的状态均值预测值b和状态协方差预测值Pb产生量测容积点集,记为
其中,j*表示测量容积点的索引值,且
4.根据权利要求3所述的基于改进迭代容积粒子滤波算法的定位方法,其特征在于,在步骤(3.2)中,机器人状态分量记为路标状态分量记为量测分量记为j*表示测量容积点的索引值,且量测容积点
5.根据权利要求4所述的基于改进迭代容积粒子滤波算法的定位方法,其特征在于,在步骤(3.3)中,根据以下式子计算转换量测容积点
其中,h(·)表示观测模型。
6.根据权利要求5所述的基于改进迭代容积粒子滤波算法的定位方法,其特征在于,在步骤(3.5)中,根据以下式子计算路标量测值的预测值
7.根据权利要求6所述的基于改进迭代容积粒子滤波算法的定位方法,其特征在于,在步骤(3.6)中,基于以下各个式子计算量测新息的协方差机器人状态与量测值之间的互协方差和卡尔曼滤波增益Ks:
8.根据权利要求7所述的基于改进迭代容积粒子滤波算法的定位方法,其特征在于,在步骤(3.6)中,根据以下式子完成对当前的状态均值估计值的一次更新:
其中l=1,...,M表示滤波的次数,al表示迭代步长因子,表示观测到的索引值为m的路标的量测值;每次滤波过程中都使用蜘蛛群居算法对迭代步长因子al进行优化更新;假设al,t为第l次迭代滤波中第t次更新的步长因子,其更新方式为:令al,t=βal,t,直到:
其中,为的雅克比矩阵,为黑塞矩阵,并且0<β<1,0<γ<0.5。
9.根据权利要求8所述的基于改进迭代容积粒子滤波算法的定位方法,其特征在于,在步骤(3)中,在对当前路标进行M次滤波后,根据以下式子来更新每个粒子中的状态协方差估计值
10.根据权利要求9所述的基于改进迭代容积粒子滤波算法的定位方法,其特征在于,所述步骤(4)进一步包括:
(4.1)根据步骤(3)中每个粒子对应的经过M次迭代更新后的状态均值估计值和状态协方差估计值进行重要性采样,得到第i个粒子对应的经采样状态均值估计值
(4.2)重要性采样完成后根据以下式子来更新每个粒子权值
对各个权值进行归一化,得到归一化后的权值:
(4.3)根据步骤(4.1)中得到的经采样状态均值估计值和归一化后的权值便可以最终确定机器人当前的位姿状态sk:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810650040.9A CN109253727B (zh) | 2018-06-22 | 2018-06-22 | 一种基于改进迭代容积粒子滤波算法的定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810650040.9A CN109253727B (zh) | 2018-06-22 | 2018-06-22 | 一种基于改进迭代容积粒子滤波算法的定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109253727A true CN109253727A (zh) | 2019-01-22 |
CN109253727B CN109253727B (zh) | 2022-03-08 |
Family
ID=65051990
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810650040.9A Active CN109253727B (zh) | 2018-06-22 | 2018-06-22 | 一种基于改进迭代容积粒子滤波算法的定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109253727B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110260869A (zh) * | 2019-05-10 | 2019-09-20 | 哈尔滨工业大学 | 一种降低星敏感器和陀螺联合滤波计算量的改进方法 |
CN110779528A (zh) * | 2019-11-07 | 2020-02-11 | 四川长虹电器股份有限公司 | 基于粒子滤波器的定位恢复方法及机器人设备 |
CN115070765A (zh) * | 2022-06-27 | 2022-09-20 | 江南大学 | 一种基于变分推断的机器人状态估计方法及系统 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101625572A (zh) * | 2009-08-10 | 2010-01-13 | 浙江大学 | 基于改进重采样方法和粒子选取的FastSLAM算法 |
CN102082560A (zh) * | 2011-02-28 | 2011-06-01 | 哈尔滨工程大学 | 一种基于集合卡尔曼滤波的粒子滤波方法 |
CN103389094A (zh) * | 2013-07-15 | 2013-11-13 | 哈尔滨工程大学 | 一种改进的粒子滤波方法 |
CN103471595A (zh) * | 2013-09-26 | 2013-12-25 | 东南大学 | 一种面向ins/wsn室内移动机器人紧组合导航的迭代扩展rts均值滤波方法 |
CN103487047A (zh) * | 2013-08-06 | 2014-01-01 | 重庆邮电大学 | 一种基于改进粒子滤波的移动机器人定位方法 |
CN105911518A (zh) * | 2016-03-31 | 2016-08-31 | 山东大学 | 机器人定位方法 |
CN106131955A (zh) * | 2016-07-12 | 2016-11-16 | 安徽工程大学 | 一种基于移动机器人辅助的无线传感器网络节点定位方法 |
CN106403950A (zh) * | 2016-06-24 | 2017-02-15 | 电子科技大学 | 一种基于参考信息的码垛机器人轨迹规划方法 |
CN106482736A (zh) * | 2016-07-11 | 2017-03-08 | 安徽工程大学 | 一种基于平方根容积卡尔曼滤波的多机器人协同定位算法 |
CN106599368A (zh) * | 2016-11-14 | 2017-04-26 | 浙江大学 | 基于改进粒子提议分布和自适应粒子重采样的FastSLAM方法 |
US20170160399A1 (en) * | 2014-07-09 | 2017-06-08 | Safran Electronics & Defense | Invariant particle filtering |
-
2018
- 2018-06-22 CN CN201810650040.9A patent/CN109253727B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101625572A (zh) * | 2009-08-10 | 2010-01-13 | 浙江大学 | 基于改进重采样方法和粒子选取的FastSLAM算法 |
CN102082560A (zh) * | 2011-02-28 | 2011-06-01 | 哈尔滨工程大学 | 一种基于集合卡尔曼滤波的粒子滤波方法 |
CN103389094A (zh) * | 2013-07-15 | 2013-11-13 | 哈尔滨工程大学 | 一种改进的粒子滤波方法 |
CN103487047A (zh) * | 2013-08-06 | 2014-01-01 | 重庆邮电大学 | 一种基于改进粒子滤波的移动机器人定位方法 |
CN103471595A (zh) * | 2013-09-26 | 2013-12-25 | 东南大学 | 一种面向ins/wsn室内移动机器人紧组合导航的迭代扩展rts均值滤波方法 |
US20170160399A1 (en) * | 2014-07-09 | 2017-06-08 | Safran Electronics & Defense | Invariant particle filtering |
CN105911518A (zh) * | 2016-03-31 | 2016-08-31 | 山东大学 | 机器人定位方法 |
CN106403950A (zh) * | 2016-06-24 | 2017-02-15 | 电子科技大学 | 一种基于参考信息的码垛机器人轨迹规划方法 |
CN106482736A (zh) * | 2016-07-11 | 2017-03-08 | 安徽工程大学 | 一种基于平方根容积卡尔曼滤波的多机器人协同定位算法 |
CN106131955A (zh) * | 2016-07-12 | 2016-11-16 | 安徽工程大学 | 一种基于移动机器人辅助的无线传感器网络节点定位方法 |
CN106599368A (zh) * | 2016-11-14 | 2017-04-26 | 浙江大学 | 基于改进粒子提议分布和自适应粒子重采样的FastSLAM方法 |
Non-Patent Citations (2)
Title |
---|
GLENN T. DONOVAN: "Position Error Correction for an Autonomous Underwater Vehicle Inertial Navigation System (INS) Using a Particle Filter", 《IEEE JOURNAL OF OCEANIC ENGINEERING》 * |
朱奇光,等: "基于平方根容积机器人蒙特卡罗定位算法研究", 《仪器仪表学报》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110260869A (zh) * | 2019-05-10 | 2019-09-20 | 哈尔滨工业大学 | 一种降低星敏感器和陀螺联合滤波计算量的改进方法 |
CN110779528A (zh) * | 2019-11-07 | 2020-02-11 | 四川长虹电器股份有限公司 | 基于粒子滤波器的定位恢复方法及机器人设备 |
CN110779528B (zh) * | 2019-11-07 | 2022-05-31 | 四川长虹电器股份有限公司 | 基于粒子滤波器的定位恢复方法及机器人设备 |
CN115070765A (zh) * | 2022-06-27 | 2022-09-20 | 江南大学 | 一种基于变分推断的机器人状态估计方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN109253727B (zh) | 2022-03-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110596593B (zh) | 基于智能自适应扩展卡尔曼滤波的锂离子电池soc估计方法 | |
CN110689576B (zh) | 一种基于Autoware的动态3D点云正态分布AGV定位方法 | |
CN110659722B (zh) | 基于AdaBoost-CBP神经网络的电动汽车锂离子电池健康状态估算方法 | |
CN108759833B (zh) | 一种基于先验地图的智能车辆定位方法 | |
CN107255795B (zh) | 基于ekf/efir混合滤波的室内移动机器人定位方法和装置 | |
CN106599368B (zh) | 基于改进粒子提议分布和自适应粒子重采样的FastSLAM方法 | |
CN110232169B (zh) | 基于双向长短时记忆模型和卡尔曼滤波的轨迹去噪方法 | |
CN109253727B (zh) | 一种基于改进迭代容积粒子滤波算法的定位方法 | |
WO2020173105A1 (zh) | 机动目标跟踪方法及装置 | |
CN103326903B (zh) | 基于隐马尔科夫的Internet网络时延预测方法 | |
CN106767780A (zh) | 基于Chebyshev多项式插值逼近的扩展椭球集员滤波方法 | |
CN110763239B (zh) | 滤波组合激光slam建图方法及装置 | |
CN109410251B (zh) | 基于稠密连接卷积网络的目标跟踪方法 | |
CN111127523B (zh) | 基于量测迭代更新的多传感器gmphd自适应融合方法 | |
CN110225454B (zh) | 一种置信度传递的分布式容积卡尔曼滤波协作定位方法 | |
CN108731700B (zh) | 一种视觉惯性里程计中的加权欧拉预积分方法 | |
CN111964667B (zh) | 一种基于粒子滤波算法的地磁_ins组合导航方法 | |
CN111814286B (zh) | 一种面向自动驾驶的车道级地图几何模型建立方法 | |
CN109115228B (zh) | 一种基于加权最小二乘容积卡尔曼滤波的目标定位方法 | |
CN114167295B (zh) | 基于多算法融合的锂离子电池soc估算方法与系统 | |
CN116047498A (zh) | 基于最大相关熵扩展卡尔曼滤波的机动目标跟踪方法 | |
CN114626307B (zh) | 一种基于变分贝叶斯的分布式一致性目标状态估计方法 | |
CN113452349B (zh) | 一种基于贝叶斯序贯重要性积分的卡尔曼滤波方法 | |
CN114139109A (zh) | 一种目标跟踪方法、系统、设备、介质及数据处理终端 | |
Jiang et al. | Road-constrained geometric pose estimation for ground vehicles |
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 |