高级检索

欠约束临时支护机器人几何静力耦合模型及运动控制研究

Geometric static coupling model and motion control study of an under-constrained temporary support robot

  • 摘要: 护盾式智能掘进机器人系统有效的解决了煤矿开采中“采掘失衡、采快掘慢”难题。临时支护机器人作为该系统的重要组成部分,尽管在提升作业效率上发挥了重要作用,但由于结构限制,仅能实现竖直方向的升降运动,难以有效应对复杂巷道的临时支护作业。为解决临时支护机器人运动受限难题,设计了一种欠约束临时支护机器人,并提出了一种基于RBF神经网络分块逼近的终端滑模控制方法,以实现欠约束临时支护机器人的高精度运动控制。首先,利用修正的G–K公式对该机器人的自由度进行了分析,针对欠约束临时支护机器人正运动学难以求解问题,建立了几何静力耦合模型,提出了一种改进的蜣螂优化算法,对正/逆几何静力问题进行求解,并对几何静力问题进行了仿真;其次,设计了一种基于RBF神经网络分块逼近的终端滑模控制器。针对末端支护平台参数矩阵的不确定,使用多组RBF神经网络对其逼近,根据自适应律在线调整权值,实现了动力学模型的重构,并设计鲁棒项消除模型重构误差和外部扰动。为缓解控制器存在的抖振问题,设计了模糊系统自适应逼近切换增益来代替鲁棒项,并利用Lyapunov准则证明了控制系统的稳定性。最后,以平面圆轨迹为例进行仿真。结果表明:改进的蜣螂优化算法对正/逆运动学单点验证精度均小于10–20,连续运动学求解结果良好。使用RBF神经网络分块逼近的终端滑模控制方法对预定轨迹的位置跟踪误差为0 ~ 0.011 m,姿态跟踪误差为0 ~ 0.003 1°,与RBF神经网络整体逼近和PD控制相比最大跟踪误差分别减少了99.0%、95.5%,均方根误差分别减少了98.3%、96.5%。证明了基于RBF神经网络分块逼近的终端滑模控制方法能进一步提高欠约束临时支护机器人的运动控制精度,在受到外界干扰的情况下具有更强的鲁棒性。

     

    Abstract: The shield type intelligent tunneling robot system effectively solves the problem of "mining excavation imbalance, fast mining, and slow tunneling" in coal mining, as an important component of the system, temporary support robots play a crucial role in improving operational efficiency. However, due to structural limitations, the temporary support robots can only achieve vertical lifting movements, making it difficult to effectively cope with the temporary support operations of complex roadways. To solve the problem of limited motion of the temporary support robot, an under-constrained temporary support robot was designed, and a terminal sliding mode control method based on RBF neural network block approximation was proposed to achieve high-precision motion control of the under-constrained temporary support robot. Firstly, the modified G–K formula was used to analyze the degrees of freedom of the robot. In response to the difficulty in solving the forward kinematics of the under-constrained temporary support robot, a geometric static coupling model was established, and an improved dung beetle optimization algorithm was proposed to solve the forward and inverse geometric static problems, and simulations of the geometric static problems were carried out. Secondly, a terminal sliding mode controller based on RBF neural network block approximation was designed. Given the uncertainty of the parameter matrix of the end support platform, multiple sets of RBF neural networks were used to approximate it, and the weights were adjusted online according to the adaptive law to realize the reconstruction of the dynamic model, and a robust term was designed to eliminate the model reconstruction error and external disturbances. To alleviate the chattering problem of the controller, a fuzzy system was designed to adaptively approximate the switching gain to replace the robust term, and the stability of the control system was proved by using the Lyapunov criterion. Finally, a simulation was carried out with a planar circular trajectory as an example. The results show that the single-point verification accuracy of the improved dung beetle optimization algorithm for forward and inverse kinematics is less than 10–20, and the continuous kinematics solution results are good. The position tracking error of the terminal sliding mode control method using RBF neural network block approximation for the predetermined trajectory is 0−0.011 m, and the attitude tracking error is 0−0.003 1°. Compared with the overall approximation of the RBF neural network and PD control, the maximum tracking error is reduced by 99.0% and 95.5% respectively, and the root mean square error is reduced by 98.3% and 96.5% respectively. It is proved that the terminal sliding mode control method based on RBF neural network block approximation can further improve the motion control accuracy of the under-constrained temporary support robot and has stronger robustness under the condition of external interference.

     

/

返回文章
返回