[发明专利]一种工业机器人碰撞检测方法、装置、电子设备及介质有效
申请号: | 201910163469.X | 申请日: | 2019-03-05 |
公开(公告)号: | CN110053043B | 公开(公告)日: | 2021-10-26 |
发明(设计)人: | 张铁;洪景东 | 申请(专利权)人: | 华南理工大学 |
主分类号: | B25J9/16 | 分类号: | B25J9/16 |
代理公司: | 广州粤高专利商标代理有限公司 44102 | 代理人: | 何淑珍;黄海波 |
地址: | 510640 广*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: |
本发明公开了一种工业机器人碰撞检测方法、装置、电子设备及介质,所述方法包括步骤:S1、当机器人处于稳定运动状态时,得到各关节的力矩误差曲线L;S2、设置针对各力矩误差曲线L的类包络曲线;S3、实时更新每个离散时间点各关节的上包络曲线L |
||
搜索关键词: | 一种 工业 机器人 碰撞 检测 方法 装置 电子设备 介质 | ||
【主权项】:
1.一种基于包络线的工业机器人碰撞检测方法,其特征在于,包括步骤:S1、当机器人处于稳定运动状态时,比较各关节的实时计算力矩与实际力矩得到各关节的力矩误差曲线L;S2、设置针对各力矩误差曲线L的类包络曲线,所述类包络曲线位于各力矩误差曲线L两侧,包括上包络曲线Lup和下包络曲线Ldown,并满足Ldown(k)≤L(k)和Lup(k)≥L(k),其中,k为时间点,L(k)为k时间点力矩误差曲线L对应的值,Lup(k)为k时间点上包络曲线对应的值,Ldown(k)为k时间点下包络曲线对应的值;S3、实时更新每个离散时间点各关节的上包络曲线Lup和下包络曲线Ldown,并计算每个离散时间点各关节的上包络曲线Lup和下包络曲线Ldown的差值;S4、当各关节的各关节的上包络曲线Lup和下包络曲线Ldown的差值都小于等于设定的碰撞检测阈值Lthr>0时,判定机器人没有碰撞发生,机器人保持预设的稳定运行状态并返回步骤S1;当各关节上包络曲线Lup和下包络曲线Ldown的差值都大于所述碰撞检测阈值Lthr时,则判定机器人存在碰撞并执行步骤S5;S5、暂停机器人的运动,显示发生碰撞的关节并报警。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于华南理工大学,未经华南理工大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201910163469.X/,转载请声明来源钻瓜专利网。