基于改进滑模控制的锚杆钻臂轨迹跟踪控制研究

Trajectory tracking control of anchor bolt drilling boom based on improved sliding mode control

  • 摘要: 煤矿锚杆钻臂轨迹跟踪控制精度对支护作业效率和安全性具有重要影响。针对煤矿井下锚杆钻臂液压系统非线性、时滞及参数时变特性导致的轨迹跟踪精度不足问题,提出了一种基于迭代学习补偿的滑模自抗扰控制(ILC−SMADRC)算法。基于D−H参数法建立了锚杆钻臂六自由度运动学模型,并采用五次多项式插值规划平滑轨迹;设计了高阶扩张状态观测器(ESO),实现系统状态及扰动的精确估计;提出基于瑞利分布函数与tanh函数构造的新型滑模趋近律,以有效抑制高频抖振;结合迭代学习补偿提高轨迹跟踪精度和鲁棒性,通过李雅普诺夫准则证明系统的稳定性。仿真结果表明,与传统PID和滑模控制(SMC)方法相比,ILC−SMADRC算法的时间乘绝对误差积分分别降低83.5%和59.2%,其中关节6跟踪误差较SMC降低96.8%,显著提升了锚杆钻臂在井下复杂工况下的运动控制精度与稳定性。

     

    Abstract: The trajectory tracking control accuracy of coal mine anchor bolt drilling booms has an important impact on the efficiency and safety of support operations. To address the insufficient trajectory tracking accuracy caused by the nonlinearity, time delay, and time-varying parameters of the hydraulic system of underground coal mine anchor bolt drilling booms, an Iterative-Learning-Compensation-Based Sliding-Mode Active Disturbance Rejection Control (ILC-SMADRC) algorithm was proposed. A six-degree-of-freedom kinematic model of the anchor bolt drilling boom was established based on the D-H parameter method, and smooth trajectories were planned using quintic polynomial interpolation. A high-order Extended State Observer (ESO) was designed to achieve accurate estimation of system states and disturbances. A novel sliding mode reaching law constructed based on the Rayleigh distribution function and the tanh function was proposed to effectively suppress high-frequency chattering. Iterative learning compensation was incorporated to improve trajectory tracking accuracy and robustness, and system stability was proven using the Lyapunov criterion. Simulation results showed that, compared with conventional PID and Sliding Mode Control (SMC) methods, the cumulative absolute error of the ILC-SMADRC algorithm was reduced by 83.5% and 59.2%, respectively, with the error of joint 6 reduced by 96.8% compared with SMC, significantly enhancing the motion control accuracy and stability of the anchor bolt drilling boom under complex underground operating conditions.

     

/

返回文章
返回