关键词:
动力学建模
导纳控制
柔顺控制
轴孔装配
摘要:
随着装配机器人技术的不断发展,越来越需要机器人完成一些与环境接触力有着极高的控制要求的任务,例如抛光、打磨、孔轴装配等。利用机器人实现自动的环境柔顺性控制作业,不仅能避免装配零件之间过大的接触力,还能增加机器人作业时在不精确的目标环境下的适应性,降低对位置精度的控制成本。由于目前国内工业装配机器人大多执行单纯的位置控制操作任务,针对力接触主动柔顺控制的应用,例如装配及擦拭等工业作业,仍然存在应用性不高等问题,大多未投入到实际工业使用中。因此,主动柔顺控制系统的研究与应用是实现智能控制亟待解决的重要问题。本文利用导纳控制实现了基于位置的力反馈综合控制,研究并搭建了基于主动柔顺控制的机器人装配系统,主要工作内容如下:首先,分别建立并验证了机械臂的运动学和动力学模型。在机械臂运动学建模基础上,仿真验证了运动学模型的正确性。针对出现的反解结果不唯一且解析解对任意构形的机器人不具有通用性等问题,提出一种新的基于退火-梯度下降混合算法的机械臂运动学反解算法,解决了反解过程中奇异性和冗余度等问题;在动力学模型方面,对比分析了机器人的动力学模型和ADAMS三维动力学仿真模型,提出了通过修正的数学补偿模型来拟合动力学方法存在的误差,提高动力学模型的精度,为控制系统的稳定控制提供了有效的理论基础。其次,根据柔顺控制原理,在位置PD控制基础上,分别引入不同的外环柔顺控制算法,将直接力反馈、阻抗控制和导纳控制分别进行对比分析,分析各参数对控制指标的影响,使用交叉验证的方法总结了各柔顺控制算法的控制效果。根据控制算法存在的缺点,引入动态S型衰减因子,分别基于修正量和运行时间各提出一种修正的导纳控制模型,解决了导纳控制模型不能同时满足较小稳态误差和较小超调量的问题,实现了对导纳动态控制的有效调节,具有较强的稳定性。针对两种修正模型,分别分析了其突变发生可能性和参数可控性,合理分析了两种修正模型的利弊,实现对模型的修正。再次,针对轴孔装配过程,开展轴孔装配策略研究。分析轴孔装配过程的数学模型,将装配过程分成寻孔和装配两个阶段,在寻孔阶段根据接触力与接触力矩的正比关系,设计了一种基于等效力臂的变步长寻孔方法,解决孔的对中问题,加速寻孔过程;在轴孔装配阶段,分析基础受力模型并模拟装配过程的运动状态,然后提出了轴孔装配控制策略。最后,根据控制策略搭建主动柔顺控制系统实验平台,开展柔顺性实验验证工作。设计并搭建了主动柔顺控制系统的硬件结构、软件框架及通信系统,分别进行了三维任意力作用下跟随运动实验、末端沿着不同刚度及不同形状斜面运动的柔顺环境适应性实验和柔顺控制插孔实验,有效验证了所提出的柔顺控制算法和轴孔装配策略。