AMCL 参数配置

<launch>
<node pkg=”amcl” type=”amcl” name=”amcl” output=”screen”>
<!– Publish scans from best pose at a max of 10 Hz –>

<!– 用作机器人的基坐标系 –>
<param name=”base_frame_id” value=”base_footprint”/>

<!– 里程计默认使用的坐标系 –>
<param name=”odom_frame_id” value=”odom”/>
<!– 模型使用,可以是”diff”, “omni”, “diff-corrected”, “omni-corrected”,后面两个是对老版本里程计模型的矫正,相应的里程计参数需要做一定的减小 –>
<param name=”odom_model_type” value=”diff”/>
<!– alpha1机器人在横向分量的运动噪声 –>
<param name=”odom_alpha2″ value=”0.2″/>
<!– alpha2机器人在转角分量的运动噪声 –>
<param name=”odom_alpha1″ value=”0.3″/>
<!– alpha3机器人纵向分量的运动噪声 –>
<param name=”odom_alpha3″ value=”0.8″/>
<!– alpha4机器人斜角方向的运动噪声 –>
<param name=”odom_alpha4″ value=”0.2″/>
<!– alpha5全向运动模型有用,差速diff无用 –>
<param name=”odom_alpha5″ value=”0.1″/>

<!– f变换发布推迟的时间,为了说明tf变换在未来时间内是可用的 –>
<param name=”transform_tolerance” value=”0.2″ />

<!– 扫描和路径发布到可视化软件的最大频率,设置参数为-1.0意为失能此功能,默认-1.0 –>
<param name=”gui_publish_rate” value=”-0.1″/>

<param name=”laser_max_beams” value=”30″/>
<!– 允许的粒子数量的最小值,默认100 –>
<param name=”min_particles” value=”500″/>
<!– 允许的粒子数量的最大值,默认5000 –>
<param name=”max_particles” value=”5000″/>

<!– 真实分布和估计分布之间的最大误差,默认0.01 –>
<param name=”kld_err” value=”0.05″/>

<!– 上标准分位数(1-p),其中p是估计分布上误差小于kld_err的概率,默认0.99 –>
<param name=”kld_z” value=”0.99″/>

<!– 被考虑的最小扫描范围;参数设置为-1.0时,将会使用激光上报的最小扫描范围 –>
<param name=”laser_min_range” value=”-1.0″/>
<!– 被考虑的最大扫描范围;参数设置为-1.0时,将会使用激光上报的最大扫描范围 –>
<param name=”laser_max_range” value=”-1.0″/>
<!– 更新滤波器时,每次扫描中多少个等间距的光束被使用(减小计算量,测距扫描中相邻波束往往不是独立的可以减小噪声影响,太小也会造成信息量少定位不准)–>
<param name=”laser_max_beams” value=”30″/>

<!–
这4个laser_z参数,在动态环境下的定位时用于异常值去除技术(还有一种状态增广技术-将隐藏状态包含进状态估计,缺点是计算复杂,acml定位未使用这种定位) 这种定位思想是环境中的动态物体总是会获得比静态地图障碍物更短的读数(人在障碍物后面是扫描不到的-假如不考虑体积,比如单个激光光束不用考虑体积),利用这样的不对称性去除异常值 缺点是:在其他可改变环境的其他类型情景(如去除障碍物)时,这样的非对称性可能不存在,但相同概率分析通常是可适用的。因为每一个异常值都被舍弃了,缺少对称性的缺点可能是从全局定位失效中恢复变得不可能。这种情况下,×××强加额外约束(如限制部分可能已被破坏的测量值)是有意义的(×××怎么约束)。(这里说的舍弃与likelihood_field模型的舍弃有区别,这里定位是先计算测量值对应非预期物体的概率(意外对象概率/混合概率)大于用户设定的阀值(amcl配置参数里貌似没有这个?)舍弃,而似然域概率是舍弃的超出最大测量范围的值,不计算概率。) (针对这个缺点不想改代码的粗暴又好用省心的处理方式可能是构图的时候将可移动的障碍物搬走,还有更直接的办法就是PS)最后,概率由这4个权重乘他们对应的概率然后相加,算法中4个权重相加等于1(这里默认值不等于1,估计做了归一化)。 这6个laser_参数可以用learn_intrinsic_parameters算法计算,该算法是期望值极大化算法,是估计极大似然参数的迭代过程。(×××好吧,amcl好像并没有做这个工作)
–>
<!– 模型的z_hit部分的混合权值,默认0.95(混合权重1.具有局部测量噪声的正确范围,以测量距离近似真实距离为均值,其后laser_sigma_hit为标准偏差的高斯分布的权重) –>
<param name=”laser_z_hit” value=”0.5″/>
<!– 模型的z_short部分的混合权值,默认0.1(混合权重2.意外对象权重(类似于一元指数关于y轴对称0~测量距离(非最大距离)的部分:ηλe^(-λz),其余部分为0,其中η为归一化参数,λ为laser_lambda_short,z为t时刻的一个独立测量值(一个测距值,测距传感器一次测量通常产生一系列的测量值)),动态的环境,如人或移动物体) –>
<param name=”laser_z_short” value=”0.05″/>
<!– 模型的z_max部分的混合权值,默认0.05(混合权重3.测量失败权重(最大距离时为1,其余为0),如声呐镜面反射,激光黑色吸光对象或强光下的测量,最典型的是超出最大距离) –>
<param name=”laser_z_max” value=”0.05″/>
<!– 模型的z_rand部分的混合权值,默认0.05(混合权重4.随机测量权重均匀分布(1平均分布到0~最大测量范围),完全无法解释的测量,如声呐的多次反射,传感器串扰) –>
<param name=”laser_z_rand” value=”0.5″/>
<!– 被用在模型的z_hit部分的高斯模型的标准差,默认0.2m –>
<param name=”laser_sigma_hit” value=”0.2″/>
<!– 模型z_short部分的指数衰减参数,默认0.1(根据ηλe^(-λz),λ越大随距离增大意外对象概率衰减越快) –>
<param name=”laser_lambda_short” value=”0.1″/>

<!– 模型使用,可以是beam, likehood_field, likehood_field_prob(和likehood_field一样但是融合了beamskip特征-官网的注释),默认是“likehood_field” –>
<param name=”laser_model_type” value=”likelihood_field”/>
<!– <param name=”laser_model_type” value=”beam”/> –>

<!– 地图上做障碍物膨胀的最大距离,用作likelihood_field模型(likelihood_field_range_finder_model只描述了最近障碍物的距离,(目前理解应该是在这个距离内的障碍物膨胀处理,但是算法里又没有提到膨胀,不明确是什么意思).这里算法用到上面的laser_sigma_hit。似然域计算测量概率的算法是将t时刻的各个测量(舍去达到最大测量范围的测量值)的概率相乘,单个测量概率:Zh * prob(dist,σ) +avg,Zh为laser_z_hit,avg为均匀分布概率,dist最近障碍物的距离,prob为0为中心标准方差为σ(laser_sigma_hit)的高斯分布的距离概率) –>
<param name=”laser_likelihood_max_dist” value=”2.0″/>
<!– 在执行滤波更新前平移运动的距离,默认0.2m(对于里程计模型有影响,模型中根据运动和地图求最终位姿的释然时丢弃了路径中的相关所有信息,已知的只有最终位姿,为了规避不合理的穿过障碍物后的非零似然,这个值建议不大于机器人半径。否则因更新频率的不同可能产生完全不同的结果) –>
<param name=”update_min_d” value=”0.2″/>
<!– 执行滤波更新前旋转的角度,默认pi/6 rad –>
<param name=”update_min_a” value=”0.5″/>

<!– 在重采样前需要的滤波更新的次数,默认2 –>
<param name=”resample_interval” value=”1″/>

<!– 慢速的平均权重滤波的指数衰减频率,用作决定什么时候通过增加随机位姿来recover,默认0(disable),可能0.001是一个不错的值 –>
<param name=”recovery_alpha_slow” value=”0.001″/>
<!– 快速的平均权重滤波的指数衰减频率,用作决定什么时候通过增加随机位姿来recover,默认0(disable),可能0.1是个不错的值 –>
<param name=”recovery_alpha_fast” value=”0.1″/>

<!–
//机器人初始化数据设置
<param name=”initial_pose_x” value=”0.0″/> //初始位姿均值(x),用于初始化高斯分布滤波器。(initial_pose_参数决定撒出去的初始位姿粒子集范围中心)
<param name=”initial_pose_y” value=”0.0″/> //初始位姿均值(y),用于初始化高斯分布滤波器。(同上)
<param name=”initial_pose_a” value=”0.0″/> //初始位姿均值(yaw),用于初始化高斯分布滤波器。(粒子朝向)
<param name=”initial_cov_xx” value=”0.5*0.5″/> //初始位姿协方差(x*x),用于初始化高斯分布滤波器。(initial_cov_参数决定初始粒子集的范围)
<param name=”initial_cov_yy” value=”0.5*0.5″/> //初始位姿协方差(y*y),用于初始化高斯分布滤波器。(同上)
<param name=”initial_cov_aa” value=”(π/12)*(π/12)”/> //初始位姿协方差(yaw*yaw),用于初始化高斯分布滤波器。(粒子朝向的偏差)
–>

</node>
</launch>

转自:https://www.cnblogs.com/dyan1024/p/7825988.html

Tags: