基于卡尔曼滤波和加权LM法的井下精确定位算法

王伟

王伟.基于卡尔曼滤波和加权LM法的井下精确定位算法[J].工矿自动化,2019,45(11):5-9.. DOI: 10.13272/j.issn.1671-251x.17500
引用本文: 王伟.基于卡尔曼滤波和加权LM法的井下精确定位算法[J].工矿自动化,2019,45(11):5-9.. DOI: 10.13272/j.issn.1671-251x.17500
WANG Wei. Underground precise positioning algorithm based on Kalman filter and weighted LM algorithm[J]. Journal of Mine Automation, 2019, 45(11): 5-9. DOI: 10.13272/j.issn.1671-251x.17500
Citation: WANG Wei. Underground precise positioning algorithm based on Kalman filter and weighted LM algorithm[J]. Journal of Mine Automation, 2019, 45(11): 5-9. DOI: 10.13272/j.issn.1671-251x.17500

基于卡尔曼滤波和加权LM法的井下精确定位算法

基金项目: 

中国煤炭科工集团有限公司青年项目(2018QN028)

中国煤炭科工集团科技创新基金重点项目(2018-TD-ZD005)

中国煤炭科工集团有限公司双创项目(2018-TD-MS013)

详细信息
  • 中图分类号: TD655.3

Underground precise positioning algorithm based on Kalman filter and weighted LM algorithm

  • 摘要: 针对基于UWB精确定位的井下近感检测装置定位结果易受非视距(NLOS)误差等噪声影响的问题,提出了一种基于卡尔曼滤波和加权LM法的井下精确定位算法。通过卡尔曼滤波预测过程得到标签卡坐标的先验估计值;利用几何关系计算估计坐标与各锚节点的距离,并将该距离与探测器直接测距值进行比较,根据差值分配各锚节点的测距权值;将权值矩阵和测距矩阵代入加权LM法中,得到标签卡坐标的中间结果;将中间结果作为测量值代入卡尔曼滤波更新过程中,得到标签卡的最终坐标。测试结果表明,与多边定位法相比,基于卡尔曼滤波和加权LM法的井下精确定位算法可在不影响定位速度的前提下,将定位精度提高一倍以上,有效降低了NLOS误差等噪声的干扰。
    Abstract: In view of problem that positioning result of underground proximity detection device based on UWB precise positioning is susceptible to noise such as non-line of sight (NLOS) error, an underground precise positioning algorithm based on Kalman filter and weighted LM algorithm was proposed. Priori estimation value of tag card coordinates is obtained by Kalman filter prediction process; distance between the estimatied coordinates and each anchor node is calculated by using geometric relationship, the calculated distance is compared with direct measuring value of the detector, and ranging weight of each anchor node is allocated according to difference of the calculated distance and measured distance; weight matrix and ranging matrix are substituted into the weighted LM algorithm as the measured value to obtain intermediate result of the tag card coordinates; the intermediate result is substituted into Kalman filter update process to obtain final coordinates of the tag card. The test results show that compared with the multilateral positioning method, the underground precise positioning algorithm based on Kalman filter and weighted LM algorithm can improve positioning accuracy by more than one time without affecting positioning speed, and effectively reducing the interference of NLOS error and other noises.
  • 期刊类型引用(5)

    1. 王坦,朱洪波. 测量异常下基于信任融合滤波的煤矿机器人定位方法. 煤矿机械. 2024(11): 197-200 . 百度学术
    2. 杜志刚,储楠,罗克. 井下位置服务系统设计. 工矿自动化. 2022(03): 123-128+134 . 本站查看
    3. 杜志刚. 位置服务系统在煤矿中的应用. 山东煤炭科技. 2022(06): 193-195+208+211 . 百度学术
    4. 龚循强,汪宏宇,鲁铁定,游为. 基于RLM-MC的高速铁路桥墩沉降曲线预测方法. 铁道学报. 2022(10): 142-149 . 百度学术
    5. 柏思忠. 基于RS485数据帧计时的总线设备间距离测量. 工矿自动化. 2021(07): 92-97+114 . 本站查看

    其他类型引用(4)

计量
  • 文章访问数:  124
  • HTML全文浏览量:  21
  • PDF下载量:  21
  • 被引次数: 9
出版历程
  • 刊出日期:  2019-11-19

目录

    /

    返回文章
    返回