一种机器人碰撞检测阈值更新方法、装置与存储介质制造方法及图纸

本发明专利技术涉及机器人技术领域，具体为一种机器人碰撞检测阈值更新方法、装置与存储介质，方法包括：通过指令或人机交互界面的方式发送是否进行阀值更新指令；阀值更新时，通过控制器获取一系列连续控制周期内的各个关节力矩误差和实际运动状态参数s，并根据关节力矩误差情况及运动状态参数s，建立误差的上下边界的包络线拟合模型E；通过指令或人机交互界面的方式发送是否停止阀值更新指令；通过指令或人机交互界面的方式发送是否开启碰撞检测指令。本发明专利技术克服了动力学模型中参数时变性以及运动和负载条件变化等带来的动力学模型预测力矩的精度下降，预测误差边界变化等问题。预测误差边界变化等问题。预测误差边界变化等问题。

【技术实现步骤摘要】
一种机器人碰撞检测阈值更新方法、装置与存储介质


[0001]本专利技术涉及机器人
，具体为一种机器人碰撞检测阈值更新方法、装置与存储介质。

技术介绍

[0002]碰撞检测技术是机器人
被广泛关注的技术问题之一。当机器人于周围作业环境发生意外碰撞时，及时的停止或柔性调结可以保护设备和人员，同时也能降低机器人损伤的风险。工业机器人不同于协作机器人，通常不具备关节力矩传感器，而基于视觉、电子皮肤等的解决方案，同样要求增加额外的传感设备。因此，基于电机电流的碰撞检测方案具有很高的研究价值和广阔的应用前景。基于电机电流的碰撞检测方案，通常需要根据事先建立好的机器人动力学模型，预测机器人实际运动状态下的关节力矩，并与关节电机电流估计的实际力矩对比，当二者的误差超出设定的阈值时则视为机器人发生碰撞。
[0003]由于机器人运行环境条件的改变，如温度引起的摩擦增大，机器人引导的不同的载荷，或变化的位姿和不同的运动速度与加速度等，都会使基于机器人动力学模型的关节力矩估计精度表现出不同的品质。
[0004]在此条件下根据关节力矩预测误差本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种机器人碰撞检测阈值更新方法，其特征在于：包括以下步骤：(一)通过指令或人机交互界面的方式发送是否进行阀值更新指令，若是，则进行步骤(二)，若否，则进行步骤(四)；(二)阀值更新时，通过控制器获取一系列连续控制周期内的各个关节力矩误差和实际运动状态参数s，并根据关节力矩误差情况及运动状态参数s，建立误差的上下边界的包络线拟合模型E；(三)通过指令或人机交互界面的方式发送是否停止阀值更新指令，若是，则停止阀值更新，并将更新后的包络线拟合模型E结果存储，若否，则返回至步骤(二)；(四)通过指令或人机交互界面的方式发送是否开启碰撞检测指令，若是，则将关节的当前运动状态参数s代入步骤(二)中的包络线拟合模型E中，计算得到此时的力矩误差的上、下边界的阀值，若否，则进行步骤(六)；(五)将步骤(四)中得到的力矩误差的上、下边界的阀值与单个或者连续多个周期的关节力矩预测误差值进行比较，判断是否发生碰撞，若是，则停机或调整机器人柔性，并进行步骤(六)，若否，则进入下一系统周期，并返回至步骤(四)；(六)结束。2.根据权利要求1所述的一种机器人碰撞检测阈值更新方法，其特征在于：步骤(二)中运动状态参数包括关节运动速度、加速度、位置。3.根据权利要求1所述的一种机器人碰撞检测阈值更新方法，其特征在于：步骤(三)中力矩误差的上边界的阀值为：τ
th+
＝E
+
(s)。4.根据权利要求1所述的一种机器人碰撞检测阈值更新方法，其特征在于：步骤(三)中力矩误差的下边界的阀值为：...

【专利技术属性】
技术研发人员：毛大超，储昭琦，党进，肖永强，游玮，
申请(专利权)人：埃夫特智能装备股份有限公司，
类型：发明
国别省市：