一种程序生成系统的制作方法
【专利摘要】一种程序生成系统，包括路径记录部，到达确定部，动作完成部，最近点记录部，高度存储部以及复位程序生成部，其在机器人紧急停止后，通过使用与示教程序的路径不在同一二维平面的复位路径，生成返回效率高并且不会发生干扰的机器人复位程序。
【专利说明】
_种程序生成系统
技术领域
[0001 ]本发明涉及程序控制机器人领域。
【背景技术】
[0002]工业机器人是集机械、电子、控制、计算机、传感技术、人工智能等多学科先进技术于一体的现代化制造业重要的自动化装备。工业机器人具有的灵活、柔性生产的特点，并且随着经济的不断发展和人力成本增加、安全保护要求提高，工业自动化程度也随之提高，因此工业机器人会获得更广泛的应用前景。
[0003]制造过程一直是机器人一个传统的应用领域，批量产品的持续生产加工需求为机器人提供了施展才能的舞台。在面向未来制造过程的生产单元中，机器人不仅仅被要求能进行简单的重复工作，更重要的是能作为一个高度柔性、开放并具有友好的人机交互功能的可编程、可重构制造单元融合到制造业系统中。
[0004]工业机器人完成的典型任务通常具有重复性，并且经常发生在已知的环境中。这些任务需要通过机器人示教程序来完成。根据工业机器人自身特点，机器人在进行示教和示教检查后，生成机器人示教程序，然后示教再现阶段进行自动作业。
[0005]在机器人的作业过程中，有时候会由于错误、干扰等在操作途中紧急停止。当发生紧急停止后，可能需要使机器人在特定时间内返回待机位置，从而在恢复作业时从待机位置重新执行机器人的作业。现有技术中的技术方案中是通过使机器人沿着示教程序中的示教路径的示教点反向地返回，如发那科株式会社在CN100408277C发明专利中所提出的技术方案。现有技术中这样的路线，能够确定机器人的返回路径，但是由于示教路径往往是较为曲折，沿着路径返回可能耗时较长，并且经过的路径环境可能发生变化，导致返回时发生干扰。
【发明内容】
[0006]本发明提供了一种程序生成系统，其能够生成返回效率高，并且不会发生干扰的机器人复位程序。
[0007]作为本发明的一个方面，提供一种程序生成系统，其能够生成机器人复位程序，包括:路径记录部，其存储预设包括多个路径点以及路径动作的机器人路径，机器人基于该机器人路径能够进行无干扰的操作；到达确定部，其在机器人到达路径点后确认;动作完成部，其在机器人完成路径点的动作后确认;最近点记录部，其在机器人完成当前路径点的动作后记录该路径点的位置和动作;高度存储部，其存储机器人路径环境中最高点的高度;复位程序生成部，其在机器人紧急停止时，基于到达确定部确定机器人是否在路径点上:(I)如果机器人在路径点上，确定第一路径为该路径点到安全高度点，所述安全高度点位于路径点上方，为使机器人最低点的高度高于所述高度存储器中存储的高度;第二路径为安全高度点到复位高度点，所述复位高度点的高度与所述安全高度点高度相等，位于复位点上方;第三路径为所述复位高度点到所述复位点;所述复位程序生成部基于所述第一路径、第二路径以及第三路径生成复位程序；(2))如果机器人不在路径点上，基于最近点记录部记录的最近点的位置，确定第一路径为当前位置到最近点的位置;第二路径为最近点的位置到该最近点上方的安全高度点的位置;第三路径为安全高度点到复位高度点，所述复位高度点的高度与所述安全高度点高度相等，位于复位点上方;第四路径为所述复位高度点到到所述复位点;所述复位程序生成部基于所述第一路径、第二路径、第三路径以及第四路径生成复位程序。
[0008]优选的，所述机器人为焊接机器人，所述机器人的焊接对象为二维平板型对象。
[0009]优选的，所述复位高度点与所述机器人路径不处于同一平面。
[0010]优选的，所述复位高度点的高度高于所述机器人路径所在平面。
[0011]优选的，还包括动作完成度统计部，反向路径生成部以及重启动作执行部;所述动作完成度统计部在机器人到达路径点后进行计时，在机器人紧急停止时基于该计数确定该路径点的动作完成度;所述反向路径生成部基于所述复位程序生成与复位路径相反的方向路径;所述重启动作执行部在紧急停止结束后接收到到恢复作业的命令时，基于所述反向路径以及所述动作完成度，确定恢复作业的重启动作。
[0012]优选的，所述重启动作执行部基于所述反向路径确定恢复作业时所述机器人到达所述紧急停止位置的行进路径;如果所述紧急停止位置不在路径点上，所述重启动作执行部基于未执行完的机器人路径继续执行；如果所述紧急停止位置在路径点上，所述重启动作执行部基于所述动作完成度以及该路径点的路径动作确定未完成动作度，基于该未完成动作度以及冗余系数确定恢复作业时该路径点的动作。
[0013]优选的，所述动作完成度根据下式计算:e= t/T，其中t为在路径点机器人紧急停止时的计时，T为路径记录部中存储的机器人路径在该路径点的路径动作时间;所述未完成动作度根据下式计算:I = I 一 ε ;恢复作业时该路径点的动作时间为tl=T X ξ X e，其中e为冗余系数。
[0014]优选的，所述冗余系数为大于I的数，优选为1.2。
[0015]优选的，还包括角度调节部，其基于所述机器人在所述路径点或者所述最近点的机器人动作姿态确定机器人角度调节为竖直的调节程序;所述复位程序生成部在生成到达安全高度点的路径程序前，先基于角度调节部生成调节程序。
【附图说明】
[0016]图1是本发明机器人系统的示意图。
[0017]图2是本发明程序生成系统的示意图。
[0018]图3是本发明实施例的一种复位程序路径示意图。
[0019]图4是本发明实施例的另一种复位程序路径示意图。
【具体实施方式】
[0020]为了更清楚地说明本申请实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本申请中记载的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
[0021]本发明的工业机器人为用于二维焊接面的焊接机器人，如图1所示，机器人10，用于二维平板型焊接平面20进行焊接，在焊接平面20上具有不同高度的环境物体30和40 ο机器人10在焊接平面20上具有焊接路径21，其包括多个不在同一直线上的路径点。正常作业时，机器人10在示教程序控制下，沿着焊接路径21在路径点上执行焊接动作。
[0022]本发明的程序生成系统100，其能够生成机器人复位程序，如图2所示，包括路径记录部101，到达确定部102，动作完成部103，最近点记录部104，高度存储部105以及复位程序生成部106。路径记录部101存储预设的机器人路径，其包括焊接路径21上的路径点以及各个路径点的动作。机器人10执行作业时在不同的路径点之间移动，到达路径点后进行路径点的焊接，到达确定部102用于在机器人10到达路径点后确认;动作完成部103用于机器人1完成路径点的焊接动作后确认。在动作完成部103确认机器人完成路径点的焊接动作后，最近点记录部104记录该路径点的位置和动作。
[0023]高度存储部105存储机器人路径环境中最高点的高度，在本实施例中其为环境物体40的高度。复位程序生成部106，在机器人10紧急停止时，生成复位程序。具体的，首先基于到达确定部102确定机器人10是否在路径点上:(I)如果如图3所示，机器人10的停止点S在路径点Pl上，确定第一路径为该路径点Pl到安全高度点P2，其中安全高度点P2位于路径点上方，为使机器人10焊接部的最低点的高度高于高度存储器105中存储的高度;第二路径为安全高度点P2到复位高度点P3，复位高度点P3的高度与安全高度点P2高度相等，位于复位点T上方;第三路径为复位高度点P3到到复位点T;复位程序生成部基于第一路径、第二路径以及第三路径生成复位程序；(2))如果如图4所示，机器人的停止点S不在路径点上，基于最近点记录部104记录的最近点的位置，确定第一路径为停止点S到最近点Pl的位置;第二路径为最近点Pl的位置到该最近点上方的安全高度点P2的位置;第三路径为安全高度点P2至愎位高度点P3，复位高度点P3的高度与安全高度点P2高度相等，位于复位点T上方;第四路径为复位高度点P3到到复位点T;复位程序生成部106基于所述第一路径、第二路径、第三路径以及第四路径生成复位程序。
[0024]由于机器人10在进行焊接时通常是具有特定的倾斜角度，如果直接将机器人10由路径点提高到位于其上方的安全高度点，该倾斜部位可能会与周围环境如环境物体40形成干扰。优选的，实施例的程序生成系统还可以包括角度调节部，其基于所述机器人在所述路径点或者所述最近点的机器人动作姿态确定机器人角度调节为竖直的调节程序;复位程序生成部106在生成到达安全高度点的路径程序前，先基于角度调节部生成调节程序。具体的，复位程序生成部居于如下生成复位程序:(I)如果机器人在路径点上，确定该路径点使机器人角度调节为竖直的角度调节程序;确定第一路径为该路径点到安全高度点，所述安全高度点位于路径点上方，为使机器人焊接部最低点的高度高于所述高度存储器中存储的高度;确定第二路径为安全高度点到复位高度点，所述复位高度点的高度与所述安全高度点高度相等，位于复位点上方;确定第三路径为所述复位高度点到到所述复位点;所述复位程序生成部基于所述角度调节程序、第一路径、第二路径以及第三路径生成复位程序;(2))如果机器人不在路径点上，基于最近点记录部记录的最近点的位置，确定第一路径为当前位置到最近点的位置;确定该最近点使机器人角度调节为竖直的角度调节程序;确定第二路径为最近点的位置到该最近点上方的安全高度点的位置;确定第三路径为安全高度点到复位高度点，所述复位高度点的高度与所述安全高度点高度相等，位于复位点上方;第四路径为所述复位高度点到所述复位点；所述复位程序生成部基于所述第一路径、角度调节程序、第二路径、第三路径以及第四路径生成复位程序。
[0025]在机器人返回复位位置后，在重新启动时需要恢复执行。优选的，本发明实施例中还包括动作完成度统计部，反向路径生成部以及重启动作执行部;其中，动作完成度统计部在机器人到达路径点后进行计时，在机器人紧急停止时基于该计数确定该路径点的动作完成度;所述反向路径生成部基于所述复位程序生成与复位路径相反的方向路径;所述重启动作执行部在紧急停止结束后接收到到恢复作业的命令时，基于所述反向路径以及所述动作完成度，确定恢复作业的重启动作。
[0026]具体的，所述重启动作执行部基于所述反向路径确定恢复作业时所述机器人到达所述紧急停止位置的行进路径;如果所述紧急停止位置不在路径点上，所述重启动作执行部基于未执行完的机器人路径继续执行；如果所述紧急停止位置在路径点上，所述重启动作执行部基于所述动作完成度以及该路径点的路径动作确定未完成动作度，基于该未完成动作度以及冗余系数确定恢复作业时该路径点的动作。其中，所述动作完成度根据下式计算:e = t/T，其中t为在路径点机器人紧急停止时的计时，T为路径记录部中存储的机器人路径在该路径点的路径动作时间；所述未完成动作度根据下式计算:ξ = I — ε ;恢复作业时该路径点的动作时间为tl=TX| Xe，其中e为冗余系数。优选的，所述冗余系数为大于I的数，优选为1.2。
[0027]在本发明提及的所有文献都在本申请中引用参考，就如同每一篇文献被单独引用作为参考那样。本发明以上所述仅为本发明的较佳实施例而已，并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进等，均包含在本发明的保护范围内。
【主权项】
1.一种程序生成系统，其能够生成机器人复位程序，包括:路径记录部，其存储预设包括多个路径点以及路径动作的机器人路径，机器人基于该机器人路径能够进行无干扰的操作；到达确定部，其在机器人到达路径点后确认;动作完成部，其在机器人完成路径点的动作后确认；最近点记录部，其在机器人完成当前路径点的动作后记录该路径点的位置和动作；高度存储部，其存储机器人路径环境中最高点的高度;复位程序生成部，其在机器人紧急停止时，基于到达确定部确定机器人是否在路径点上:(I)如果机器人在路径点上，确定第一路径为该路径点到安全高度点，所述安全高度点位于路径点上方，为使机器人最低点的高度高于所述高度存储器中存储的高度;第二路径为安全高度点到复位高度点，所述复位高度点的高度与所述安全高度点高度相等，位于复位点上方;第三路径为所述复位高度点到所述复位点；所述复位程序生成部基于所述第一路径、第二路径以及第三路径生成复位程序；(2))如果机器人不在路径点上，基于最近点记录部记录的最近点的位置，确定第一路径为当前位置到最近点的位置;第二路径为最近点的位置到该最近点上方的安全高度点的位置;第三路径为安全高度点到复位高度点，所述复位高度点的高度与所述安全高度点高度相等，位于复位点上方;第四路径为所述复位高度点到到所述复位点;所述复位程序生成部基于所述第一路径、第二路径、第三路径以及第四路径生成复位程序。2.根据权利要求1所述的程序生成系统，其特征在于:所述机器人为焊接机器人，所述机器人的焊接对象为二维平板型对象。3.根据权利要求2所述的程序生成系统，其特征在于:所述复位高度点与所述机器人路径不处于同一平面。4.根据权利要求3所述的程序生成系统，其特征在于:所述复位高度点的高度高于所述机器人路径所在平面。5.根据权利要求4所述的程序生成系统，其特征在于:还包括动作完成度统计部，反向路径生成部以及重启动作执行部;所述动作完成度统计部在机器人到达路径点后进行计时，在机器人紧急停止时基于该计数确定该路径点的动作完成度;所述反向路径生成部基于所述复位程序生成与复位路径相反的方向路径;所述重启动作执行部在紧急停止结束后接收到到恢复作业的命令时，基于所述反向路径以及所述动作完成度，确定恢复作业的重启动作。
【文档编号】B25J9/16GK105835058SQ201610254106
【公开日】2016年8月10日
【申请日】2016年4月23日
【发明人】韩少卿
【申请人】韩少卿