基于非完整性约束的采煤机定位方法
宋单阳1
杨金衡1
陶心雅2
卢春贵1
田慕琴1
宋建成1
1.太原理工大学矿用智能电器技术国家地方联合工程实验室,山西太原 0300242.太原科技大学电子信息工程学院,山西太原 030024
摘要：目前基于惯性导航系统和里程计组合的采煤机定位方法直接用里程计输出对惯性导航系统推算得到的采煤机前进速度进行修正,但抑制惯性导航系统误差发散的能力非常有限.采煤机在运动过程中满足非完整性约束的特点,即在采煤机不发生跳跃和侧滑的情况下,牵引齿轮和履带连接处的侧向和垂向速度为零.基于该特点,在惯性导航系统和里程计组合定位的基础上,提出了一种基于非完整性约束的采煤机定位方法.安装于采煤机机身中部的惯性测量单元输出经机械编排获得采煤机姿态、速度和位置信息;安装于采煤机牵引齿轮上的里程计输出用于计算采煤机瞬时速度.使用惯性导航系统的机械编排结果和误差传播模型建立卡尔曼滤波状态方程,在采煤机牵引齿轮和履带的连接处引入非完整性约束,利用惯性导航系统投影在连接处的速度与里程计输出的速度之差作为观测向量,建立卡尔曼滤波观测方程;将卡尔曼滤波算法处理后的结果作为误差反馈,对惯性导航系统的输出进行修正,得到采煤机姿态、速度和位置的最优估计.实验结果表明,相较于传统惯性导航系统和里程计组合的定位方法,加入非完整性约束后定位误差没有随时间发散,对实际轨迹具有良好的追踪性能;采煤机在前向、侧向、垂向上的定位误差分别降低了 66％,62％,67％.
关键词：采煤机定位惯性导航系统里程计非完整性约束卡尔曼滤波
分类号：TD679(矿山电工)
资助基金：山西省重点研发计划项目(202102010101005)
论文发表日期：2022-07-10
在线出版日期：2025-08-15（本平台首次上网日期，不代表文献的发表时间）
页数：6( 52-57 )
英文信息