防止搬送对象物的落下事故的机器人系统的制作方法
【技术领域】
[0001]本发明涉及机器人系统，其包含具有能够把持搬送对象物的手的机器人以及控制机器人的动作的控制装置，并防止搬送对象物的落下事故。
【背景技术】
[0002]通常，在针对搬送机器人的示教操作时，为使工件在搬送途中不落下，需要在确认把持工件的手已到达搬送目的地的工作台或托盘等后才释放手。与之关联地，在JP-A-H9 - 124267中，提出有在通过夹钳悬挂地移送工件的移送机中防止工件落下的技术。具体来说，JP - A - H9 - 124267的移送机具备确认单元，所述确认单元通过传感器确认工件就位于移送目的地的托盘，并且仅在确认了工件的就位时解除夹钳的动作限制。但是，在采用JP — A — H9 — 124267的技术的情况下，需要将构成确认单元的专用传感器以及机构部设置在手侧，所以手的构造变得复杂且手的制造成本增加。另外，在JP — A — H9 — 124267的技术中，需要准备适合于各个工件的尺寸以及形状的传感器以及机构部，所以难以提供能够对应多品种工件的手。
[0003]期望即使在手侧不设置专用的传感器以及机构部等也能够防止因对手进行了错误的示教操作而引起的搬送对象物的落下事故的机器人系统。
【发明内容】
[0004]根据本发明的第一方案，提供一种机器人系统，其包括:具备具有手腕部的臂以及安装于手腕部的手的机器人；以及控制机器人的动作的控制装置，应许可针对手的示教操作的许可区域预先设定在手能够到达的最大区域中，控制装置具备:判定部，该判定部基于表示手的位置以及姿态的手位置信息而判定手的整体是否存在于许可区域内；以及示教操作限制部，该示教操作限制部在判定为手的整体存在于许可区域内的情况下，许可针对手的示教操作，并且在判定为手的整体不存在于许可区域内的情况下，禁止针对手的示教操作。
[0005]根据本发明的第二方案，在第一方案的基础上，提供如下机器人系统，许可区域具有凸多面体、球体或是旋转椭圆体的形状。
[0006]根据本发明的第三方案，在第一或第二方案的基础上，提供如下机器人系统，还包括检测机器人的手腕部的位置以及姿态的传感器，控制装置还具备位置算出部，该位置算出部基于传感器检测到的信息来算出手位置信息。
[0007]根据本发明的第四方案，在第一或第二方案的基础上，提供如下机器人系统，还包括视觉传感器，该视觉传感器获得手的图像并基于手的图像而生成手位置信息。
[0008]根据本发明的第五方案，在第一?第四方案中任一方案的基础上，提供如下机器人系统，还具备模型配置部，该模型配置部将手模型虚拟地配置于手位置信息表示的位置，手模型以简化手形状的方式对手进行模型化而得到，判定部在手模型的整体存在于许可区域内的情况下，判定手的整体存在于许可区域内，在手模型的整体不存在于许可区域内的情况下，判定手的整体不存在于许可区域内。
[0009]根据本发明的第六方案，在第五方案的基础上，提供如下机器人系统，手模型具有外接于手的长方体形状。
[0010]根据本发明的第七方案，在第一?第六方案中任一方案的基础上，提供如下机器人系统，判定部依次判定移动中的手的整体是否存在于许可区域内。
[0011]根据本发明的第八方案，在第一?第七方案中任一方案的基础上，提供如下机器人系统，手是伺服驱动式的手。
[0012]参照对附图所表示的本发明的例示的实施方式的详细的说明将使这些以及其他的本发明的目的、特征以及优点更明确。
【附图说明】
[0013]图1是表示本发明的一个实施方式的例示的机器人系统的构成的方框图。
[0014]图2是表示图1的机器人的外观的立体图。
[0015]图3是表示预先设定的许可区域的第一例的立体图。
[0016]图4是表示预先设定的许可区域的第二例的立体图。
[0017]图5是表示预先设定的许可区域的第三例的立体图。
[0018]图6是表示由图1的模型配置部虚拟地配置的手模型的立体图。
[0019]图7是表示图1的机器人将搬送对象物搬送至载置台的中途的状态的立体图。
[0020]图8是表示图1的机器人已经将搬送对象物搬送至载置台的状态的立体图。
[0021]图9是表示图1的控制装置的限制针对手的示教操作的处理的步骤的流程图。
[0022]图10表示本实施方式的机器人系统的变形例的构成的方框图。
[0023]图11是表示本发明的机器人系统能够采用的伺服驱动式手的一例的立体图。
【具体实施方式】
[0024]以下，参照附图对本发明的实施方式进行详细地说明。在各附图中，对相同的构成要素标记相同的符号。此外，以下的记述并不对专利的申请保护范围所记述的发明技术的范围或用语的意义等进行限定。
[0025]参照图1?图10，对本发明的一个实施方式的机器人系统进行说明。本实施方式的机器人系统是通过机器人的动作来搬送种种搬送对象物、例如自动化生产线中的未加工乃至加工完毕的部件的搬送系统。图1是表示本实施方式的例示的机器人系统A的构成的方框图。如图1所示，本例的机器人系统A具备:具备臂RA以及手RH的机器人R ;控制机器人R的动作的控制装置C ;以及接受来自操作员的针对机器人R的各部的示教操作的示教装置I。本例的示教装置I是像示教控制器或键盘那样的输入装置。这里所谓的示教操作，是指为使机器人R记住期望的动作而使机器人R执行该动作的意思。
[0026]图2是表示本例的机器人系统A的机器人R的外观的立体图。如图2所示，本例的机器人R是具备具有手腕部W的臂RA以及安装于手腕部W的手RH的垂直多关节机器人。在图2中，虽然例示了 6轴的垂直多关节机器人，但是本实施方式的机器人的轴数并不限定于此。如图2所示，本例的手RH具备能够把持搬送对象物O的一对抓爪G、Go而且，本例的机器人R根据在示教装置I中接受的示教操作，能够以将由手RH把持的搬送对象物O从规定的作业区域的第一位置搬送至第二位置的方式动作。在此，机器人R的作业区域的第一位置例如是搬送对象物O的聚集处，第二位置例如是设置于各作业台的载置台T。
[0027]再次参照图1，本例的机器人R的臂RA具备与其轴数对应的个数的驱动马达21，这些驱动马达21各自装配有传感器22。本例的传感器22是一般的旋转编码器，检测臂RA的各部特别是手腕部W的位置以及姿态。传感器22的输出数据发送至控制装置C的位置算出部12。另外，本例的手RH具备以一对抓爪G、G向相互接近的方向以及相互离开的方向移动的方式驱动一对抓爪G、G的驱动部30。本例的驱动部30通过液压或气压那样的流体压力来驱动一对抓爪G、G0
[0028]具有以上的构造的机器人R的各部的动作根据在示教装置I接受的示教操作而由控制装置C控制。但是，对于机器人R的手RH的示教操作仅在手RH的整体存在于规定区域内的情况下被许可，在除此以外的情况下被禁止。以下，这样的规定区域称为许可区域PA。本例的手RH的许可区域PA在手RH能够到达的最大区域中由操作员预先设定。图3是表示预先设定的许可区域PA的第一例的立体图。在本例中，设置有位于作为搬送对象物O的搬送目的地的载置台T的上方的具有凸多面体、具体来说长方体形状的许可区域PA。在该情况下，操作员例如能够通过在预先定义的基准坐标系中指定凸多面体的各顶点的坐标来设定凸多面体状的许可区域PA。
[0029]图4是表示预先设定的许可区域PA的第二例的立体图，在本例中，设定有中心点配置于载置台T的上方的具有球体形状的许可区域PA。在该情况下，操作员例如能够通过指定基准坐标系中的球体的中心点的坐标以及半径的长度来设定球体状的许可区域PA。另夕卜，图5是表示预先设定的许可区域PA的第三例的立体图，在本例中，设置有两个焦点配置于载置台T的上方的具有旋转椭圆体形状的许可区域PA。在该情况下，操作员例如能够通过指定基准坐标系中旋转椭圆体的两个焦点的坐标以及长轴以及短轴的长度来设定旋转椭圆体状的许可区域PA。如上所述，操作员能够设定具有种种尺寸及形状的许可区域PA。与预先设定的许可区域PA相关的信息能够作为许可区域数据存储在控制装置C的存储部10中。
[0030]再次参照图1，本例的控制装置C具备存储部10、动作控制部11、位置算出部12、模型配置部13、判定部14以及示教操作限制部15。以下对控制装置C的各部进行详细地说明。本例的存储部 10 是包含 ROM (Read OnlyMemory)以及 RAM(Random Access Memory)等的存储装置。在本例的存储部10中能够存储上述的许可区域数据以及后述的手模型数据等。另外，本例的动作控制部11具有基于示教装置I中接受的示教操作而生成针对机器人R的各部的动作指令的功能。这样生成的动作指令分别发送到臂RA的驱动马达21以及手RH的驱动部30。
[0031]本例的位置算出部12具有基于从臂RA的传感器22发送的输出数据而算出表示手RH的位置以及姿态的手位置信息的功能。特别地，本例的位置算出部12基于从各传感器22以规定的周期时间发送的输出数据而依次算出手位置信息。由位置算出部12算出的手位置信息被发送至模型配置部13。另外，本例的模型配置部13具有将预先制作的手RH的三维模型虚拟地配置于由手位置信息所表示的位置的功能。这样的三维模型以下称为手模型HM。
[0032]图6是表示手模型HM的一例的立体图。本例的手模型HM以简化手RH的形状的方式对手RH进行模型化而得到，并配合由手位置信息所表示的位置、即最大区域MA内的实际的手RH的位置而配置。这样一来虚拟配置的手模型HM能够用于判定手RH的整体是否存在于许可区域PA内。此外，图6的手模型HM虽然是具有与手RH外接的长方体的形状，但本实施方式的机器人系统A中的手模型HM的形状并不限定于此。即、操作员能够任意地设定与实际的手RH的形状对应的手模型HM。与由操作员设定的手模型HM相关的信息能够作为手模型数据存储于存储部10。
[0033]再次参照图1，本例的判定部14具有基于上述的手位置信息而判定手RH的整体是否存在于许可区域PA内的功能。具体来说，本例的判定部14判定由模型配置部13虚拟地配置的手模型HM的整体是否存在于许可区域PA内。此时，判定部14例如能够通过将基准坐标系中的许可区域PA的各点的坐标与手模型HM的各点的坐标进行比较，来判定手模型HM的整体是否存在于许可区域PA内。许可区域PA的各点的坐标例如能根据许可区域数据而获得。另外，手模型HM的各点的坐标例如能够基于手位