蒙特卡洛粒子滤波定位算法_ROS -- 最简单的自主ACML定位

关于定位的原理和算法：

ARUANTOU：自适应MCL（KLD采样）zhuanlan.zhihu.com

ARUANTOU：定位算法 -- MCL蒙特卡洛（粒子）滤波zhuanlan.zhihu.com

在Ros实现中，有一个AMCL的package，用的就是自适应滤波算法。这里主要记录下自主定位在ros中的实现方式。

我们知道在粒子滤波定位的时候，需要结合地图数据和机器人的初始位姿通过不断的移动之后们，机器人就可以知道自己所在的位置。

在ros中我们可以通过这个button来进行初始位姿，但是这还是一个人为的过程，在实际应用中还是需要自动化的，这样会显得更大气上档次。

AMCL包是很强大的，研究这个包居然发现自身是支持自动自主定位的。内部实现为一个service -- global_location. 我们只需要每次在运行amcl之后，通过client调用一下这个service，它就会在整个地图数据的free空间布满粒子，这样机器人就可以通过自己的移动来不断的过滤筛选出概率最高的那些粒子最终实现定位的功能。

先看下client的实现：

#include "ros/ros.h"
#include "std_srvs/Empty.h"
#include <unistd.h>
int main(int argc, char** argv)
{ros::init(argc, argv, "DeliverRobot");ros::NodeHandle n;ros::ServiceClient client = n.serviceClient<std_srvs::Empty>("global_localization");std_srvs::Empty srv;int trytimes = 0;while(!(client.call(srv)) && trytimes < 5){ROS_ERROR("Failed call global localization");trytimes++;sleep(1);continue;}if(trytimes == 5){ROS_ERROR("Has try 5 times No useful!!!!!!!");}else{ROS_INFO("call global localization successful");}return 0;
}

然后通过修改launch文件，增加client node的添加：

<node pkg="deliver" type="deliver" name="deliver" output="screen"></node>

只要加上这一句，在amcl启动后，client会请求这个service，然后我们就可以通过rviz中看到最终的定位情况：

https://www.zhihu.com/video/1146572389180620800

蒙特卡洛粒子滤波定位算法_ROS -- 最简单的自主ACML定位相关推荐

粒子滤波跟踪算法及实现
粒子滤波跟踪算法实现的基本步骤如下: 初始化步骤:选择目标,计算目标模型颜色直方图,初始化粒子. 粒子采样及权重计算:在上一帧目标附近按高斯分布散布粒子,统计每个粒子的颜色直方图.与目标模型颜色直方图 ...
蒙特卡洛粒子滤波定位算法_粒子滤波——来自哈佛的详细的粒子滤波器教程【1】...
本文原版链接:https://www.seas.harvard.edu/courses/cs281/papers/doucet-johansen.pdf 本文是哈佛大学相关研究人员于2008年发表的一 ...
蒙特卡洛粒子滤波定位算法_基于粒子滤波的TBD算法仿真—MATLAB仿真
目标跟踪的最终目的是在最小的误差下确定目标的位置,而在无线传感器网络中要实现这个目的需要很多相关技术的支持,如定位技术.目标检测技术.估计技术.节能技术等.目标跟踪问题的求解有很多方法, 从算法的考虑 ...
蒙特卡洛粒子滤波定位算法_序列蒙特卡洛(SMC)与粒子滤波
上一节我们讲了蒙特卡洛方法,如果对蒙特卡洛方法不了解的朋友们可以看我之前写的这一篇文章. Shawn:一文看懂蒙特卡洛采样方法zhuanlan.zhihu.com 今天这篇文章我们来讲一讲针对时间序 ...
蒙特卡洛粒子滤波定位算法_蒙特卡罗定位算法(基于粒子滤波的定位算法) ——原理、理解与仿真...
1 算法原理 1.1 机器人定位问题关于机器人定位,有三大问题,它们分别是: (1)"全局定位":指初始位置未知,机器人靠自身运动确定自己在地图中的位姿. (2)"位姿 ...
蒙特卡洛粒子滤波定位算法_定位算法 -- MCL蒙特卡洛（粒子）滤波
之前的文章介绍过卡尔曼滤波算法进行定位,我们知道kalman算法适合用于线性的高斯分布的状态环境中,我们也介绍了EKF,来解决在非高斯和非线性环境下的机器人定位算法.但是他们在现实应用中存在计算量,内 ...
OpenCV3学习（12.4）粒子滤波Condensation算法
算法详解 opencv2.3以后,condensation算法放在legacy中了,也就是说要引入下面文件,condensation算法的函数原型在" -\OpenCV\sources\mo ...
rssi室内定位算法原理_RSSI的室内人员卡尔曼滤波定位算法
[1] 彭宇,王丹.无线传感器网络定位技术综述[J].电子测量与仪器学报,2011(5):389-399. PENG Yu,WANG Dan.Overview of wireless sensor ...
目标跟踪之粒子滤波---Opencv实现粒子滤波算法
目标跟踪学习笔记_2(particle filter初探1) 目标跟踪学习笔记_3(particle filter初探2) 前面2篇博客已经提到当粒子数增加时会内存报错,后面又仔细查了下程序,是代码方 ...

蒙特卡洛粒子滤波定位算法_ROS -- 最简单的自主ACML定位

蒙特卡洛粒子滤波定位算法_ROS -- 最简单的自主ACML定位相关推荐

最新文章

热门文章