关键词:
机器人动力学
参数辨识
人机交互
力估计
碰撞检测
牵引示教
自适应卡尔曼滤波
摘要:
工业环境中人机协作要求日益增多,如何能确保操作人员与机器人安全地共享作业空间以及实现流畅便捷的交互成为当前协作机器人面临的挑战难题。本文以小型工业机械臂为研究对象,在不使用外部传感器情况下实现碰撞检测及牵引示教的人机交互目标。以低成本方案实现人机共存、人机协作不但具有经济价值,同时可深化人机交互方面的理论研究。为此,本文针对无外部传感器的人机交互控制与碰撞检测研究中的机械臂动力学参数辨识、交互力观测器设计、碰撞检测以及人机交互控制等关键问题展开如下工作:准确的机械臂动力学模型是交互力估计的基础。针对动力学参数估计问题,提出一种结合鲁棒线性回归与最小二乘方差分量估计的动力学参数估计方法,在迭代估计中剔除不符合动力学模型的异常测量数据以提升辨识结果对异常数据的鲁棒性,并在合理假设关节力矩噪声方差矩阵结构后,得到力矩噪声方差的最佳线性无偏估计。此外,为保证辨识参数有物理意义,并在参数估计时考虑物理可行性约束。与此同时,为降低关节力矩测量噪声对参数辨识结果的影响,基于机械臂动力学参数辨识结果是每个关节独立辨识结果加权之和的分析思路,通过对关节子回归矩阵的优化得到了更加均衡的激励轨迹,并在理论上给出优化子回归矩阵的必要性。实验结果表明,利用所提动力学参数辨识及激励轨迹设计方法可提高动力学参数辨识准确性,有效地避免了交叉验证时关节力矩拟合精度的下降。与传统方法相比,交叉验证时关节力矩拟合均方根误差最多下降40.5%。为给人机交互控制及碰撞检测提供力信息,需设计扰动观测器估计交互作用力,为此提出一种新的自适应卡尔曼滤波算法用于估计作用力。首先借助对离散时间代数黎卡提方程的摄动分析,给出了待观测系统能否适用自适应卡尔曼滤波的判断依据,并给出了符合条件的交互力观测系统模型。然后基于噪声协方差不匹配对卡尔曼滤波性能影响的理论分析,结合斯坦因无偏风险估计,提出一种全新思路的自适应卡尔曼滤波算法,并讨论正则项对所提自适应卡尔曼滤波的影响。最后将自适应卡尔曼滤波应用到交互力矩估计上,通过仿真及实验表明,与已有的几种观测器估计结果相比,所提算法能自动平衡噪声放大及跟踪性能之间的权衡,交互力估计误差总体上最小。负载变化、摩擦系数改变等因素使得机械臂动力学模型存在误差,交互力观测结果存在不可忽视的残差对碰撞检测造成不利影响,为此提出一种基于自适应滤波的碰撞检测算法以应对模型不确定性。首先通过分析交互力矩估计残差,给出残差力矩合理简化的时变参数线性模型。然后采用方向遗忘递归最小二乘法解决弱激励条件下的时变参数估计问题,避免了传统自适应滤波算法(如指数遗忘递归最小二乘法)存在的估计饱和、参数发散问题。利用时变参数估计结果,得到交互力矩观测残差的滤波结果及自适应动态检测阈值,以此实现模型存在误差时的碰撞检测。在物理机械臂上实现无外部传感器的人机交互控制与碰撞检测验证。结合交互力矩观测结果和导纳控制,实现无外部传感器的机械臂交互控制。基于鲁棒性能优化,给出了导纳控制参数优化选取方法,并实现牵引示教的人机交互应用,在作业空间完成连续轨迹示教任务。实验结果表明,本文所提方法能在不借助力传感器的情况下实现流畅、稳定的牵引示教。在碰撞检测验证上,利用交互力矩的估计结果,对动力学模型较准确及带负载导致模型不准确的情形分别进行碰撞检测验证。当模型较准确时,采用简单阈值即可有效检测到最低20 N的碰撞力;而当机械臂增加负载而导致模型不精确时,利用所提自适应滤波碰撞检测方法可克服模型不确定性的干扰,实现对动态冲击力的检测。