Yang Hai, Li Wei, Luo Tao, Liang Haibo, Zhang He, Gu Yaxiong, Luo Chengming
School of Mechatronic Engineering, Southwest Petroleum University, Chengdu 610500, China.
School of Mechatronic Engineering, China University of Mining and Technology, Xuzhou 221116, China.
Micromachines (Basel). 2017 Nov 22;8(11):340. doi: 10.3390/mi8110340.
The accurate measurement of position and orientation for shearers is a key technology in realizing an automated, fully-mechanized, coal mining face. Since Global Positioning System (GPS) signal cannot arrive at the coal mine underground, wireless sensor network positioning system cannot operate stably in the coal mine; thus a strap-down inertial navigation system (SINS) is used to measure the position and orientation of the shearer. Aiming at the problem of the SINS accumulative error, this paper proposes a positioning error correction method based on the motion constraint-aided SINS zero velocity updated (ZUPT) model. First of all, a stationary state detection model of the shearer is built with median filter based on the acceleration and angular rate measured by the SINS. Secondly, the motion of the shearer is analyzed using coal mining technology, then the motion constraint model of the shearer is established. In addition, the alternate action between the motion constraint model and the ZUPT model is analyzed at the process of movement and cessation of the shearer, respectively; hence, the motion constraint-aided SINS ZUPT model is built. Finally, by means of the experimental platform of the SINS for the shearer, the experimental results show that the maximum position error with the positioning model proposed in this paper is 1.6 m in 180 s, and increases by 92.0% and 88.1% compared with the single motion constraint model and single ZUPT model, respectively. It can then restrain the accumulative error of the SINS effectively.
采煤机位置和姿态的精确测量是实现自动化、综采工作面的关键技术。由于全球定位系统(GPS)信号无法到达煤矿井下,无线传感器网络定位系统在煤矿中无法稳定运行;因此采用捷联惯性导航系统(SINS)来测量采煤机的位置和姿态。针对SINS累积误差问题,本文提出了一种基于运动约束辅助SINS零速修正(ZUPT)模型的定位误差校正方法。首先,基于SINS测量的加速度和角速率,利用中值滤波器建立采煤机静止状态检测模型。其次,运用采煤技术分析采煤机的运动,进而建立采煤机的运动约束模型。此外,分别在采煤机运动和停止过程中分析运动约束模型与ZUPT模型的交替作用;由此建立运动约束辅助SINS ZUPT模型。最后,通过采煤机SINS实验平台,实验结果表明,本文提出的定位模型在180 s内最大位置误差为1.6 m,与单一运动约束模型和单一ZUPT模型相比,分别增大了92.0%和88.1%。该模型能够有效抑制SINS的累积误差。