在非煤矿山井下斜坡道运输过程中，由于井下UWB动态定位精度不足、车辆定位卡采样间隔长和数据丢失等，传统信号灯闭锁控制方法效果较差。针对该问题，提出一种基于改进卡尔曼滤波和状态观测器的井下信号灯闭锁控制方法。分析了基于UWB的井下车辆定位原理，给出了适合非煤矿山井下特点的信号灯逻辑判定方法。提出一种强跟踪卡尔曼滤波算法，通过强跟踪自适应方式对卡尔曼滤波算法进行改进，在计算预测误差时加入时变渐消因子，提高定位精度；根据滤波后所得的后验距离与速度值预测出车辆到达门限的时间，解决离散数据采集导致的控制滞后性问题，提高信号灯闭锁的可靠性和及时性。采用远程状态观测器评估信号灯闭锁控制效果，基于时域自动跟踪的统计，实现闭锁可靠性的量化评估。仿真结果表明，改进卡尔曼滤波算法后，车辆动态与静态位置误差分别降低25.67%和27.19%，动态与静态速度误差分别降低25.28%和34.73%，信号灯门限逻辑响应更快。井下工业性试验和应用结果表明，采用强跟踪尔曼滤算法后，井下信号闭锁成功率达99.5%以上，有效提高了井下斜坡道岔路口信号闭锁控制的实时性和可靠性，保障了井下车辆的安全行驶。

0 引言
1 基于UWB的车辆定位原理
2 井下信号灯逻辑判定方法
2.1逻辑判定基本参数
2.2逻辑判定规则
3 改进卡尔曼滤波算法
3.1 问题分析
3.2 卡尔曼滤波算法
3.3 改进方法
4 状态观测器
5 仿真与工业现场验证
5.1 仿真分析
5.1.1 定位性能
5.1.2 速度跟踪性能
5.2工业现场验证
5.2.1 位置及速度滤波数据分析
5.2.2 信号灯闭锁效果分析
6 结论

汪学明,黄竞智,宋传智,等.基于改进卡尔曼滤波和状态观测器的井下信号灯闭锁控制[J/OL].工矿自动化,1-11[2024-11-28].https://doi.org/10.13272/j.issn.1671-251x.2024080066.