Pose Detection and Automatic Deviation Correction Control Strategy of Crawler Walking Equipment in Coal Mines

Abstract

Autonomous navigation technology is the basis of underground crawler walking equipment automation. Based on research of the sector laser pose parameter detection method, a pose detection system based on a cross laser is proposed. The mathematical model between pose parameters, laser receiver measurement data and tilt sensor measurement data is established by vector algorithm and the expression of key pose parameters is deduced. This paper studies the deviation correction control strategy of crawler walking equipment and puts forward the point deviation correction control strategy based on roadway excavation technology. Firstly, the end position of the path is determined according to the initial pose of the roadheader. Then, Bessel curve is used to plan the path between the starting point and the endpoint, and the pure tracking algorithm is used to track the planned path. The measurement errors of X and Y coordinates and yaw angle of roadheader within 10 80 m shall not exceed 10 mm, 32 mm and 0.65°. Using the point deviation correction strategy, the positioning error of the roadheader at the end of the path is less than 13 mm, and the yaw angle error is less than 0.16°. In the deviation correction process, the maximum angular velocity of the roadheader is 0.07 rad/s, which is less than 0.82 rad/s of the conventional deviation correction strategy. The results show that the point deviation correction strategy can not only ensure the accuracy of motion control, but also improve the stability of equipment motion.