Trajectory Tracking Algorithm Study of Coal Mine Water Detector Drilling Bar Installation

Abstract

Mechanical water detection is recognized as the most reliable and safe production technology for coal mines, mainly for the detection of water hazards in pre-mining operations. Intelligent water detectors are currently the main research direction in mechanical water detection, and the automatic installation of drilling bars is the key to achieving intelligent water detection. Improving the connection accuracy in the process of installing drilling bars is an important research topic for the improvement of control links. To improve the connection accuracy of the drilling bars at the time of supplying material, we used the modified Denavit–Hartenberg method to analyze the motion gestures of the supplied material device and the Lagrange equation to establish a dynamic analysis model. We aimed at better control precision by improving the sliding mode control algorithm and at increasing the convergence rate of tracking errors with a sliding controller based on an exponential approximation law and using saturated functions instead of the symbol functions in the reaching law to weaken the vibration in the control process. We then used particle swarm optimization (PSO) to find the optimum combination parameters of the sliding mode controllers and test the performance of the sliding mode controllers before and after PSO with MATLAB/Simulink. The results showed that the optimized controller has a strong resistance to parameter fluctuations, and the system responds quickly, achieves a good performance, and improves the convergence rate of tracking errors.