工博士机器人技术有限公司是一家集研发、生产、销售、技术服务于一体的专注于自动化、智能化设备生产和机器人系统集成应用的科技型企业，与ABB、库卡KUKA、发那科FANUC、安川YASKAWA、欧地希OTC、川崎Kawasaki、遨博AUBO、现代HYUNDAI、电装DENSO、欧姆龙OMRON、爱普生EPSON等机器人公司签订了战略合作关系。

公司业务范围：

◆机器人本体及配套产品销售、机器人应用技术培训服务；

◆机器人在焊接、切割、搬运、激光技术、机床上下料、钣金折弯、锻造等领域的系统集成应用；

◆机器人变位机、导轨、防护工作房、焊接工装夹具等系统周边设备的设计和生产。

 地址：上海市嘉定区南翔镇众仁路399号B座20楼2007室(王工：18616566200)

----------------------------------------------------------------------------------------------------------

 

　　1、简介

 

 

　　本章介绍自动碰撞恢复功能Auto Collision Recovery，使阅读者能迅速掌握其要领。

 

 

　　1.1机器人要求

 

 

　　要在配制R-30iB控制柜的机器人中使用此功能，需要安装软件选项包R510 Auto Collision Recovery。

 

 

　　1.2主要功能

 

 

　　自动碰撞恢复用于从srvu -50碰撞检测错误中自动恢复。当碰撞检测错误发生时，机器人停止，运行的程序也挂起。当自动碰撞恢复安装，它将自动返回到程序。为了使用自动碰撞恢复，必须在机器人上安装碰撞保护。

 

 

　　自动碰撞恢复的不当使用会损坏机器人、端节工具和工作台上的目标，并使人受伤。使用SKIP函数，程序可以通过安全恢复过程正确返回。

 

 

　　1.3开启与禁用

 

 

　　安装之后，自动碰撞恢复是默认启用的。禁用它，可以设置：

 

 

　　[HTCOLREC]COL_REC=FALSE。

 

 

　　

 

 

 

　　图1-1 自动碰撞恢复的开启与禁用

 

 

　　2、自动碰撞恢复模式

 

 

　　自动碰撞恢复有两种模式，在两种模式中FANUC推荐使用高速跳出模式。

 

 

　　2.1、第1种模式

 

 

　　第1种模式是自动碰撞恢复的默认模式。

 

 

　　下面是一个检测到碰撞错误的程序实例。程序中，设置了一个SKIP条件，当“SRVO-50 Quick Stop”或“SRVO-53 Disturbance Excess”发生时此条件触发。第6行中如果Skip被触发，记录当前位置至PR[3]，并执行下一行；如果Skip没有被触发，跳转到LBL[100]。

 

 

　　

 

 

 

　　在类似于紧急停止的停止错误下，程序的执行将在下一行暂停。自动碰撞恢复，运行在后台，可以检测停止错误，并尝试返回到程序。当程序执行返回时，用户必须执行适当的恢复程序，例如将机器人从当前位置缓慢移动到安全位置。

 

 

　　如果用户不使用高速跳转命令，自动崩溃恢复将回到机器人停止的程序。这很可能会引发更多的碰撞错误。在SKIP函数中，非常重要的是要认真对待碰撞错误。

 

 

　　注意:在用户冲突恢复过程中，如果再次发生冲突，将再次尝试冲突恢复。限制损坏机器人、工具和夹具的事故次数。

 

 

　　机器人正在进行碰撞恢复时，可以设置一个DO为ON或者一个数字寄存器为1。为了设置DO或数字寄存器，需要设置以下变量数据，这些变量在名为HTCOLREC.PC的程序中被定义：

 

 

　　首先，在SELECT菜单中选择HTCOLREC.PC：

 

 

　　其次，在DATA菜单中，选择KAREL Vars，翻阅直到“Col_recov”变量，将会看到类似以下的菜单：

 

 

　　(1）在REG_INDEX中设置预定的寄存器号，该寄存器的值在碰撞恢复中会设成1。确保该值在数字寄存器变量的范围内；

 

 

　　（2）在DO_INDEX中设置预定的DO值，该DO在碰撞恢复中会置ON。确保该值在有效的DO范围内；

 

 

　　（3）在ERR_DO_INDEX中设置一个DO的值，该DO在自动碰撞恢复的未知错误中将被打开。

 

 

　　设置完这些变量后当碰撞发生时，寄存器将被设置成1，DO会被打开。用户程序的错误处理逻辑必须重设寄存器和（或）DO；HandlingTool软件不会重设这些寄存器或DO。

 

 

　　用户可以在程序中使用寄存器值或DO状态，来判断机器人是否遭遇碰撞，以及适当的选择其他动作。可以想象用户将重设寄存器为零和设置DO为OFF。

 

 

　　用户需要调节两个延迟变量的值：ERR_DELAY和RESET_DELAY（毫秒单位），取决于周期时间和安全要求。

 

 

　　ERR_DELAY是等待的时间，在错误发生之后及进行RESET之前。在自动错误恢复重置后，触发碰撞检测程序返回之前，有进一步的5秒钟的延迟。随后的延迟必须等待伺服系统重启。

 

 

　　注意：不能设置RESET_DELAY值过低，否则伺服恢复前当程序尝试返回时会出错。

 

 

　　2.2第二种模式

 

 

　　在一些应用中，当碰撞检测错误发生时，尽量终止所有程序，再运行一个错误恢复程序，并重新开始初始程序。原始程序可以被写入分支，该分支可取决于被DO_INDEX定义的DO状态或被REG_INDEX定义的数字寄存器的值。当相同的程序在恢复模式中运行时，它将会在程序中做适当的分支去顺利的恢复。

 

 

　　为了强制使自动碰撞恢复采用第二种模式，按以下步骤：

 

 

　　设置RECOVERY_TASK为希望运行的程序名，该程序中碰撞检测错误会发生。仅仅输入程序名，不要输出“.TP”或“.pc”等扩展名。同时设置USE_REC_TASK为TRUE。

 

 

　　比如，设置RECOVERY_TASK为已命名为ERR_REC的程序，在这种模式下所有在运行中的程序都会终止。然后运行ERR_REC，当它完成后主程序才会再次运行。

 

 

　　用户可能需要调节变量[HTCOLREC]ABORT_DELAY的值。ABORT_DELAY是在做出ABORT ALL和发出RUN命令来运行原始程序后的机器人等待的时间。虽然原始程序终止并在内部运行，用户必须意识到控制器需要少量的时间去终止所有任务，默认值是16ms。如果延迟减少到0，碰撞发生时进入暂停状态的原始程序，将不会终止但会要求重启，这将导致错误。

 

 

　　3、限制 下列限制应用于自动碰撞恢复：

 

 

　　1. 自动碰撞恢复功能需要机器人安装了碰撞保护。适当的设置碰撞保护的灵敏度；

 

 

　　2. 当用户计划使用自动碰撞恢复且预计有碰撞时，慢速移动机器人；

 

 

　　3. 碰撞检测错误终止机器人并暂停导致该错误的程序。在自动错误恢复期间，将返回所有挂起的任务。如果一个用户程序(KAREL或TP)在碰撞检测错误的事件中被暂停，这些任务也会被返回。用户应该意识到这一限制，并保护由于自动碰撞恢复而返回的程序。当发生冲突时，可以设置寄存器值1或DO值ON。建议在程序返回值中检查这些值。如果应用程序也中断了由于错误而挂起的程序，它们应该被修复，因为自动错误恢复返回所有挂起的任务;

 

 

　　4. 不合理的使用这个功能将会对机器人、末关节工具、工作台上的目标以及人员造成伤害。应使用SKIP功能并正确通过安全恢复流程处理程序的返回；

 

 

　　5. 机器人在碰撞恢复中如果发生一个碰撞，机器人会再次尝试碰撞恢复。不要重复的让这种事情发生，否则会损坏机器人、工具和夹具；

 

 

　　6. 如果碰撞检测引起的程序由于内部安全原因被用户或控制器终止了，碰撞恢复将不会发生。对于要执行的碰撞恢复，程序必须在碰撞检测后处于暂停的状态；

 

 

　　7. 当从KCL（KAREL命令语言）中运行一个程序时，自动碰撞恢复可能会尝试返回一个不同的程序，而不是所希望的程序。为了确保自动碰撞 恢复返回正确的任务，必须从SELECT菜单中选择程序或者设置系统变量 $TP_DEFPROG给从KCL中运行的程序；

 

 

　　8. 当通过使用SHIFT+FWD和有效的TP来运行程序时，自动碰撞恢复不会起作用，也不被支持。TP使能键必须为OFF，以保证该功能能够使用。

 

 

　　以上内容转载于网络

 

 

　　更多：发那科机器人

 

　　更多咨询：发那科机器人配件