煤矿用无人驾驶辅助运输车辆的蒙特卡罗定位方法

来源 :煤炭科学技术 | 被引量 : 0次 | 上传用户:Arqiu
下载到本地 , 更方便阅读
声明 : 本文档内容版权归属内容提供方 , 如果您对本文有版权争议 , 可与客服联系进行内容授权或下架
论文部分内容阅读
为解决煤矿无人驾驶车辆自主定位这一重要问题,研究了车辆在巷道环境中行驶时的蒙特卡罗定位方法.首先进行了场景分析,综合考虑工作任务和行驶安全性,得出车辆纵向和侧向位姿状态估计的不同要求,其中沿巷道轴线方向的车辆纵向位置在需要时获得,相对巷道中心线基准的车辆侧向位置和转向姿态角应实时精确解算,由此指出基于特征测量的定位方法在巷道环境应用时存在的局限,讨论了侧向激光测距扫描的适用性.进一步将矿井全域地图分解为典型场景区域地图的集合,提出了将车辆自主精确定位问题维持在一个典型场景所对应的区域地图范围内进行的策略.其次论述了蒙特卡罗定位算法的实现方法,分析了煤矿辅助运输车辆的转向结构形式,运用基于车辆的速度运动模型实现了算法的控制更新过程.为使测量概率随车辆位姿变化具有平滑性,建立了基于激光测距传感器的似然域模型实现了算法的测量更新过程,并提出调节似然域模型不确定性参数来避免定位算法失效的方法.最后,通过在典型场景内针对全局定位问题进行蒙特卡罗定位算法仿真,验证了定位策略和算法.通过高斯近似对粒子集进行密度提取来获得置信度分布,并以高斯分布均值作为车辆位姿估计.作为对比,在相同的车辆实际运行轨迹条件下,针对位置跟踪问题完成了基于特征测量的扩展卡尔曼滤波定位算法仿真.结果表明,蒙特卡罗定位中,车辆侧向位置估计和姿态角估计始终能够很好地反映实际状态值,纵向位置的后验概率由多峰分布收敛为单峰分布,反映了全局定位过渡到位置跟踪的过程.扩展卡尔曼滤波定位一方面不能解决全局定位问题;另一方面侧向定位精度受特征方位角测量误差的影响显著.在煤矿巷道应用环境下,基于激光测距扫描的蒙特卡罗定位所获得的侧向定位精度优于基于特征测量的扩展卡尔曼滤波定位情况.在区域地图范围内进行蒙特卡罗定位,实现了矿用车辆的全局定位和位置跟踪,满足了在巷道环境中不同位姿状态的估计及时性差异化要求.
其他文献
采用概率综合评价法,基于市政道路进行研究区域评价单元划分,建立城镇燃气输配系统中低压管网的风险评价模型,计算管网风险值,根据计算结果对评价单元风险等级作出判断.