CN109917332A - 一种基于改进粒子滤波的室内机器人定位方法 - Google Patents

一种基于改进粒子滤波的室内机器人定位方法 Download PDF

Info

Publication number
CN109917332A
CN109917332A CN201910104416.0A CN201910104416A CN109917332A CN 109917332 A CN109917332 A CN 109917332A CN 201910104416 A CN201910104416 A CN 201910104416A CN 109917332 A CN109917332 A CN 109917332A
Authority
CN
China
Prior art keywords
particle
last moment
axis
new
rot1
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
Application number
CN201910104416.0A
Other languages
English (en)
Other versions
CN109917332B (zh
Inventor
苏成悦
萧志聪
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangdong University of Technology
Original Assignee
Guangdong University of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Guangdong University of Technology filed Critical Guangdong University of Technology
Priority to CN201910104416.0A priority Critical patent/CN109917332B/zh
Publication of CN109917332A publication Critical patent/CN109917332A/zh
Application granted granted Critical
Publication of CN109917332B publication Critical patent/CN109917332B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Feedback Control In General (AREA)

Abstract

一种基于改进粒子滤波的室内机器人定位方法,包括:S1:提取参数;包括:上一时刻的粒子集合、里程信息、测量信息、地图、上一时刻的粒子数目、上上一时刻的粒子数目,上一时刻状态粒子位置的更新趋向;S2:对上一时刻的粒子集合中的每个粒子进行更新,并融合进上一时刻的更新趋向,得到新的粒子集合;S3:对更新后的粒子集进行判断,判断|nx,t‑nx,t‑1|>3|nx,t‑1‑nx,t‑2|是否成立,若成立,则执行S4;若不成立,则xd=yd=0;并执行S5;S4:计算该时刻状态粒子位置的更新趋向;S5:计算当前时刻的粒子数目;S6:输出结果;本发明所述方法在粒子更新的同时优化了计算,可以使机器人定位修复快速收敛至正确位置,可满足机器人室内定位需求。

Description

一种基于改进粒子滤波的室内机器人定位方法
技术领域
本发明涉及机器人定位领域,更具体地,涉及一种基于改进粒子滤波的室内机器人定位方法。
背景技术
定位在机器人执行任务时起着重要作用;实时建图、路径规划和自动避障都需要机器人在世界坐标中准确的地理坐标,其基于概率的定位算法主要有扩展卡尔曼滤波算法,无迹卡尔曼滤波算法、直方图滤波算法及粒子滤波算法,前两者需要基于特征的地标辅助,不适于全局定位,而直方图滤波的好坏严重依赖于栅格地图的粗糙度,对于硬件低廉的普通机器人,一个精细的地图意味着需要更长的计算时间。
粒子滤波采用蒙特卡洛机制实现了递推贝叶斯滤波算法;它不受非高斯噪声和非线性模型的限制,并以维护粒子集合Xt来近似后验置信度bel(xt);目前针对粒子滤波算法的优化主要集中在滤波过程中对粒子数目的减少、粒子收敛速度的提高、粒子的抗干扰能力等方面;Liu等实施残差策略只对部分关键粒子进行更新,而其余粒子保持不变,减少了计算方面的冗余,但只更新部分粒子降低了算法的抗干扰能力,Li T等考虑了粒子的空间信息,使用分组策略对粒子进行合并,保持了粒子的多样性,但计算合并过程占用了相当大的开销;有的优化方法使用并行分布式计算,利用GPU为粒子滤波提高计算速度,但该改进对硬件要求过高;还有的则通过对真实后验的拟合,尽可能调整粒子滤波中每次迭代所需的粒子数目;但由于多数室内机器人体积小成本低廉,上述改进研究并很难符合室内定位需求。
发明内容
本发明为克服上述现有技术所述的基于粒子滤波的机器人定位很难符合室内定位需求缺陷,提供一种基于改进粒子滤波的室内机器人定位方法。
所述方法包括以下步骤:
S1:提取参数;提取的参数包括:上一时刻的粒子集合Xt-1、里程信息ut、测量信息zt、地图m、上一时刻的粒子数目nx,t-1、上上一时刻的粒子数目nx,t-2,上一时刻状态间x轴和y轴上的粒子位置的更新趋向xd,t-1、yd,t-1
其中,t-1表示上一时刻,t-2表示上上一时刻;
S2:结合上一时刻状态间x轴和y轴上的粒子位置的更新趋向xd,t-1、yd,t-1,对上一时刻的粒子集合Xt-1中的每个粒子的位置信息和重要性权重进行更新,得到新的粒子集合Xt
S3:对新的粒子集合Xt进行判断,判断|nx,t-nx,t-1|>3|nx,t-1-nx,t-2|是否成立,若成立,则进行步骤S4;若不成立,则x轴和y轴上粒子位置的更新趋向xd和yd为:xd=yd=0;从而执行步骤S5;
在粒子滤波更新过程中的每次迭代过程中,当nx数目急剧变化,表明当前分布与后验分布相差很大,即机器人定位误差变大,需要更大的粒子数目来适应新变化的分布,此时,可添加进测量信息,使粒子快速收敛回正常水平。设nx,t、nx,t-1、nx,t-2分别代表t、t-1、t-2时刻的粒子数目,若|nx,t-nx,t-1|>3|nx,t-1-nx,t-2|成立,则说明粒子变化程度明显,需采用带测量信息的粒子采样更新;
S4:计算x轴和y轴上的粒子位置的更新趋向xd和yd;x轴和y轴为基于地图坐标系上的坐标轴。
S5:计算当前时刻的粒子数目nx,t
S6:输出结果;输出新的粒子集合Xt、x轴和y轴上粒子位置的更新趋向xd和yd、当前时刻的粒子数目nx,t
本发明以KLD(Kullback-Leibler Distance)采样为基础,通过引入基于KLD的实时粒子数目作为判断机器人误差大小的依据,在误差较大阶段,结合t-1和t-2两个时刻雷达激光测量信息,选取权值较大的粒子的方位融合进粒子滤波的采样更新阶段,使粒子更新能以更快速度收敛至高似然区域,实现对粒子滤波的改进。
优选地,S2中采样更新后的新粒子位置信息的计算公式为:
rot1′=rot1-g(ε1)
rot2′=rot2一g(ε2)
tran′=tran-g(ε3)
xq,t=xq,t-1+xd,t-1+tran′*cos(θ+rot1′)
yq,t=yq,t-1+yd,t-1+tran′*Cos(θ+rot1′)
θ′=θ+rot1′+rot2′
其中,rotl,rot2为一个周期内运动的旋转分量,tran为线性分量,rotl,rot2,tran均由里程信息ut得到,g为标准正态分布,ε为自定义方差,xq,t,yq,t即为采样更新后的新粒子位置,xq,t-1,yq,t-1即为上一时刻采样更新后的新粒子位置,θ为更新后的角度信息,θ为更新前的角度信息,为第i个粒子上一时刻的权值,为状态转移概率,为新采样的粒子。
优选地,步骤S4中xd和yd的计算公式为:
xd=x′t-1-x′t-2
yd=y′t-1-y′t-2
xq,t-1,yq,t-1为第q个粒子上一时刻的真实坐标;xq,t-2,yq,t-2为第q个粒子上上一时刻的真实坐标,wq,t-1为第q个粒子上一时刻的权重,Q代表最优粒子子集里粒子的个数。
优选地,步骤S5中当前时刻的粒子数目的计算公式为:
其中k为粒子分布直方图条数,ε为自定义方差,z1-δ为正态分布上标准正常分位数,该公式是的算法kullback-leibler divergence RESAMPLE(KLD RESAMPLE)中的一个计算粒子数目的式子,用于在每个周期合理得到所需的粒子数目。
优选地,步骤S6中新的粒子集合Xt的集合为其均值代表机器人最新位置。
与现有技术相比,本发明技术方案的有益效果是:本发明基于KLD-粒子滤波算法实时跟踪每次迭代所需粒子数,提出了一个KLD粒子滤波定位改进算法;结合里程信息及部分测量信息,将前时刻激光雷达的测量信息融合进粒子定位算法中;本算法在粒子更新的同时优化了计算,可以使机器人定位修复快速收敛至正确位置,该算法比普通KLD采样有更好的收敛效果,本发明所述的基于粒子滤波的机器人定位方法能够满足机器人室内定位需求。
附图说明
图1为本发明所述的基于改进粒子滤波的室内机器人定位方法的流程图。
具体实施方式
附图仅用于示例性说明,不能理解为对本专利的限制;
为了更好说明本实施例,附图某些部件会有省略、放大或缩小,并不代表实际产品的尺寸;
对于本领域技术人员来说,附图中某些公知结构及其说明可能省略是可以理解的。
下面结合附图和实施例对本发明的技术方案做进一步的说明。
本实施例提供一种基于改进粒子滤波的室内机器人定位方法。
提供一种基于改进粒子滤波的室内机器人定位方法。
所述方法包括以下步骤:
S1:提取参数;提取的参数包括:上一时刻的粒子集合Xt-1、里程信息ut、测量信息zt、地图m、上一时刻的粒子数目nx,t-1、上上一时刻的粒子数目nx,t-2,上一时刻状态间x轴和y轴上的粒子位置的更新趋向xd,t-1、yd,t-1
其中,t-1表示上一时刻,t-2表示上上一时刻;
S2:结合上一时刻状态间x轴和y轴上的粒子位置的更新趋向xd,t-1、yd,t-1,对上一时刻的粒子集合Xt-1中的每个粒子的位置信息和重要性权重进行更新,得到新的粒子集合Xt
采样更新后的新粒子位置信息的计算公式为:
rot1′=rot1-g(ε1)
rot2′=rot2-g(ε2)
tran′=tran-g(ε3)
xq,t=xq,t-1+xd,t-1+tran′*cos(θ+rot1′)
yq,t=yq,t-1+yd,t-1+tran′*cos(θ+rot1′)
θ′=θ+rot1′+rot2′
其中,rotl,rot2为一个周期内运动的旋转分量,tran为线性分量,rotl,rot2,tran均由里程信息ut得到,g为标准正态分布,ε为自定义方差,xq,t,yq,t为采样更新后的新粒子位置,xq,t-1,yq,t-1为上一时刻采样更新后的新粒子位置,θ为更新后的角度信息,θ为更新前的角度信息,为第i个粒子上一时刻的权值,为状态转移概率,为新采样的粒子。
S3:对新的粒子集合Xt进行判断,判断|nx,t-nx,t-1|>3|nx,t-1-nx,t-2|是否成立,若成立,则进行步骤S4;若不成立,则x轴和y轴上粒子位置的更新趋向xd和yd为:xd=yd=0;从而执行步骤S5;
在粒子滤波更新过程中的每次迭代过程中,当nx数目急剧变化,表明当前分布与后验分布相差很大,即机器人定位误差变大,需要更大的粒子数目来适应新变化的分布,此时,可添加进测量信息,使粒子快速收敛回正常水平。设nx,t、nx,t-1、nx,t-2分别代表t、t-1、t-2时刻的粒子数目,若|nx,t-nx,t-1|>3|nx,t-1-nx,t-2|成立,则说明粒子变化程度明显,需采用带测量信息的粒子采样更新;
S4:计算x轴和y轴上的粒子位置的更新趋向xd和yd;x轴和y轴为基于地图上的世界坐标系上的坐标轴。
xd和yd的计算公式为:
xd=x′t-1-x′t-2
yd=y′t-1-y′t-2
xq,t-1,yq,t-1为第q个粒子上一时刻的真实坐标;xq,t-2,yq,t-2为第q个粒子上上一时刻的真实坐标,wq,t-1为第q个粒子上一时刻的权重,Q代表最优粒子子集里粒子的个数。
S5:计算当前时刻的粒子数目nx,t;当前时刻的粒子数目的计算公式为:
其中k为粒子分布直方图条数,ε为自定义方差,z1-δ为正态分布上标准正常分位数,z1-δ可由标准正态分布表查阅得到,ε=0.1,z1-δ=0.98,k为自动更新的,该公式是的算法Kullback-Leibler Divergence Resample(KLD RESAMPLE)中的一个计算粒子数目的式子,用于在每个周期合理得到所需的粒子数目。
上式用于决定在以概率为1-δ、由粒子所代表的分布与真实后验分布的相近度小于ε的条件下,粒子滤波所需要的粒子数目。
S6:输出结果;输出Xt、xd、yd、nx,t
其中,步骤S6中新的粒子集合Xt的集合为其均值代表机器人最新位置。
本发明以KLD(Kullback-Leibler Distance)采样为基础,通过引入基于KLD的实时粒子数目作为判断机器人误差大小的依据,在误差较大阶段,结合t-1和t-2两个时刻雷达激光测量信息,选取权值较大的粒子的方位融合进粒子滤波的采样更新阶段,使粒子更新能以更快速度收敛至高似然区域,实现对粒子滤波的改进。
附图中描述位置关系的用语仅用于示例性说明,不能理解为对本专利的限制;
显然,本发明的上述实施例仅仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明权利要求的保护范围之内。

Claims (8)

1.一种基于改进粒子滤波的室内机器人定位方法,其特征在于,所述方法包括以下步骤:
S1:提取参数;
S2:结合S1所提取的参数,对上一时刻的粒子集合Xt-1中的每个粒子的位置信息和重要性权重进行更新,得到新的粒子集合;
S3:对新的粒子集合进行判断,判断|nx,t-nx,t-1|>3|nx,t-1-nx,t-2|是否成立,若成立,则进行步骤S4;若不成立,则x轴和y轴上粒子位置的更新趋向都为零;从而执行步骤S5;
S4:分别计算x轴和y轴上粒子位置的更新趋向;
S5:计算当前时刻的粒子数目;
S6:输出结果;输出新的粒子集合、x轴和y轴上粒子位置的更新趋向、当前时刻的粒子数目。
2.根据权利要求1所述的基于改进粒子滤波的室内机器人定位方法,其特征在于,S1中提取的参数包括:上一时刻的粒子集合Xt-1、里程信息ut、测量信息zt、地图m、上一时刻的粒子数目nx,t-1、上上一时刻的粒子数目nx,t-2,上一时刻状态间x轴和y轴上的粒子位置的更新趋向xd,t-1、yd,t-1,其中,t-1表示上一时刻,t-2表示上上一时刻。
3.根据权利要求1所述的基于改进粒子滤波的室内机器人定位方法,其特征在于,S2中采样更新后的新粒子位置信息的计算公式为:
rot1′=rot1-g(ε1)
rot2′=rot2-g(ε2)
tran′=tran-g(ε3)
xq,t=xq,t-1+xd,t-1+tran*cos(θ+rot1′)
yq,t=yq,t-1+yd,t-1+tran′*cos(θ+rot1′)
θ′=θ+rot1′+rot2′
其中,rot1,rot2为一个周期内运动的旋转分量,tran为线性分量,rot1,rot2,tran均由里程信息ut得到,g为标准正态分布,ε为自定义方差,xq,t,yq,t为采样更新后的新粒子位置,xq,t-1,yq,t-1为上一时刻采样更新后的新粒子位置,θ′为更新后的角度信息,θ为更新前的角度信息。
4.根据权利要求1所述的基于改进粒子滤波的室内机器人定位方法,其特征在于,S2中重要性权重的计算公式为:
其中,为第i个粒子上一时刻的权值,为状态转移概率,新采样的粒子。
5.根据权利要求1所述的基于改进粒子滤波的室内机器人定位方法,其特征在于,步骤S4中计算x轴上粒子位置的更新趋向xd的计算公式为:
xd=x′t-1-x′t-2
xq,t-1为第q个粒子上一时刻的x轴上的真实坐标;xq,t-2为第q个粒子上上一时刻x轴上的真实坐标,wq,t-1为第q个粒子上一时刻的权重,Q代表最优粒子子集里粒子的个数。
6.根据权利要求1所述的基于改进粒子滤波的室内机器人定位方法,其特征在于,步骤S4中计算y轴上粒子位置的更新趋向yd的计算公式为:
yd=y′t-1-y′t-2
yq,t-1为第q个粒子上一时刻y轴上的的真实坐标;yq,t-2为第q个粒子上上一时刻的y轴上的真实坐标,wq,t-1为第q个粒子上一时刻的权重,Q代表最优粒子子集里粒子的个数。
7.根据权利要求1所述的基于改进粒子滤波的室内机器人定位方法,其特征在于,步骤S5中当前时刻的粒子数目的计算公式为:
其中k为粒子分布直方图条数,ε为自定义方差,z1-δ为正态分布上标准正常分位数。
8.根据权利要求1所述的基于改进粒子滤波的室内机器人定位方法,其特征在于,步骤S6中新的粒子集合Xt的集合为其均值代表机器人最新位置。
CN201910104416.0A 2019-02-01 2019-02-01 一种基于改进粒子滤波的室内机器人定位方法 Active CN109917332B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910104416.0A CN109917332B (zh) 2019-02-01 2019-02-01 一种基于改进粒子滤波的室内机器人定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910104416.0A CN109917332B (zh) 2019-02-01 2019-02-01 一种基于改进粒子滤波的室内机器人定位方法

Publications (2)

Publication Number Publication Date
CN109917332A true CN109917332A (zh) 2019-06-21
CN109917332B CN109917332B (zh) 2022-12-16

Family

ID=66961302

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910104416.0A Active CN109917332B (zh) 2019-02-01 2019-02-01 一种基于改进粒子滤波的室内机器人定位方法

Country Status (1)

Country Link
CN (1) CN109917332B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110941004A (zh) * 2019-12-04 2020-03-31 南京航空航天大学 一种基于gnss/uwb的移动机器人室内外联合定位方法及装置
CN111551977A (zh) * 2020-06-04 2020-08-18 手拉手信息技术有限公司 一种基于超级计算机的低功耗穿戴式定位设备与定位方法
CN111722180A (zh) * 2020-07-02 2020-09-29 广东工业大学 一种基于卡尔曼滤波的室内行人定位方法、装置及系统
CN112666574A (zh) * 2020-12-31 2021-04-16 江苏智库智能科技有限公司 基于均匀粒子使用激光雷达提高agv定位精度的方法

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080119961A1 (en) * 2006-11-16 2008-05-22 Samsung Electronics Co., Ltd. Methods, apparatus, and medium for estimating pose of mobile robot using particle filter
US20110246130A1 (en) * 2010-03-31 2011-10-06 Yuichi Taguchi Localization in Industrial Robotics Using Rao-Blackwellized Particle Filtering
CN103487047A (zh) * 2013-08-06 2014-01-01 重庆邮电大学 一种基于改进粒子滤波的移动机器人定位方法
CN106441279A (zh) * 2016-12-08 2017-02-22 速感科技(北京)有限公司 基于自主定位和边缘探索的机器人定位方法、系统
CN107063264A (zh) * 2017-04-13 2017-08-18 杭州申昊科技股份有限公司 一种适用于大规模变电站环境的机器人地图创建方法
CN107246873A (zh) * 2017-07-03 2017-10-13 哈尔滨工程大学 一种基于改进的粒子滤波的移动机器人同时定位与地图构建的方法
CN108375374A (zh) * 2018-02-26 2018-08-07 重庆邮电大学 基于自适应迭代容积粒子滤波的蒙特卡罗定位算法
CN108507579A (zh) * 2018-04-08 2018-09-07 浙江大承机器人科技有限公司 一种基于局部粒子滤波的重定位方法
CN108871341A (zh) * 2018-07-05 2018-11-23 内江市下代互联网数据处理技术研究所 一种全局优化的并发定位与建图方法

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080119961A1 (en) * 2006-11-16 2008-05-22 Samsung Electronics Co., Ltd. Methods, apparatus, and medium for estimating pose of mobile robot using particle filter
US20110246130A1 (en) * 2010-03-31 2011-10-06 Yuichi Taguchi Localization in Industrial Robotics Using Rao-Blackwellized Particle Filtering
CN103487047A (zh) * 2013-08-06 2014-01-01 重庆邮电大学 一种基于改进粒子滤波的移动机器人定位方法
CN106441279A (zh) * 2016-12-08 2017-02-22 速感科技(北京)有限公司 基于自主定位和边缘探索的机器人定位方法、系统
CN107063264A (zh) * 2017-04-13 2017-08-18 杭州申昊科技股份有限公司 一种适用于大规模变电站环境的机器人地图创建方法
CN107246873A (zh) * 2017-07-03 2017-10-13 哈尔滨工程大学 一种基于改进的粒子滤波的移动机器人同时定位与地图构建的方法
CN108375374A (zh) * 2018-02-26 2018-08-07 重庆邮电大学 基于自适应迭代容积粒子滤波的蒙特卡罗定位算法
CN108507579A (zh) * 2018-04-08 2018-09-07 浙江大承机器人科技有限公司 一种基于局部粒子滤波的重定位方法
CN108871341A (zh) * 2018-07-05 2018-11-23 内江市下代互联网数据处理技术研究所 一种全局优化的并发定位与建图方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
DIETER FOX: "Adapting the Sample Size in Particle Filters Through KLD-Sampling", 《THE INTERNATIONAL JOURNAL OF ROBOTICS RESEARCH》 *
T. LI等: "Adapting sample size in particle filters through KLD-resampling", 《ELECTRONICS LETTERS》 *
刘盼等: "室内环境约束的行人航向粒子滤波修正方法", 《计算机应用》 *
雷杨浩: "室内动态环境下基于粒子滤波的服务机器人定位", 《中国优秀硕士学位论文全文数据库信息科技辑(月刊)》 *

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110941004A (zh) * 2019-12-04 2020-03-31 南京航空航天大学 一种基于gnss/uwb的移动机器人室内外联合定位方法及装置
CN111551977A (zh) * 2020-06-04 2020-08-18 手拉手信息技术有限公司 一种基于超级计算机的低功耗穿戴式定位设备与定位方法
CN111551977B (zh) * 2020-06-04 2023-05-26 长沙手拉手信息技术有限公司 一种基于超级计算机的低功耗穿戴式定位设备与定位方法
CN111722180A (zh) * 2020-07-02 2020-09-29 广东工业大学 一种基于卡尔曼滤波的室内行人定位方法、装置及系统
CN112666574A (zh) * 2020-12-31 2021-04-16 江苏智库智能科技有限公司 基于均匀粒子使用激光雷达提高agv定位精度的方法
CN112666574B (zh) * 2020-12-31 2021-09-07 江苏智库智能科技有限公司 基于均匀粒子使用激光雷达提高agv定位精度的方法

Also Published As

Publication number Publication date
CN109917332B (zh) 2022-12-16

Similar Documents

Publication Publication Date Title
CN109917332A (zh) 一种基于改进粒子滤波的室内机器人定位方法
CN107084714B (zh) 一种基于RoboCup3D的多机器人协作目标定位方法
CN109798896B (zh) 一种室内机器人定位与建图方法及装置
CN106126961B (zh) 灰色粒子群卫星钟差自适应预测方法及系统
CN105180938B (zh) 一种基于粒子滤波的重力采样矢量匹配定位方法
CN107063264A (zh) 一种适用于大规模变电站环境的机器人地图创建方法
CN110095127A (zh) 一种基于分段的隐马尔可夫模型地图匹配方法
CN109597864A (zh) 椭球边界卡尔曼滤波的即时定位与地图构建方法及系统
CN109460539B (zh) 一种基于简化容积粒子滤波的目标定位方法
CN107607122B (zh) 面向室内定位的位置指纹库构建和动态更新方法
WO2021179642A1 (zh) 确定位置轨迹的方法、装置、系统、终端及存储介质
CN109724592A (zh) 一种基于进化梯度搜索的auv地磁仿生导航方法
Mallick et al. Out-of-sequence measurement processing for tracking ground target using particle filters
CN107132504A (zh) 基于粒子滤波的定位追踪装置、方法及电子设备
CN110850363A (zh) 一种基于实时定位轨迹数据进行动态滤波优化的方法
CN115952691A (zh) 多站无源时差交叉联合定位系统的优化布站方法及装置
CN114137562B (zh) 一种基于改进全局最邻近的多目标跟踪方法
CN108871365A (zh) 一种航向约束下的状态估计方法及系统
CN115728803A (zh) 一种城市驾驶车辆连续定位系统及方法
CN110689108A (zh) 一种非线性系统状态估计方法
CN110763234B (zh) 一种水下机器人海底地形匹配导航路径规划方法
CN111563918B (zh) 一种多卡尔曼滤波器数据融合的目标跟踪方法
CN108337639A (zh) 一种基于牛顿插值的蒙特卡罗移动节点定位算法
CN113810846A (zh) 一种基于WiFi和IMU融合的室内定位方法
CN113887058A (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