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.
-
-
期刊类型引用(21)
1. 王攀攀,李兴宇,戴诗科,徐瑞东,王宇佩,陈凯玄,邓先明. 基于角域重采样和领域对抗网络的滚动轴承故障迁移诊断方法及实验分析. 实验技术与管理. 2024(05): 54-61 . 百度学术
2. 魏礼鹏,鹿伟强,于铄航,陈雯雅,张珂. 基于SA-PSO的煤矿小功率电机故障诊断研究. 煤矿机械. 2024(07): 174-176 . 百度学术
3. 李臻. 基于提升小波-SVD差分谱的煤机设备故障诊断. 煤矿机械. 2024(10): 169-173 . 百度学术
4. 杨秀宇,邵斌,贾少毅,赖岳华. 强背景噪声下滚动轴承轻微磨损故障特征提取方法. 煤炭工程. 2023(05): 153-159 . 百度学术
5. 刘金森,黄炜嘉,李效龙. 基于粒子群优化支持向量机的癫痫发作预测. 计算机与数字工程. 2023(03): 736-741+747 . 百度学术
6. 潘晓博,葛鲲鹏,钱孟浩,赵衍,董飞. 基于改进联合分布适应的轴承智能故障诊断方法. 机电工程. 2023(09): 1354-1362 . 百度学术
7. 王玉承,李亚,王海瑞,肖杨. 基于CEEMDAN-SVM和时域特征的滚动轴承故障诊断方法研究. 化工自动化及仪表. 2022(02): 175-181 . 百度学术
8. 李金才,付文龙,王仁明,陈星,孟嘉鑫. 基于深度网络的滚动轴承智能故障诊断. 工矿自动化. 2022(04): 78-88 . 本站查看
9. 曹洁,张玉林,王进花,余萍. 基于VMD和SVPSO-BP的滚动轴承故障诊断. 太阳能学报. 2022(09): 294-301 . 百度学术
10. 黄向慧,田坤臣,荣相,魏礼鹏,杨方. 变频环境下异步电机故障诊断方法. 机床与液压. 2022(18): 165-171 . 百度学术
11. 张旭辉,鞠佳杉,杨文娟,吕欣媛. 基于数字孪生的复杂矿用设备预测性维护系统. 工程设计学报. 2022(05): 643-650+664 . 百度学术
12. 许志鹏,刘振坚,庄德玉,尹玉玺. 基于振动信号的采矿机截割负载分类. 工矿自动化. 2022(12): 137-143 . 本站查看
13. 王红尧,吴佳奇,李长恒,唐文锦,张艳林. 矿用钢丝绳损伤检测信号处理方法研究. 工矿自动化. 2021(02): 58-62 . 本站查看
14. 黄重谦. 基于多隐层小波卷积极限学习神经网络的滚动轴承故障识别. 工矿自动化. 2021(05): 77-82+100 . 本站查看
15. 黄芝玲,陈金峰,曾永华,陆筠濠,黎惠敏,朱兴统. 基于小波包模糊熵与RBF神经网络的滚动轴承故障诊断. 广东石油化工学院学报. 2021(03): 26-29 . 百度学术
16. 宫涛,杨建华,单振,刘后广. 强噪声背景与变转速工况条件下滚动轴承故障诊断研究. 工矿自动化. 2021(07): 63-71 . 本站查看
17. 姜家国,郭曼利,杨思国. 基于GAF和DenseNet的滚动轴承故障诊断方法. 工矿自动化. 2021(08): 84-89 . 本站查看
18. 杨战社,孔晨再,荣相,魏礼鹏,史小军. 基于EEMD能量熵与ANN的矿用异步电机故障诊断. 微电机. 2021(08): 23-27+61 . 百度学术
19. 郭秀才,吴妮,曹鑫. 基于特征融合与DBN的矿用通风机滚动轴承故障诊断. 工矿自动化. 2021(10): 14-20+26 . 本站查看
20. 恵阿丽,鹿伟强,荣相,魏礼鹏,陈雯雅. 基于Park—WPT和WOA—LSSVM的异步电动机故障诊断方法. 工矿自动化. 2021(12): 106-113 . 本站查看
27. 樊红卫,严杨,张旭辉,张超,曹现刚,薛策译,毛清华,李杰. 滚动轴承优选WPE与ANVTPSO-BPNN故障诊断. 振动.测试与诊断. 2023(03): 593-602+625-626 . 百度学术
其他类型引用(16)
计量
- 文章访问数: 124
- HTML全文浏览量: 21
- PDF下载量: 21
- 被引次数: 37