Locking control of underground signal lights based on improved Kalman filter and state observer
WANG Xueming;HUANG Jingzhi;SONG Chuanzhi;WU Daifeng
在非煤矿山井下斜坡道运输过程中,由于井下UWB动态定位精度不足、车辆定位卡采样间隔长和数据丢失等,传统信号灯闭锁控制方法效果较差。针对该问题,提出一种基于改进卡尔曼滤波和状态观测器的井下信号灯闭锁控制方法。分析了基于UWB的井下车辆定位原理,给出了适合非煤矿山井下特点的信号灯逻辑判定方法。提出一种强跟踪卡尔曼滤波算法,通过强跟踪自适应方式对卡尔曼滤波算法进行改进,在计算预测误差时加入时变渐消因子,提高定位精度;根据滤波后所得的后验距离与速度值预测出车辆到达门限的时间,解决离散数据采集导致的控制滞后性问题,提高信号灯闭锁的可靠性和及时性。采用远程状态观测器评估信号灯闭锁控制效果,基于时域自动跟踪的统计,实现了闭锁可靠性的量化评估。仿真结果表明,改进卡尔曼滤波算法后,车辆动态与静态位置误差分别降低25.67%和27.19%,动态与静态速度误差分别降低25.28%和34.73%,信号灯门限逻辑响应更快。井下工业性试验和应用结果表明,采用强跟踪尔曼滤算法后,井下信号闭锁成功率达99.5%以上,有效提高了井下斜坡道岔路口信号闭锁控制的实时性和可靠性,保障了井下车辆的安全行驶。
During underground ramp transportation in non-coal mines, traditional signal light locking control method is ineffective due to insufficient UWB dynamic positioning accuracy, long sampling interval of vehicle positioning cards, and data loss. Aiming at this problem, this paper proposed a locking control method of underground signal lights based on improved Kalman filter and state observer. The underground vehicle positioning principle based on UWB was analyzed, and a signal light logic determination method tailored to the characteristics of non-coal mine operation was provided. A strong tracking Kalman filter algorithm was introduced, and it was improved through strong tracking adaptive method. A time-varying fading factor was incorporated in the calculation of prediction errors, improving the positioning accuracy. According to the filtered posterior distance and speed values, the time for the vehicle to reach the threshold was predicted, solving the problem of control lag caused by discrete data acquisition and improving the reliability and timeliness of signal light locking. A remote state observer was used to evaluate the performance of signal light locking control. Based on statistics of the time domain automatic tracking, the quantitative evaluation of the locking reliability was realized. Simulation results demonstrated that after improving Kalman filter algorithm, the dynamic and static position errors of the vehicle were reduced by 25.67% and 27.19%, respectively, the dynamic and static speed errors were reduced by 25.28% and 34.73%, respectively. The logic response of the signal light threshold was faster. Results from underground industrial trials and applications showed that the success rate of underground signal locking was over 99.5% after using the strong tracking Kalman filter algorithm, which effectively improved the real-time performance and reliability of signal locking control of underground ramp intersections and ensured the safe driving of underground vehicles.
non-coal mine;underground ramp transportation;signal light locking control;UWB;vehicle positioning;signal light logic determination;strong tracking Kalman filter;state observer
主办单位:煤炭科学研究总院有限公司 中国煤炭学会学术期刊工作委员会