4UPU−PU−RRU龙门履带式临时支护机器人位姿控制方法

Posture control method for 4UPU−PU−RRU gantry-tracked temporary support robot

  • 摘要: 为保证煤矿巷道掘进中掘锚并行作业的安全高效实施,临时支护需在永久支护完成前有效控制顶板悬空暴露导致的冒顶、片帮高风险。针对这一需求,研发了一种具备位姿自适应能力的龙门履带式临时支护机器人。该装备旨在解决垂直下沉、沿掘进方向倾斜、沿水平方向倾斜及其复合变形等复杂顶板工况下的快速、稳定支护需求。通过构建4UPU−PU−RRU并联机构的运动学模型,采用几何法进行逆运动学求解,并利用基于雅可比矩阵的Newton−Raphson迭代实现正运动学的快速计算,实时映射目标支护位姿与4个支护电缸的伸缩量。设计了基于双闭环PID (Proportional-Integral-Derivative)控制框架的PLC (Programmable Logic Controller)+伺服驱动控制系统。该系统利用倾角传感器实时反馈位姿偏差,通过PLC逆解模型计算实时所需的电缸伸缩补偿量,运用双闭环PID算法驱动伺服电机实现位姿的快速、精准自适应调整。基于1∶5缩尺原理样机的实验验证结果显示:在阶跃响应实验下,系统位姿角控制误差(X轴≤0.024°,Y轴≤0.036°)与响应时间(≤1.1 s)满足严苛精度与实时性要求;在模拟动态复合变形工况下,X轴最大误差值为0.89°,最大平均绝对误差值为0.26°,最大均方根误差为0.32°;Y轴最大误差值为1.00°,最大平均绝对误差值为0.26°,最大均方根误差为0.33°。结果表明:所研发的系统能够有效适应复杂多变的顶板变形,确保支护顶板与巷道顶板紧密贴合。通过理论建模、系统设计与实验验证,为煤矿巷道掘锚并行作业提供了高效、安全的智能化临时支护技术方案,对推动掘进作业向智能化、安全化方向发展具有重要实践意义。

     

    Abstract: To ensure safety and efficiency during simultaneous excavation and bolting in coal mine roadways, temporary support must control the risk of roof collapse caused by unsupported roof exposure prior to permanent support completion. A gantry-type tracked temporary support robot with posture-adaptive capability has been developed to provide rapid and stable support under complex roof conditions, including vertical subsidence, longitudinal and lateral inclinations, and their composite deformations. A kinematic model of a 4UPU−PU−RRU parallel mechanism was established, in which inverse kinematics was solved geometrically and forward kinematics was computed efficiently using a Jacobian-based Newton–Raphson iterative method, enabling real-time mapping between the target support posture and the extensions of four electric cylinders. A PLC-based servo control system with a dual-loop PID framework was designed, using tilt sensor feedback and inverse kinematics to compute real-time compensation values for precise posture adjustment. Tests on a 1∶5 scale prototype showed that under step response, the posture angle error (X-axis ≤ 0.036°, Y-axis ≤ 0.024°) and response time (≤1.1 s) satisfied strict requirements. Under simulated dynamic composite deformation, the maximum error was 0.89°, with mean absolute and root mean square errors below 0.26° and 0.33°, respectively, demonstrating effective adaptation to variable roof deformations and ensuring tight support-roof contact. An intelligent temporary support solution is provided, contributing to safer and more intelligent tunneling operations.

     

/

返回文章
返回