[发明专利]一种人机协作机械臂的碰撞识别方法

摘要

本发明公开了一种人机协作机械臂的碰撞识别方法，该方法包括利用基于PD控制的通用关节力矩控制器计算关节力矩命令值，并将关节力矩命令值发送至关节驱动器以控制机械臂执行期望轨迹规划动作；关节力矩命令值为关节力矩控制器在PD控制率作用下对期望关节力矩、期望关节转速和期望关节转角三个通道同时进行控制时所需要的力矩值；实时计算期望关节力矩与关节力矩命令值之间的关节力矩偏差值，并根据此差值计算碰撞能量值，且当碰撞能量值大于设定阈值时按照五阶多项式曲线规划机械臂的关节转角以控制机械臂执行避让动作。因此，采用本发明提供的碰撞识别方法，能够准确快速识别出发生在工业机械臂本体上任意位置处的碰撞。

主权项

1.一种人机协作机械臂的碰撞识别方法，其特征在于，所述碰撞识别方法包括：利用基于PD控制的通用关节力矩控制器计算关节力矩命令值，并将所述关节力矩命令值发送至关节驱动器以控制机械臂执行期望轨迹规划动作；所述关节力矩命令值为所述关节力矩控制器在PD控制率作用下对期望关节力矩、期望关节转速和期望关节转角三个通道同时进行控制时所需要的力矩值；所述期望关节力矩为采用机械臂关节逆动力学模型计算机械臂沿期望轨迹运动时的力矩；所述机械臂关节逆动力学模型为结合惯性力、科氏力、重力、以及非线性摩擦力的力矩计算模型；所述非线性摩擦力包括静摩擦力、线性粘性摩擦力和非线性粘性摩擦力；实时计算所述期望关节力矩与所述关节力矩命令值之间的关节力矩偏差值；根据所述关节力矩偏差值计算碰撞能量值，并当所述碰撞能量值大于设定阈值时按照五阶多项式曲线规划机械臂的关节转角以控制机械臂执行避让动作；所述五阶多项式曲线为q(t)＝k0+k1t+k2t2+k3t3+k4t4+k5t5；其中，kj,j＝0,...,5为关节轨迹规划参数；所述关节轨迹规划参数的值是根据虚拟反弹策略方程组计算得到；所述虚拟反弹策略方程组为q⁺、分别为机械臂在发生碰撞时的关节转角、关节转速和关节角加速度，T为机械臂执行避让动作所需要的时间。