CN110977972B - 一种多关节机器人碰撞检测方法、计算机可读存储介质及机器人 - Google Patents
一种多关节机器人碰撞检测方法、计算机可读存储介质及机器人 Download PDFInfo
- Publication number
- CN110977972B CN110977972B CN201911222850.5A CN201911222850A CN110977972B CN 110977972 B CN110977972 B CN 110977972B CN 201911222850 A CN201911222850 A CN 201911222850A CN 110977972 B CN110977972 B CN 110977972B
- Authority
- CN
- China
- Prior art keywords
- robot
- current
- joint robot
- detection method
- collision detection
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/0095—Means or methods for testing manipulators
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种多关节机器人碰撞检测方法、计算机可读存储介质及机器人,通过检测多关节机器人各轴驱动电机转矩电流获得电流信息,计算分析电流信息判断多关节机器人是否发生碰撞,当检测到的电流突然增大且短时间内累计能量超过设定阈值,或谐波含量急剧增大,则判定碰撞产生并调整机器人工作状态。在不增加硬件检测的情况下,通过机器人本身自带的电流检测模块实时检测电流,依据新增的判断逻辑准确判断机器人是否发生碰撞,保障了机器人减速机及本体结构不受损害。
Description
技术领域
本发明涉及多关节机器人技术领域,具体涉及一种多关节机器人碰撞检测方法、计算机可读存储介质及机器人。
背景技术
工业机器人常用于车间流水线,在实际运行中可能会因上位运动控制器轴限位参数设置不当或人员操作不当等原因使其运行范围超出安全空间,导致其机械臂与流水线其他装置产生碰撞,造成机器人减速机和机械本体损坏,甚至可能会伤到产线工人,后果严重。
当前对工业现场机器人碰撞检测方法并不完善,常用的方法有:采用视觉传感器、距离检测传感器或压力传感器安置于六轴机器人轴端,探测机械臂与障碍物的距离,一旦距离过小则停机报警。以上方法实现方式复杂,成本较高,且可能会误报故障。
发明内容
针对现有技术的不足,本发明提出了一种新的多关节机器人碰撞检测方法,可以有效防止多关节机器人因误碰撞造成本体机械结构损坏或人员伤害。
为实现上述目的,本发明采用如下技术方案:
一种多关节机器人碰撞检测方法,通过检测多关节机器人各轴驱动电机转矩电流获得电流信息,计算分析电流信息判断多关节机器人是否发生碰撞,当检测到的电流突然增大且短时间内累计能量超过设定阈值,或谐波含量急剧增大,则判定碰撞产生并调整机器人工作状态。在不增加硬件检测的情况下,通过机器人本身自带的电流检测模块实时检测电流,依据新增的判断逻辑准确判断机器人是否发生碰撞,保障了机器人减速机及本体结构不受损害。
进一步的,所述计算分析电流信息判断多关节机器人是否发生碰撞具体为:通过检测多关节机器人任一轴驱动电机转矩电流Iq,当Iq>If,计算转矩电流Iq和额定电流Ir差值的积分量Q1,计算If和额定电流Ir差值的积分量Q2,当Q1>Q2,则判定多关节机器人发生碰撞,其中If为预设电流阈值。设定了两个判断条件,只有同时满足两个判断条件才能判定机器人发生碰撞,当Iq>If表明电机电流突然增大了,当Q1>Q2表明短时间内累计能量已经超过阈值,此时可以更准确判定是碰撞发生,实时检测判断避免了误判或漏判的情况发生。
进一步的,所述计算分析电流信息判断多关节机器人是否发生碰撞具体为:通过检测多关节机器人任一轴驱动电机转矩电流,计算该轴电机U相电流的谐波含量,当谐波含量大于X,则判定多关节机器人发生碰撞,其中X为预设的百分比值。
进一步的,所述计算Iq和额定电流Ir差值的积分量Q1具体公式为:Q1=∫(Iq-Ir)dt;所述计算If和额定电流Ir差值的积分量Q2具体公式为:Q2=∫(If-Ir)dt。通过微积分函数公式可以准确计算出实时检测电流的累计能量,以及设定的累计能量,通过累计能量比较判断,可以更加精准判断,相较于直接通过电流判断避免了某一时刻电流突然变大某一时刻电流突然变小误判的情况发生。
进一步的,所述该轴电机U相电流的谐波含量具体为:将电流信号进行离散数字化采样,经内部的微处理器执行谐波计算功能,计算出0-N次谐波,谐波含量是从交流量中减去基波分量后除以交流量得到的值,即谐波含量=(交流量-基波分量)/交流量 *100% 。
进一步的,所述判定碰撞产生并调整机器人工作状态具体为:当检测到机器人发生碰撞,立即断伺服使能,电机断电,延时y ms后给电机刹车信号使电机抱闸,其中y为预设常量值。及时调整机器人的工作状态,保证了机器人发生的第一时间制动停机,防止机器人本体受损或对人员造成伤害。
一种多关节机器人,包括控制柜、线缆及机械本体,所述控制柜通过所述线缆与所述机械本体相连接,所述控制柜包括有伺服驱动器和运动控制器,所述线缆与所述伺服驱动器相连,所述线缆和所述运动控制器相连,所述伺服驱动器包括处理器和存储器,所述存储器用于存储计算机程序,所述计算机程序被所述处理器调用时实现以上任一项所述的多关节机器人碰撞检测方法。其中运动控制器规划机器人的运行轨迹,并将位置指令给定到伺服驱动器,伺服驱动器按位置指令的要求,对功率进行放大、变换与调控等处理控制伺服电机运行,实现高精度的传动系统定位。
一种计算机可读存储介质,用于存储计算机程序,所述计算机程序被处理器调用时实现以上任一项所述的多关节机器人碰撞检测方法。
一种机器人,包括处理器和存储器,所述存储器用于存储计算机程序,所述计算机程序被所述处理器调用时实现以上任一项所述的多关节机器人碰撞检测方法。
本发明提供的一种多关节机器人碰撞检测方法、计算机可读存储介质及机器人的有益效果在于:以一种低成本且简单有效的方法检测机器人碰撞,保障机器人减速机及本体结构不受损坏,保证车间产线工人人身安全。
附图说明
图1为本发明流程示意图;
图2为本发明多关节机器人结构示意图;
图3为本发明碰撞停机时序图;
图4为本发明负载激增时电流变化波形图。
图中:1、控制柜;2、线缆;3、机械本体。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整的描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。本领域普通人员在没有做出创造性劳动前提下所获得的所有其他实施例,均属于本发明的保护范围。
实施例1:一种多关节机器人碰撞检测方法。
如图1所示,一种多关节机器人碰撞检测方法,具体步骤如下:
本实施例应用于六轴机器人的碰撞检测,当六轴机器人机械臂与外部发生碰撞时,相当于驱动各个轴运动的电机负载突然加大甚至发生电机堵转,流过定子线圈的电流会快速增加,根据电机容量和加工工艺不同,负载激增时电流一般会达到电机额定电流的5-12倍,如图4所示。
通过伺服驱动器中电流采样芯片采集六轴机器人各轴驱动电机转矩电流Iq(Iq1,Iq2...Iq6),当某个(或几个)轴电机电流突然增大超过设定的快速过载电流阈值If(If1,If2...If6,该值根据实际设定,改变该值相当于改变判断机器人碰撞条件的灵敏度)时,计算该轴电流Iq与额定电流Ir差值的积分量Q1,和该轴快速过载电流阈值If和额定电流Ir差值的积分量Q2 ,同时计算该轴电机U相电流的谐波含量。
当Q1>Q2或谐波含量>10%时判定此时产生碰撞,对机器人进行停机防碰撞处理。
如图3所示,机器人碰撞后,根据碰撞停机时序图对机器人进行停机。当检测到机器人发生碰撞,立即断伺服使能,电机断电,延时150ms后给电机刹车信号使电机抱闸,通常电机抱闸实际吸合时间约为100ms,根据此时序图可使六轴机器人在碰撞后的250ms内完成制动停机。
实施例2:一种多关节机器人。
图如2所示,一种多关节机器人,包括控制柜1、线缆2及机械本体3,所述控制柜1通过所述线缆2与所述机械本体3相连接,所述控制柜1包括有伺服驱动器和运动控制器,所述线缆2与所述伺服驱动器相连,所述线缆2和所述运动控制器相连,其中运动控制器规划机器人的运行轨迹,并将位置指令给定到伺服驱动器,伺服驱动器按位置指令的要求,对功率进行放大、变换与调控等处理控制伺服电机运行,实现高精度的传动系统定位,所述伺服驱动器包括处理器和存储器,所述存储器用于存储计算机程序,所述计算机程序被所述处理器调用时实现实施例1所述的多关节机器人碰撞检测方法。
实施例3:一种计算机可读存储介质。
一种计算机可读存储介质,用于存储计算机程序,所述计算机程序被处理器调用时实现实施例1所述的多关节机器人碰撞检测方法。
实施例4:一种机器人。
一种机器人,包括处理器和存储器,所述存储器用于存储计算机程序,所述计算机程序被所述处理器调用时实现实施例1所述的多关节机器人碰撞检测方法。
以上所述为本发明的较佳实施例而已,但本发明不应局限于该实施例和附图所公开的内容,所以凡是不脱离本发明所公开的精神下完成的等效或修改,都落入本发明保护的范围。
Claims (9)
1.一种多关节机器人碰撞检测方法,其特征在于,通过检测多关节机器人各轴驱动电机转矩电流获得电流信息,计算分析电流信息判断多关节机器人是否发生碰撞,当检测到的电流突然增大且短时间内累计能量超过设定阈值,或谐波含量急剧增大,则判定碰撞产生并调整机器人工作状态。
2.如权利要求1所述的多关节机器人碰撞检测方法,其特征在于,所述计算分析电流信息判断多关节机器人是否发生碰撞具体为:通过检测多关节机器人任一轴驱动电机转矩电流Iq,当Iq>If,计算转矩电流Iq和额定电流Ir差值的积分量Q1,计算If和额定电流Ir差值的积分量Q2,当Q1>Q2,则判定多关节机器人发生碰撞,其中If为预设电流阈值。
3.如权利要求1所述的多关节机器人碰撞检测方法,其特征在于,所述计算分析电流信息判断多关节机器人是否发生碰撞具体为:通过检测多关节机器人任一轴驱动电机转矩电流,计算该轴电机U相电流的谐波含量,当谐波含量大于X,则判定多关节机器人发生碰撞,其中X为预设的百分比值。
4.如权利要求2所述的多关节机器人碰撞检测方法,其特征在于,所述计算Iq和额定电流Ir差值的积分量Q1具体公式为:Q1=∫(Iq-Ir)dt;所述计算If和额定电流Ir差值的积分量Q2具体公式为:Q2=∫(If-Ir)dt。
5.如权利要求3所述的多关节机器人碰撞检测方法,其特征在于,所述该轴电机U相电流的谐波含量具体为:将电流信号进行离散数字化采样,经内部的微处理器执行谐波计算功能,计算出0-N次谐波,谐波含量是从交流量中减去基波分量后除以交流量得到的值,即谐波含量=(交流量-基波分量)/交流量 *100% 。
6.如权利要求1所述的多关节机器人碰撞检测方法,其特征在于,所述判定碰撞产生并调整机器人工作状态具体为:当检测到机器人发生碰撞,立即断伺服使能,电机断电,延时yms后给电机刹车信号使电机抱闸,其中y为预设常量值。
7.一种多关节机器人,其特征在于,包括控制柜、线缆及机械本体,所述控制柜通过所述线缆与所述机械本体相连接,所述控制柜包括有伺服驱动器和运动控制器,所述线缆与所述伺服驱动器相连,所述线缆和所述运动控制器相连,所述伺服驱动器包括处理器和存储器,所述存储器用于存储计算机程序,所述计算机程序被所述处理器调用时实现权利要求1-6任一项所述的多关节机器人碰撞检测方法。
8.一种计算机可读存储介质,用于存储计算机程序,其特征在于,所述计算机程序被处理器调用时实现权利要求1-6任一项所述的多关节机器人碰撞检测方法。
9.一种机器人,包括处理器和存储器,所述存储器用于存储计算机程序,其特征在于,所述计算机程序被所述处理器调用时实现权利要求1-6任一项所述的多关节机器人碰撞检测方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911222850.5A CN110977972B (zh) | 2019-12-03 | 2019-12-03 | 一种多关节机器人碰撞检测方法、计算机可读存储介质及机器人 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911222850.5A CN110977972B (zh) | 2019-12-03 | 2019-12-03 | 一种多关节机器人碰撞检测方法、计算机可读存储介质及机器人 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110977972A CN110977972A (zh) | 2020-04-10 |
CN110977972B true CN110977972B (zh) | 2021-02-12 |
Family
ID=70089796
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911222850.5A Active CN110977972B (zh) | 2019-12-03 | 2019-12-03 | 一种多关节机器人碰撞检测方法、计算机可读存储介质及机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110977972B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111590546B (zh) * | 2020-05-15 | 2021-11-02 | 配天机器人技术有限公司 | 机器人抱闸释放方法、机器人及具有存储功能的装置 |
CN111645070B (zh) * | 2020-05-19 | 2022-06-14 | 华为技术有限公司 | 机器人的安全防护方法、装置与机器人 |
CN111906775A (zh) * | 2020-06-08 | 2020-11-10 | 深圳众为兴技术股份有限公司 | 一种机器人碰撞检测方法、装置、存储介质及机器人 |
CN111923045B (zh) * | 2020-08-07 | 2021-10-29 | 珠海格力智能装备有限公司 | 机器人的控制方法、装置、计算机可读存储介质和处理器 |
CN112737420B (zh) * | 2020-12-29 | 2023-05-19 | 广州市威控机器人有限公司 | 一种机械臂电机断电刹车方法、系统和可读存储介质 |
CN113517827B (zh) * | 2021-04-13 | 2024-01-05 | 高创传动科技开发(深圳)有限公司 | 电机伺服系统及其控制方法、装置、编带机、设备及介质 |
CN113517839B (zh) * | 2021-04-13 | 2024-01-05 | 高创传动科技开发(深圳)有限公司 | 电机伺服系统及其控制方法、装置、插件机、设备及介质 |
CN113885500A (zh) * | 2021-10-08 | 2022-01-04 | 深圳市云鼠科技开发有限公司 | 基于lds和电流的状态检测方法和装置 |
CN114872034A (zh) * | 2022-06-16 | 2022-08-09 | 北京市商汤科技开发有限公司 | 一种机械臂驱动结构、臂型机器人及驱动方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN207643152U (zh) * | 2017-12-25 | 2018-07-24 | 珠海市俊凯机械科技有限公司 | 带有微型压力感知功能的机械手 |
CN110073794A (zh) * | 2019-04-30 | 2019-08-02 | 浙江亚特电器有限公司 | 用于智能割草机的碰撞检测方法 |
CN110328664A (zh) * | 2019-06-28 | 2019-10-15 | 希格斯动力科技(珠海)有限公司 | 碰撞检测方法及装置 |
Family Cites Families (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100592967C (zh) * | 2003-07-29 | 2010-03-03 | 松下电器产业株式会社 | 控制机器人的方法和设备 |
US7298108B2 (en) * | 2004-11-29 | 2007-11-20 | Smc Kabushiki Kaisha | Control system for electric actuator |
CN102426391B (zh) * | 2011-09-05 | 2014-06-11 | 华南理工大学 | 一种判断机器人运行是否发生碰撞的方法 |
JP6164948B2 (ja) * | 2013-06-20 | 2017-07-19 | キヤノン株式会社 | ロボット装置及び部品の製造方法 |
CN104914909B (zh) * | 2014-03-11 | 2017-11-28 | 深圳市中兴微电子技术有限公司 | 一种电源控制装置及方法 |
CN105137994A (zh) * | 2015-09-10 | 2015-12-09 | 珠海市一微半导体有限公司 | 机器人障碍物检测系统及方法 |
US9682481B2 (en) * | 2015-10-26 | 2017-06-20 | X Development Llc | Communication of information regarding a robot using an optical identifier |
JP6481635B2 (ja) * | 2016-02-15 | 2019-03-13 | オムロン株式会社 | 接触判定装置、制御装置、接触判定システム、接触判定方法及び接触判定プログラム |
US10353400B2 (en) * | 2016-05-23 | 2019-07-16 | Asustek Computer Inc. | Navigation system and navigation method |
CN106842956B (zh) * | 2017-03-17 | 2018-02-23 | 葛辰雨 | 机器人避障方法及系统 |
CN107775639B (zh) * | 2017-10-26 | 2020-10-23 | 广州市敏嘉机器人技术有限公司 | 一种基于电流法的机器人防碰撞方法与系统 |
CN108161939B (zh) * | 2017-12-29 | 2020-11-03 | 深圳市越疆科技有限公司 | 一种机械臂的柔性避障方法、系统及终端设备 |
JP6846717B2 (ja) * | 2018-02-14 | 2021-03-24 | ファナック株式会社 | ロボットのジョイントの異常検出装置及び異常検出方法 |
CN109079856A (zh) * | 2018-10-30 | 2018-12-25 | 珠海格力智能装备有限公司 | 机器人的碰撞检测方法和装置 |
CN110000815B (zh) * | 2019-04-09 | 2022-03-01 | 达闼机器人有限公司 | 一种碰撞检测方法、装置、电子设备及存储介质 |
CN109940622B (zh) * | 2019-04-28 | 2020-10-27 | 西安交通大学 | 一种基于电机电流的机器人机械臂无传感碰撞检测方法 |
CN110355786A (zh) * | 2019-06-21 | 2019-10-22 | 珠海格力电器股份有限公司 | 一种机器人撞击检测方法及机器人 |
CN110488801A (zh) * | 2019-07-30 | 2019-11-22 | 南京理工大学 | 基于碰撞危险度的移动机器人自适应速度避碰决策的方法 |
-
2019
- 2019-12-03 CN CN201911222850.5A patent/CN110977972B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN207643152U (zh) * | 2017-12-25 | 2018-07-24 | 珠海市俊凯机械科技有限公司 | 带有微型压力感知功能的机械手 |
CN110073794A (zh) * | 2019-04-30 | 2019-08-02 | 浙江亚特电器有限公司 | 用于智能割草机的碰撞检测方法 |
CN110328664A (zh) * | 2019-06-28 | 2019-10-15 | 希格斯动力科技(珠海)有限公司 | 碰撞检测方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN110977972A (zh) | 2020-04-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110977972B (zh) | 一种多关节机器人碰撞检测方法、计算机可读存储介质及机器人 | |
CN107775639B (zh) | 一种基于电流法的机器人防碰撞方法与系统 | |
CN107614212B (zh) | 工业机器人及其故障判断方法 | |
EP3238893B1 (en) | Robot system | |
US10011017B2 (en) | Industrial robot system and control method thereof | |
US20160363924A1 (en) | Servo motor stop controller to control and stop servo motor during emergency stop | |
US10442085B2 (en) | Production system for performing cooperative work by operator and robot | |
US20160243700A1 (en) | Human cooperation robot system in which robot is caused to perform retreat operation | |
US9776328B2 (en) | Robot control apparatus having function of detecting contact with object or person | |
US9701014B2 (en) | Robot control device for preventing misjudgment by collision judging part | |
US8457787B2 (en) | Method and control device for targeted reaction in the event of a contact between a machine element of a machine and an object | |
KR20150021478A (ko) | 로봇을 제어하기 위한 방법 | |
CN112476438B (zh) | 机械臂避障方法、装置、机械臂及机器人 | |
JPH096432A (ja) | 制御システムの異常検知装置 | |
CN209335630U (zh) | 一种基于工业机器人的无传感弹性碰撞装置 | |
CN111347416B (zh) | 一种无外部传感器的检查机器人碰撞检测方法 | |
CN110740840A (zh) | 确定铰接式工业机器人的关节中的关节转矩的方法 | |
Je et al. | Current based compliance control method for minimizing an impact force at collision of service robot arm | |
CN115021389A (zh) | 一种工业机器人断电自我保护方法 | |
CN100344056C (zh) | 电动机的控制装置 | |
CN114161477A (zh) | 一种工业机器人碰撞检测方法 | |
CN112318501B (zh) | 一种提高机器人碰撞力检测精度及保护灵敏度的方法 | |
EP3907171B1 (en) | A crane, a vehicle, and a method for the crane | |
CN114074323B (zh) | 一种确保机器人速度和动量边界限制的安全系统 | |
CN114074325B (zh) | 一种确保机器人力边界限制的安全系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |