机器人的干涉区域设定装置的制造方法
【技术领域】
[0001]本发明涉及一种设定机器人的干涉区域的干涉区域设定装置。
【背景技术】
[0002]以往已知有如下的装置，其在使用机器人进行作业的情况下，为了避免机器人与周围的障碍物的干涉，而在机器人的周围设定供障碍物存在的干涉区域，并禁止机器人进入干涉区域内。关于这一点，例如在日本特开2005-81445号公报中，记载了一种脱机设定干涉区域并进行动作模拟的装置。在日本特开2005-81445号公报记载的装置中，从CAD装置读取机器人以及障碍物等的三维形状数据，并使用该三维形状数据在屏幕上设定干涉区域。进而，通过鼠标操作等，在屏幕上设定对应于安全栅等的干涉区域。
[0003]但是，在上述的日本特开2005-81445号公报中记载的装置中，需要为了设定干涉区域而预先准备三维形状模型，进而手动输入干涉区域，因此耗时较多。
【发明内容】
[0004]本发明的一方案的机器人的干涉区域设定装置具备3D摄像机，其通过对机器人的周围进行拍摄来取得包含距离信息和颜色信息的机器人的周围的区域的拍摄图像。干涉区域设定装置具有生成3D图的3D图生成部，该3D图由根据拍摄图像而在机器人的周围的三维空间等间隔地配置的多个点列构成，各个点列具有拍摄图像所包含的颜色信息。干涉区域设定装置具备颜色设定部，其设定能够区别机器人与障碍物的颜色，该颜色为机器人以及机器人的周围的障碍物的至少一方的颜色。干涉区域设定装置具备颜色检索部，其从由3D图生成部生成的3D图中检索具有对应于由颜色设定部设定的颜色的颜色信息的点列。干涉区域设定装置具备干涉区域设定部，其根据通过拍摄图像的距离信息而得到的位置数据来设定干涉区域，该位置数据是由颜色检索部检索到的点列的位置数据。
【附图说明】
[0005]本发明的目的、特征、以及优点可以通过联系附图而进行的以下实施方式的说明而变得更明确。在这些附图中:
[0006]图1是表示应用了本发明的实施方式的干涉区域设定装置的加工系统的一个例子的图。
[0007]图2是表示本发明的实施方式的干涉区域设定装置的整体结构的框图。
[0008]图3是表示由图2的机器人控制装置执行的处理的一个例子的流程图。
【具体实施方式】
[0009]以下，参照图1?图3来对本发明的实施方式进行说明。图1是表示应用了本发明的实施方式的干涉区域设定装置的加工系统100的一个例子的图。该加工系统100具有机器人I和机床2。机床2具有罩3，利用罩3形成加工室4。在罩3的一部分设置有能够开闭的门5，通过门5把工件搬送至加工室4，并在加工室4内加工工件。
[0010]在加工室4中，配置有机器人I。机器人I例如是具有能够转动的多个臂的垂直多关节机器人。机器人I通过伺服马达的驱动进行动作，并在臂前端部把持工件、夹具，来辅助利用机床2进行的工件的加工。此外，还能够在臂前端部安装焊接装置、涂装装置来将机器人I构成为焊接机器人、涂装机器人，并在加工室4利用机器人I来加工工件。机器人I连接于机器人控制装置10(图2)，按照预定的程序由机器人控制装置10来控制。也能够由作业人员将机器人I的驱动指令输入至机器人控制装置10，并根据该驱动指令来控制机器人I。
[0011]在通过作业人员的操作使这样配置在加工室4的机器人I进行动作的情况下，存在机器人I与机床2的一部分(加工室4内的工作台、地板、罩3等)或配置于加工室4的各种部件(以下，将这些统称为障碍物)干涉的隐患。因此，优选预先在机器人I的周围设定供障碍物存在的干涉区域，利用机器人控制装置10来禁止机器人I向干涉区域内移动。
[0012]干涉区域能够由作业人员通过将例如大小、位置不同的多个长方体输入到机器人控制装置10来设定。但是，这样手动设定干涉区域会费时。而且，在长方体的数目达到可输入的长方体的数目的上限的情况下，无法设定干涉区域。虽然也可以利用障碍物的3D模型来设定干涉区域，但是，在这种情况下，由于每当障碍物的位置、形状变化都需要重新制作3D模型，因此并不容易。由此，在本实施方式中，使用如下利用3D摄像机6所取得的机器人I的周围的拍摄图像来设定干涉区域。
[0013]3D摄像机6是一种立体摄像机，从不同的方向同时对对象物进行拍摄，通过产生视差来取得到对象物的距离信息。3D摄像机6具有相距规定距离地配置的一对摄像机6a、6b，且一对摄像机6a、6b分别具有拍摄元件。本实施方式的3D摄像机6不仅取得距离信息，还取得对象物的颜色信息(RGB等)。此外，3D摄像机6也可以是发射激光来根据反射位置以及反射时间来取得反射点的距离信息的摄像机。
[0014]在设定干涉区域时，首先，通过3D摄像机6来对机器人I的周围(加工室4的整个区域)进行拍摄。机器人I中带有表示机器人坐标系的基准点(例如原点)的标记7(图中为箭头)。因此，通过利用3D摄像机6来对包含标记7的区域进行拍摄，换句话说，通过将标记7包含到拍摄范围8，能够使用机器人坐标系来表示拍摄范围8内的对象物的位置(XYZ坐标)。
[0015]图1表示作业人员把持3D摄像机6进行拍摄的例子。另一方面，也能够由能够变更3D摄像机6的位置以及姿势的摄像机支架来保持3D摄像机6，并根据来自外部的拍摄指令来执行拍摄。在这种情况下，可以将控制信号输入到摄像机支架驱动用的驱动器来调整3D摄像机6的位置和姿势。这时，在拍摄范围8不包括加工室4的整体区域的情况下，变更3D摄像机6的位置以及姿势，并从多个地方和多个方向反复进行多次拍摄，直至结束对加工室4整体区域的拍摄。通过对这样得到的多个拍摄图像进行合成，能够取得加工室4的整体区域的机器人坐标系中的距离信息。这时，也可以不以摄像机支架来调整摄像机的位置和姿势，而是使用能够对由手拿着摄像机来拍摄的多个图像进行合成的摄像机。
[0016]图2是表示本发明的实施方式的干涉区域设定装置的整体结构的框图。干涉区域设定装置的一部分由机器人控制装置10构成。机器人控制装置10作为功能性结构，具有3D摄像机控制器11、3D图生成部12、颜色设定部13、颜色检索部14、干涉区域设定部15以及机器人控制部16。
[0017]在机器人控制装置10连接有示教操作盘9，示教操作盘9具有输入部9a，能够通过输入部9a将各种指令输入到机器人控制装置10。另外，示教操作盘9具有显示部％，能够通过显示部9b来显示各种指令值、演算结果、干涉区域等。
[0018]3D摄像机控制器11控制3D摄像机6。S卩，将拍摄指令输出到3D摄像机6，来调整拍摄时刻。或者，调整激光的发射时刻。在由摄像机支架来保持3D摄像机6的情况下，3D摄像机控制器11能够将控制信号输出到摄像机支架，从而变更3D摄像机6的位置和姿势。通过3D摄像机6而取得的拍摄图像被存储到作为机器人控制装置10的存储部的存储器。
[0019]3D图生成部12根据存储于存储器的拍摄图像(距离信息)，在机器人I的周围的三维空间等间隔地配置多个点列来形成3D图。即，3D图生成部12利用拍摄图像来特定机器人I和障碍物的位置，并在由机器人I和障碍物形成的三维空间等间隔地设定点列。此夕卜，在生成3D图的阶段中，机器人I与障碍物还未被区别开来。
[0020]构成3D图的各个点列构成微小长度的正方形的区域。各点列分别具有拍摄图像所包含的颜色信息(RGB)的数据。S卩，在点列相当于机器人1、障碍物时，点列具有其颜色信息。一方面，在点列相当于加工室4内的什么都没有的空间时，赋予点列用于区别于机器人I和障碍物的颜色信息(例如R、G、B = 0、0、0)。3D图生成部12还在由3D摄像机6取得的拍摄图像中通过图案匹配等来特定标记7的图像，并赋予对应于标记7的点列能够识别于其他点列的颜色信息(例如R、G、B= UUDo
[0021]颜色设定部13设定通过示教操作盘9而指令的机器人I的颜色(外形颜色)。颜色设定部13设定能够区别机器人与障碍物的颜色。在本实施方式中，机器人I与障碍物由相互不同的颜色(分别称作机器人颜色和障碍物颜色)形成。例如机器人颜色