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

双悬臂截割机器人可解决传统单臂掘进机在截割大尺寸断面时效率低下的难题,但其与煤岩的动态交互影响控制性能。现有研究以双臂接触同一对象形成运动闭链为前提,无法满足双悬臂截割机器人双臂运动及末端截割头输出力的控制要求。针对该问题,设计了一种基于机器人相对动力学模型的力位混合控制系统。建立双悬臂截割机器人运动学和动力学模型,基于机器人的相对雅可比矩阵及虚位移与虚功原理推导出机器人的相对动力学模型,通过单一变量同时描述机器人双臂的运动状态,将机器人双臂独立的动力学模型整合为一个整体。基于机器人的相对动力学模型,设计了机器人双臂力位混合控制系统,通过李雅普诺夫函数验证了系统的稳定性和可行性。仿真结果表明:双悬臂截割工艺较单悬臂截割拥有更大的工作空间,具有一次性实现大断面截割的能力;双悬臂截割机器人力位混合控制系统能够完成对期望相对位置和期望相对力的同步跟踪,对截割头期望位置跟踪的绝对误差在0.3132 m以内,均方根误差为0.1447 m。