[发明专利]机器人及其碰撞检测方法有效
申请号: | 201811382714.8 | 申请日: | 2018-11-20 |
公开(公告)号: | CN109834705B | 公开(公告)日: | 2023-06-02 |
发明(设计)人: | 原田镇郎 | 申请(专利权)人: | 发那科株式会社 |
主分类号: | B25J9/14 | 分类号: | B25J9/14;B25J9/16 |
代理公司: | 北京清亦华知识产权代理事务所(普通合伙) 11201 | 代理人: | 宋融冰 |
地址: | 日本*** | 国省代码: | 暂无信息 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 及其 碰撞 检测 方法 | ||
1.一种机器人,其特征在于,具备:
机器人主体,其具备至少一个臂;
气弹簧,其作为所述机器人主体的所述臂的平衡器发挥功能;
内压检测部,其检测所述气弹簧的气缸内压;以及
控制装置,其控制所述机器人主体,
所述控制装置,计算出对驱动所述臂的伺服马达的转矩命令值与实际上使所述臂进行动作所需的所述伺服马达的转矩的差分,作为推断干扰值,当所述推断干扰值超过预定的阈值时,判定所述机器人主体产生碰撞,并且基于由所述内压检测部检测到的所述气缸内压,校正所述推断干扰值或所述阈值。
2.根据权利要求1所述的机器人,其特征在于,
所述控制装置利用转矩变化量校正所述推断干扰值或所述阈值,所述转矩变化量基于由所述内压检测部检测到的所述气缸内压与处于填充有适量气体的状态下的所述气缸内压的差分。
3.根据权利要求1或2所述的机器人,其特征在于,
所述内压检测部为所述气弹簧所具备的压力传感器。
4.根据权利要求1或2所述的机器人,其特征在于,
所述内压检测部,将在填充有适量气体的状态下所述臂配置于预定的判定位置时的所述伺服马达的电流值作为基准值,并且基于所述臂配置于所述判定位置时的所述伺服马达的电流值与所述基准值的差分,推断所述气缸内压。
5.根据权利要求1或2所述的机器人,其特征在于,
所述内压检测部累计活塞相对于构成所述气弹簧的气缸的总动作距离,并根据累计的所述总动作距离推断所述气缸内压。
6.一种机器人的碰撞检测方法,其特征在于,包括:
内压检测步骤,检测气弹簧的气缸内压,所述气弹簧作为具备至少一个臂的机器人主体的所述臂的平衡器发挥功能;
干扰计算步骤,计算出对驱动所述机器人主体的所述臂的伺服马达的转矩命令值与实际上使所述臂进行动作所需的伺服马达的转矩的差分,作为推断干扰值;
校正步骤,基于通过所述内压检测步骤检测到的所述气缸内压,校正所述推断干扰值;以及
判定步骤,当通过所述校正步骤校正后的所述推断干扰值超过预定的阈值时,判定所述机器人主体产生碰撞。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于发那科株式会社,未经发那科株式会社许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201811382714.8/1.html,转载请声明来源钻瓜专利网。