关键词:
协作机器人
柔顺控制
无力传感外力估计
动力学
参数辨识
摘要:
随着我国制造业往智能化的方向发展,机器人的应用场景日益广泛。传统的工业机器人大多采用位置控制模式,主要追求较高精度的轨迹跟踪和重复定位,而当下社会的发展对机器人提出了更高的期望,需要其在工作空间中独立或配合完成精密装配、抛光打磨、人机协作等与外界产生交互的任务,这就要求机器人必须具备一定的交互能力,单靠机器视觉并不能可靠的实现这一目标,所以力控技术是机器人发展的重要方向之一。要实现力控,机器人具备感知外力的能力至关重要,传感器通常是测量物理量的首要选择,但是高精度的机器人力或力矩传感器价格不菲,直接使用力传感器将大幅增加控制成本,所以低成本的外力估计方法是机器人技术的研究热点之一。
要实现无力传感器的外力检测,必须依赖于准确的机器人动力学模型,模型中参数的准确与否将直接影响动力学计算的准确度,而较准确的动力学参数通常无法直接得到,需要通过参数辨识实验获取。当机器人检测到外力后,如何应对也是力控技术中的关键一环,综上,为实现无力传感器的外力估计,主要展开了以下几个方面的研究:
(1)以Xarm6协作机器人为研究对象,采用拉格朗日法对其进行动力学建模,得到标准的机器人动力学方程,然后对其线性化,变换为观测变量矩阵乘以最小参数集的形式。再引入关节摩擦模型,进一步提高动力学模型的准确性。
(2)用五阶傅里叶级数设计并优化激励轨迹对Xarm6协作机器人进行充分激励,然后用线性化动力学方程和加权最小二乘法根据采集并滤波处理后的数据进行离线动力学参数辨识。先通过MATLAB和CoppeliaSim软件联合仿真验证了线性化动力学模型的正确性和参数辨识方法的可行性,再对Xarm6协作机器人进行了参数辨识,进一步说明辨识方法的正确性。另外,用快速动力学参数辨识的方法确定出低速运动状态下的Xarm6协作机器人的模型参数,并通过实验说明了该方法的可行性和低速动力学模型的正确性。
(3)根据完整动力学模型,设计外力观测器实现对外力的估计。本文提出了一种将基于逆动力学和广义动量偏差外力观测器结合的方法,可以兼顾两种方法的优势并互补各自的不足,通过仿真实验说明了该方法的有效性。另外,根据低速动力学模型设计了基于逆动力学的外力观测器,通过Xarm6协作机器人实验平台说明了低速下该外力观测器的有效性。
(4)基于外力估计结果和阻抗思想,设计了导纳控制器,对机器人进行柔顺控制以实现与环境的良好交互,通过仿真实现了基于外力估计的柔顺控制,检验了该外力估计方法的可行性和实用性。