双悬臂截割机器人相对动力学建模与力位混合控制研究  

Relative dynamics modeling and force-position hybrid control of dual-arm cutting robot

作　　者：刘鹏[1,2,3] 周昊晨 马宏伟[1,2] 曹现刚 张旭辉[1,2] 段学超 毛清华[1,2] 田海波 薛旭升[1,2] 王川伟 LIU Peng;ZHOU Haochen;MA Hongwei;CAO Xiangang;ZHANG Xuhui;DUAN Xuechao;MAO Qinghua;TIAN Haibo;XUE Xusheng;WANG Chuanwei(College of Mechanical Engineering,Xi'an University of Science and Technology,Xi'an 710054,China;Shaanxi Key Laboratory of Mine Electromechanical Equipment Intelligent Detection and Control,Xi'an 710054,China;Key Laboratory of Electronic Equipment Structure Design of Ministry of Education,Xidian University,Xi'an 710000,China)

机构地区：[1]西安科技大学机械工程学院,陕西西安710054 [2]陕西省矿山机电装备智能检测与控制重点实验室,陕西西安710054 [3]西安电子科技大学电子装备结构设计教育部重点实验室,陕西西安710000

出　　处：《工矿自动化》2024年第10期80-89,共10页Journal Of Mine Automation

基　　金：陕西省教育厅服务地方专项项目(23JC053);陕西省自然科学基础研究计划面上项目(S2024-JC-YB-2526)。

摘　　要：双悬臂截割机器人可解决传统单臂掘进机在截割大尺寸断面时效率低下的难题,但其与煤岩的动态交互影响控制性能。现有研究以双臂接触同一对象形成运动闭链为前提,无法满足双悬臂截割机器人双臂运动及末端截割头输出力的控制要求。针对该问题,设计了一种基于机器人相对动力学模型的力位混合控制系统。建立双悬臂截割机器人运动学和动力学模型,基于机器人的相对雅可比矩阵及虚位移与虚功原理推导出机器人的相对动力学模型,通过单一变量同时描述机器人双臂的运动状态,将机器人双臂独立的动力学模型整合为一个整体。基于机器人的相对动力学模型,设计了机器人双臂力位混合控制系统,通过李雅普诺夫函数验证了系统的稳定性和可行性。仿真结果表明:双悬臂截割工艺较单悬臂截割拥有更大的工作空间,具有一次性实现大断面截割的能力;双悬臂截割机器人力位混合控制系统能够完成对期望相对位置和期望相对力的同步跟踪,对截割头期望位置跟踪的绝对误差在0.3132 m以内,均方根误差为0.1447 m。The dual-arm cutting robot addresses the low efficiency of traditional single-arm roadheaders when cutting large cross-sections.However,its dynamic interaction with coal-rock affects control performance.In current studies,both arms of the dual-arm cutting robot interact with the same object,forming a closed kinematic chain,which fails to meet the control requirements for independent arm movement and the output force of each cutting head.To solve this issue,a force-position hybrid control system based on the robot's relative dynamics model was designed.The kinematic and dynamics models of the dual-arm cutting robot were established,with the relative dynamics model derived using the robot's relative Jacobian matrix and principles of virtual displacement and virtual work.This model used a single variable to describe the motion states of both arms,integrating their independent dynamics models into a unified one.Based on this relative dynamics model,a force-position hybrid control system was developed for the robot's dual arms,with system stability and feasibility verified via the Lyapunov function.Simulation results indicated that the dual-arm cutting process had a larger workspace compared to single-arm cutting,allowing for efficient large cross-section cutting.The force-position hybrid control system enabled synchronized tracking of expected relative position and force,with the absolute error in tracking the target cutter position kept within 0.3132 m and a root mean square error of 0.1447 m.

关 键 词：巷道掘进 双悬臂截割机器人 力位混合控制 相对动力学 相对雅可比矩阵 

分 类 号：TD632[矿业工程—矿山机电]