CN102554939A - 工业机器人碰撞保护方法和装置 - Google Patents
工业机器人碰撞保护方法和装置 Download PDFInfo
- Publication number
- CN102554939A CN102554939A CN2010106157588A CN201010615758A CN102554939A CN 102554939 A CN102554939 A CN 102554939A CN 2010106157588 A CN2010106157588 A CN 2010106157588A CN 201010615758 A CN201010615758 A CN 201010615758A CN 102554939 A CN102554939 A CN 102554939A
- Authority
- CN
- China
- Prior art keywords
- robot
- collision
- controller
- module
- motor
- 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.)
- Granted
Links
Images
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种工业机器人碰撞保护方法和装置，机器人控制器与电机控制器进行通讯连接，进行信号的采集和命令发送，机器人控制器的下电控制信号通过继电器与电机控制器进行控制连接，机器人控制器的显示信号接至示教盒；方法为：系统启动，机器人控制器的轨迹规划模块生成运动轨迹后发给电机控制器控制电机转动，并将轨迹点保存到扩展RAM模块中；如果发生碰撞，则读取扩展RAM模块中保存的轨迹点信息，控制电机反方向转动；反向运行一段后给出继电器下电信号，使机器人本体进入下电停机状态，并在示教盒上显示出碰撞警报。本发明能够在机械手臂与障碍物发生碰撞时及时下电，对机器人本体实施保护，能够更有效的对碰撞进行检测，进一步减小碰撞造成的损失。
Description
技术领域
本发明涉及工业机器人保护技术，具体的说是一种工业机器人碰撞保护方法和装置。
背景技术
工业机器人是一种自动化程度和工作效率都很高的自动化设备，在其运行过程中，如果发生意外，比如在其工作范围内遇到障碍物时，机械手臂就会与障碍物发生碰撞，这不但会影响到系统的正常运行，严重时还会损坏机器人。
发明内容
针对现有技术中存在的工业机器人在工作过程中存在安全隐患等不足之处，本发明要解决的技术问题是提供一种能够对机器人本体实施保护的工业机器人碰撞保护方法和装置。
为解决上述技术问题，本发明采用的技术方案是：
本发明工业机器人碰撞保护装置包括机器人控制器、电机控制器、示教盒以及继电器，其中机器人控制器与电机控制器进行通讯连接，进行信号的采集和命令发送，机器人控制器的下电控制信号通过继电器与电机控制器进行控制连接，机器人控制器的显示信号接至示教盒。
所述机器人控制器包括码盘采集模块、扭矩采集模块、轨迹规划模块以及扩展RAM模块，其中码盘采集模块与电机控制器的编码器接口相连，对编码器的码盘信号进行采集，扭矩采集模块与电机控制器的扭矩接口连接，对电机扭矩信号进行采集，轨迹规划模块的轨迹点控制信号接至电机控制器，扩展RAM模块通过数据线与轨迹规划模块相连，保存轨迹规划模块最近生成的轨迹点。
本发明工业机器人碰撞保护方法包括以下步骤：
系统启动，机器人控制器的轨迹规划模块生成运动轨迹后发给电机控制器控制电机转动，并将轨迹点保存到扩展RAM模块中；调用碰撞检测子程序判断是否有碰撞发生，如果发生碰撞，则读取扩展RAM模块中保存的轨迹点信息，控制电机反方向转动；反向运行一段后给出继电器下电信号，使机器人本体进入下电停机状态，并在示教盒上显示出碰撞警报。
如果没有发生碰撞，则返回机器人控制器的轨迹规划模块生成运动轨迹步骤，进入下一个执行周期计算下一个轨迹点并控制电机转动。
调用碰撞检测子程序包括以下步骤：
通过码盘采集模块采集码盘，由码盘求出电机转动的实际速度值和实际加速度值；通过扭矩采集模块采集电机扭矩，分别对速度、加速度和扭矩分别进行判断，如果三者中有一个以上超过阈值，则碰撞标志置1，否则碰撞标志置0。
本发明具有以下有益效果及优点：
1.本发明提供一种机器人碰撞保护方法和装置，能够在机械手臂与障碍物发生碰撞时及时下电，对机器人本体实施保护。
2.本发明提供一种速度、加速段、扭矩结合的碰撞保护检测方法，能够更有效的对碰撞进行检测，进一步减小碰撞造成的损失。
附图说明
图1为本发明装置总体结构图；
图2为本发明方法流程图；
图3为本发明方法中碰撞检测子程序流程图。
具体实施方式
下面结合附图对本发明作进一步详细说明。
如图1所示，本发明包括：机器人控制器、电机控制器、示教盒、继电器，其中机器人控制器包括码盘采集模块、扭矩采集模块、轨迹规划模块和扩展RAM模块，电机控制器包括编码器接口和扭矩接口，码盘采集模块与电机控制器的编码器接口结合实现对码盘的实时采集。扭矩采集模块与电机控制器的扭矩接口结合实现对电机扭矩的采集。轨迹规划模块通过轨迹规划算法生成轨迹点控制电机转动，并且由轨迹值可求出命令速度值和命令加速度值，用于碰撞判断时的阈值计算。扩展RAM模块实时的保存最近生成的轨迹点，用于碰撞发生时控制电机反转使手臂缩回；编码器接口将实时的码盘值发送给机器人控制器的码盘采集模块。扭矩接口为机器人控制器的扭矩采集模块提供与电机扭矩成比例的电压，扭矩采集模块采集电压值就可以得到相应的扭矩值。
图2为系统运行流程图。系统启动后，每个控制周期中，机器人控制器的轨迹规划模块生成运动轨迹后发给电机控制器控制电机转动，并轨迹点保存到扩展RAM模块。然后调用碰撞检测子程序判断是否有碰撞发生，如果没有则进入下一个执行周期计算下一个轨迹点并控制电机转动，如果发生碰撞则读取RAM中保存的轨迹控制电机反方向转动，反向运行一段后给出继电器下电信号，使机器人本体进入下电停机状态，并在示教盒上显示出碰撞警报。
图3为碰撞检测子程序流程图。其每个执行周期都被调用，实时的检测碰撞是否发生。碰撞检测子程序首先通过码盘采集模块采集码盘，然后由码盘求实际速度值和实际加速度值，接下来通过扭矩采集模块采集电机扭矩，之后分别对速度、加速度和扭矩分别进行判断，如果三者中有一个以上超过了阈值则碰撞标志置1，否则碰撞标志置0。系统调用碰撞检测子程序后通过判断碰撞标志来确定碰撞是否发生。
Claims (5)
1.一种工业机器人碰撞保护装置，其特征在于：包括机器人控制器、电机控制器、示教盒以及继电器，其中机器人控制器与电机控制器进行通讯连接，进行信号的采集和命令发送，机器人控制器的下电控制信号通过继电器与电机控制器进行控制连接，机器人控制器的显示信号接至示教盒。
2.根据权利要求1所述的工业机器人碰撞保护装置，其特征在于：所述机器人控制器包括码盘采集模块、扭矩采集模块、轨迹规划模块以及扩展RAM模块，其中码盘采集模块与电机控制器的编码器接口相连，对编码器的码盘信号进行采集，扭矩采集模块与电机控制器的扭矩接口连接，对电机扭矩信号进行采集，轨迹规划模块的轨迹点控制信号接至电机控制器，扩展RAM模块通过数据线与轨迹规划模块相连，保存轨迹规划模块最近生成的轨迹点。
3.一种工业机器人碰撞保护方法，其特征在于包括以下步骤：
系统启动，机器人控制器的轨迹规划模块生成运动轨迹后发给电机控制器控制电机转动，并将轨迹点保存到扩展RAM模块中；
调用碰撞检测子程序判断是否有碰撞发生，如果发生碰撞，则读取扩展RAM模块中保存的轨迹点信息，控制电机反方向转动；
反向运行一段后给出继电器下电信号，使机器人本体进入下电停机状态，并在示教盒上显示出碰撞警报。
4.按权利要求3所述的工业机器人碰撞保护方法，其特征在于：如果没有发生碰撞，则返回机器人控制器的轨迹规划模块生成运动轨迹步骤，进入下一个执行周期计算下一个轨迹点并控制电机转动。
5.按权利要求3所述的工业机器人碰撞保护方法，其特征在于：调用碰撞检测子程序包括以下步骤：
通过码盘采集模块采集码盘，由码盘求出电机转动的实际速度值和实际加速度值；
通过扭矩采集模块采集电机扭矩，分别对速度、加速度和扭矩分别进行判断，如果三者中有一个以上超过阈值，则碰撞标志置1，否则碰撞标志置0。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201010615758.8A CN102554939B (zh) | 2010-12-30 | 2010-12-30 | 工业机器人碰撞保护方法和装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201010615758.8A CN102554939B (zh) | 2010-12-30 | 2010-12-30 | 工业机器人碰撞保护方法和装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN102554939A true CN102554939A (zh) | 2012-07-11 |
| CN102554939B CN102554939B (zh) | 2014-12-10 |
Family
ID=46402219
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201010615758.8A Active CN102554939B (zh) | 2010-12-30 | 2010-12-30 | 工业机器人碰撞保护方法和装置 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN102554939B (zh) |
Cited By (14)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104526718A (zh) * | 2014-12-02 | 2015-04-22 | 深圳控石智能系统有限公司 | 一种防机器人电机飞车装置及方法 |
| CN104626152A (zh) * | 2013-11-14 | 2015-05-20 | 沈阳新松机器人自动化股份有限公司 | 工业机器人主动柔顺控制方法及装置 |
| CN105004368A (zh) * | 2015-06-29 | 2015-10-28 | 深圳乐行天下科技有限公司 | 一种自主机器人的碰撞检测方法、装置及系统 |
| CN105773602A (zh) * | 2015-07-10 | 2016-07-20 | 石家庄森锐机械科技有限公司 | 一种码垛机器人控制系统 |
| CN105856246A (zh) * | 2016-04-22 | 2016-08-17 | 广州捷士电子科技有限公司 | 一种示教编程过程中防止末端执行器碰撞产品的方法 |
| CN106826819A (zh) * | 2017-01-15 | 2017-06-13 | 上海新时达电气股份有限公司 | 桁架机器人防碰撞检测方法及装置 |
| CN107614213A (zh) * | 2015-05-20 | 2018-01-19 | 日产自动车株式会社 | 故障诊断装置及故障诊断方法 |
| CN107848126A (zh) * | 2015-09-16 | 2018-03-27 | 松下知识产权经营株式会社 | 机器人的碰撞检测方法 |
| CN110000807A (zh) * | 2019-04-08 | 2019-07-12 | 广州市威控机器人有限公司 | 一种机器的舵机保护方法、系统和可读存储介质 |
| CN110026977A (zh) * | 2018-01-12 | 2019-07-19 | 株式会社日立制作所 | 机器人控制装置及自动组装系统 |
| CN110561429A (zh) * | 2019-08-30 | 2019-12-13 | 北京北方华创微电子装备有限公司 | 机械手碰撞保护检测方法、系统及下位机 |
| CN112083644A (zh) * | 2019-06-13 | 2020-12-15 | 北京京东尚科信息技术有限公司 | 用于机器人的安全控制方法、系统、电子设备及可读介质 |
| CN113880402A (zh) * | 2021-10-22 | 2022-01-04 | 湖北楚大智能装备有限公司 | 一种制瓶机的控制方法与装置 |
| CN114770493A (zh) * | 2022-01-24 | 2022-07-22 | 四川广目科技有限公司 | 基于ros网络的服务机械臂可视化远程控制系统 |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1771114A (zh) * | 2003-07-29 | 2006-05-10 | 松下电器产业株式会社 | 控制机械手的方法和设备 |
| CN1994692A (zh) * | 2006-01-04 | 2007-07-11 | 发那科株式会社 | 机器人控制装置 |
| JP2007249524A (ja) * | 2006-03-15 | 2007-09-27 | Daihen Corp | ロボット制御装置 |
| CN100544899C (zh) * | 2007-10-26 | 2009-09-30 | 昆山华恒工程技术中心有限公司 | 一种开放式机器人系统 |
| CN101602208A (zh) * | 2008-06-11 | 2009-12-16 | 松下电器产业株式会社 | 机械手、机械手的碰撞检测方法以及机械手的控制方法 |
| CN201881387U (zh) * | 2010-12-30 | 2011-06-29 | 沈阳新松机器人自动化股份有限公司 | 工业机器人碰撞保护装置 |
-
2010
- 2010-12-30 CN CN201010615758.8A patent/CN102554939B/zh active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1771114A (zh) * | 2003-07-29 | 2006-05-10 | 松下电器产业株式会社 | 控制机械手的方法和设备 |
| CN1994692A (zh) * | 2006-01-04 | 2007-07-11 | 发那科株式会社 | 机器人控制装置 |
| JP2007249524A (ja) * | 2006-03-15 | 2007-09-27 | Daihen Corp | ロボット制御装置 |
| CN100544899C (zh) * | 2007-10-26 | 2009-09-30 | 昆山华恒工程技术中心有限公司 | 一种开放式机器人系统 |
| CN101602208A (zh) * | 2008-06-11 | 2009-12-16 | 松下电器产业株式会社 | 机械手、机械手的碰撞检测方法以及机械手的控制方法 |
| CN201881387U (zh) * | 2010-12-30 | 2011-06-29 | 沈阳新松机器人自动化股份有限公司 | 工业机器人碰撞保护装置 |
Non-Patent Citations (1)
| Title |
|---|
| YOJI YAMADA等: "A failure-to-safety robot system for human-robot coexistence", 《ROBOTICS AND AUTONOMOUS SYSTEMS》, vol. 18, no. 12, 30 June 1996 (1996-06-30) * |
Cited By (18)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104626152A (zh) * | 2013-11-14 | 2015-05-20 | 沈阳新松机器人自动化股份有限公司 | 工业机器人主动柔顺控制方法及装置 |
| CN104626152B (zh) * | 2013-11-14 | 2016-08-31 | 沈阳新松机器人自动化股份有限公司 | 工业机器人主动柔顺控制方法及装置 |
| CN104526718A (zh) * | 2014-12-02 | 2015-04-22 | 深圳控石智能系统有限公司 | 一种防机器人电机飞车装置及方法 |
| CN107614213A (zh) * | 2015-05-20 | 2018-01-19 | 日产自动车株式会社 | 故障诊断装置及故障诊断方法 |
| CN105004368A (zh) * | 2015-06-29 | 2015-10-28 | 深圳乐行天下科技有限公司 | 一种自主机器人的碰撞检测方法、装置及系统 |
| CN105773602A (zh) * | 2015-07-10 | 2016-07-20 | 石家庄森锐机械科技有限公司 | 一种码垛机器人控制系统 |
| CN107848126A (zh) * | 2015-09-16 | 2018-03-27 | 松下知识产权经营株式会社 | 机器人的碰撞检测方法 |
| CN105856246A (zh) * | 2016-04-22 | 2016-08-17 | 广州捷士电子科技有限公司 | 一种示教编程过程中防止末端执行器碰撞产品的方法 |
| CN105856246B (zh) * | 2016-04-22 | 2018-05-22 | 广州捷士电子科技有限公司 | 一种示教编程过程中防止末端执行器碰撞产品的方法 |
| CN106826819A (zh) * | 2017-01-15 | 2017-06-13 | 上海新时达电气股份有限公司 | 桁架机器人防碰撞检测方法及装置 |
| CN106826819B (zh) * | 2017-01-15 | 2019-07-30 | 上海新时达电气股份有限公司 | 桁架机器人防碰撞检测方法及装置 |
| CN110026977A (zh) * | 2018-01-12 | 2019-07-19 | 株式会社日立制作所 | 机器人控制装置及自动组装系统 |
| CN110000807A (zh) * | 2019-04-08 | 2019-07-12 | 广州市威控机器人有限公司 | 一种机器的舵机保护方法、系统和可读存储介质 |
| CN110000807B (zh) * | 2019-04-08 | 2021-04-20 | 广州市威控机器人有限公司 | 一种机器的舵机保护方法、系统和可读存储介质 |
| CN112083644A (zh) * | 2019-06-13 | 2020-12-15 | 北京京东尚科信息技术有限公司 | 用于机器人的安全控制方法、系统、电子设备及可读介质 |
| CN110561429A (zh) * | 2019-08-30 | 2019-12-13 | 北京北方华创微电子装备有限公司 | 机械手碰撞保护检测方法、系统及下位机 |
| CN113880402A (zh) * | 2021-10-22 | 2022-01-04 | 湖北楚大智能装备有限公司 | 一种制瓶机的控制方法与装置 |
| CN114770493A (zh) * | 2022-01-24 | 2022-07-22 | 四川广目科技有限公司 | 基于ros网络的服务机械臂可视化远程控制系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN102554939B (zh) | 2014-12-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN102554939B (zh) | 工业机器人碰撞保护方法和装置 | |
| CN201881387U (zh) | 工业机器人碰撞保护装置 | |
| CN107107349B (zh) | 机械臂系统 | |
| CN203357457U (zh) | 无线电缆巡检机器人及其控制系统 | |
| CN103309254B (zh) | 一种闸机电机控制系统 | |
| CN102772874B (zh) | 消防炮智能控制系统 | |
| CN111402633B (zh) | 一种基于uwb定位的物体防碰撞方法和土建工程防碰撞系统 | |
| CN2879255Y (zh) | 数控机床切削过载监控器 | |
| CN111113377B (zh) | 具有姿态校准系统的人形机器人及其控制方法 | |
| CN110948527A (zh) | 一种轨道式移动机器人防护系统及方法 | |
| CN112476438B (zh) | 机械臂避障方法、装置、机械臂及机器人 | |
| CN203357454U (zh) | 电缆巡检机器人及其控制系统 | |
| CN209335630U (zh) | 一种基于工业机器人的无传感弹性碰撞装置 | |
| CN105509986A (zh) | 防冲撞反恐防暴装置拦截性能测试系统 | |
| CN111168660B (zh) | 一种冗余自由度液压重载机器臂主动安全系统 | |
| CN111823235A (zh) | 一种用于采摘机械臂的碰撞检测方法 | |
| CN207014366U (zh) | 一种六轴焊接工业机器人防碰撞控制系统 | |
| CN111402634A (zh) | 一种基于uwb定位的设备虚拟电子围栏设置方法和系统 | |
| CN105278556A (zh) | 基于对偶四元数建模与控制的三关节空间机械臂系统 | |
| CN203402849U (zh) | 一种门式起重机雷达防撞装置 | |
| CN203833582U (zh) | 一种臂架防碰撞检测系统 | |
| CN114593986B (zh) | 一种摆锤式冲击试验台控制器及其控制方法 | |
| CN202159255U (zh) | 一种工程机械监控系统的模拟台 | |
| CN105668258A (zh) | 取料机防碰撞的方法和系统 | |
| CN107538486B (zh) | 一种关节力控制平台装置、方法及相关装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant |