Research on the strategy of motion constraint-aided ZUPT for the SINS positioning system of a shearer

Abstract

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.