CN105643369A - 机床以及具备机器人的协作系统 - Google Patents

机床以及具备机器人的协作系统 Download PDF

Info

Publication number
CN105643369A
CN105643369A CN201510688224.0A CN201510688224A CN105643369A CN 105643369 A CN105643369 A CN 105643369A CN 201510688224 A CN201510688224 A CN 201510688224A CN 105643369 A CN105643369 A CN 105643369A
Authority
CN
China
Prior art keywords
coordinate
robot
mentioned
coordinates
lathe
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
Application number
CN201510688224.0A
Other languages
English (en)
Other versions
CN105643369B (zh
Inventor
西浩次
水野淳
小山田匡宏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
FANUC Corp
Original Assignee
FANUC Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Priority to JP2014242393A priority Critical patent/JP6126067B2/ja
Priority to JP2014-242393 priority
Application filed by FANUC Corp filed Critical FANUC Corp
Publication of CN105643369A publication Critical patent/CN105643369A/zh
Application granted granted Critical
Publication of CN105643369B publication Critical patent/CN105643369B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23QDETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
    • B23Q17/00Arrangements for observing, indicating or measuring on machine tools
    • B23Q17/24Arrangements for observing, indicating or measuring on machine tools using optics or electromagnetic waves
    • B23Q17/2409Arrangements for indirect observation of the working space using image recording means, e.g. a camera
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • B25J9/1692Calibration of manipulator
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02Sensing devices
    • B25J19/021Optical sensing devices
    • B25J19/023Optical sensing devices including video camera means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1694Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
    • B25J9/1697Vision controlled systems
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10STECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00Robots
    • Y10S901/02Arm motion controller

Abstract

本发明提供能够以简易的结构且精度良好地取得用于进行从对机器人规定的机器人坐标系向对机床规定的机械坐标系的坐标变换的坐标变换手段的协作系统。根据三个校正用标记在使机械坐标系平行移动后的基体坐标系中的坐标值,定义假定的坐标系,而求出从假定的坐标系向基体坐标系的坐标变换矩阵。使用摄像机拍摄三个校正用标记,取得校正用标记在机器人坐标系中的位置。根据机器人坐标系中的三个坐标值,求出从机器人坐标系向假定的坐标系的坐标变换矩阵,并且使用上述两个坐标变换矩阵来求出从机器人坐标系向基体坐标系的坐标变换矩阵。

Description

机床以及具备机器人的协作系统
技术领域
[0001 ]本发明涉及机器人相对于机床进行作业的协作系统。
背景技术
[0002]在机器人相对于机床进行作业的情况下,除加工对象的处理以外,能够进行工具的更换、切肩的清扫、机床的内部检查等。此处,若机器人的作业仅是加工对象的处理,则一般是,利用机器人的工具前端点(Tool Center Point)的位置(坐标值),取得加工对象的表面上的多个(通常3点或者4点)教学点,求出从机器人坐标系向加工对象的坐标系(机械坐标系)的坐标变换矩阵。
[0003] 例如,在日本特开昭59-177607号公报中记载了如下自动编程方法:连接机床和机器人,使用对机器人设定的坐标系与对机床设定的坐标系之间的变换式,而根据机床的程序自动地生成机器人程序。
[0004]在日本特开平05-212652号公报中记载了一种精密加工机,该精密加工机具备:第一运算单元,其具备加工区域和测量区域,并且以测定数据为基础计算坐标变换矩阵;第二运算单元,其使用求出的坐标变换矩阵来进行测定数据的变换;判定单元,其对计算出的形状数据的形状精度进行判定;修正单元,其进行NC数据的自动修正;以及加工执行单元,其根据修正后的NC数据再次进行加工。
[0005] 在日本特开平05-324034号公报中记载了如下机器人的控制方法:从进行机床的NC控制的上位计算机向控制机器人的机器人控制器发送动作控制数据,来进行机床的工件、工具的装卸移动。
[0006]在日本特开2008-152733号公报中记载了如下离线编程装置:基于包括对机床给予的工件加工程序的、特定对象物的位置的指令,来求出处理作业执行时的机床上的对象物的位置以及姿势,并相对于该对象物的位置以及姿势,在预先设定的相对位置关系下,求出处理作业执行时的机器人的位置以及姿势,由此生成作业程序。
[0007] 在日本特表平11-509928号公报中记载了如下装置以及方法:使用安装于机器人的手指尖的探测器,取得相对于机器人坐标系的物体的坐标值,来生成该物体的三维模型。并且在日本特表平11-509928号公报中也记载了如下技术:在机器人的手指尖安装摄像机,变更摄像机的位置而拍摄物体,并根据由此得到的多个图像取得物体的坐标值,从而生成该物体的三维模型。
[0008] 在日本特开2009-279677号公报中记载了如下机器人控制装置:不需要进行摄像机等测量装置的校准,将机器人和作业对象移动至所希望的相对位置关系,而实现了自动地进行教学位置的修正。
[0009]以往,对于机器人坐标系与机械坐标系之间的坐标变换,主要以加工对象的处理为目的而被使用。例如,在日本特开昭59-177607号公报中记载了利用机器人而容易地生成机床的加工对象的处理程序的方法,并且在日本特开平05-324034号公报中记载了如下方法:通过使用上位计算机,而能够容易地对机器人进行指示,以便实施机器人所进行的机床的加工对象的处理、工具的装卸。但是,在日本特开昭59-177607号公报以及日本特开平05-324034号公报中,均使用坐标变换,但并未提及坐标变换手段的具体的取得方法。
[00Ί0]日本特开平05-212652号公报所记载的技术中,使用测量出的加工对象的表面与理想曲面之间的差、以及从对测量装置设定的坐标系向定义于机床的规定位置的坐标系进行的坐标变换,来修正机床的加工量。但是,并未说明从与测量装置对应地设定的坐标系向定义于机床的规定位置的坐标系的坐标变换手段的具体的取得方法。
[0011] 在日本特开2008-152733号公报中,为了取得机床和机器人的通用坐标系,在机器人的手指尖安装位置检测器,在机床的工作台安装检测用的目标物,固定机器人的手指尖位置,并以三个位置检测目标物。具体而言,第一,决定目标物的基准位置,并在该位置检测目标物。第二,使工作台沿基准轴方向移动,并检测目标物。第三,使目标物返回基准位置而使之沿不同的基准轴方向移动,并检测目标物。基于从像这样得到的三个测量值求出的坐标变换矩阵、和离线模拟装置中的模拟结果,来进行机器人的校准。但是,在该方法中,需要预先准备用于在离线模拟装置中使用的高精度的三维CAD模型。并且,存在离线模拟装置中的计算中包含实际机器人与实际机床的配置误差这一问题。
[0012] 并且在日本特开平05-324034号公报或者日本特开2008-152733号公报所记载的方法中,除机器人和机床以外,还需要上位计算机或者离线模拟装置,从而也存在设备费用变高这一问题。
[0013]另外,机器人相对于机床进行的作业在包括加工对象的处理以外的作业的情况下,机器人不仅需要能够到达或者接近加工对象,还需要能够到达或者接近机床的其它部位。在这样的情况下,机器人的配置位置会较大地受到限制。
[0014]这样,在机器人相对于机床进行的作业包括加工对象的处理以外的各种作业、且欲使这些作业自动化的情况下,机器人仅保持有在加工对象附近的作业用的坐标系信息的话则不充分。
发明内容
[0015]因此,本发明的目的在于提供一种机器人和机床的协作系统,S卩,能够以简单的结构且精度良好地取得坐标变换矩阵等坐标变换手段,该坐标变换矩阵等坐标变换手段用于进行从对机器人规定的机器人坐标系向定义于机床的规定位置的机械坐标系的坐标变换。
[0016]为了实现上述目的,本申请发明提供一种协作系统,具有机床和相对于上述机床进行作业的机器人,其特征在于,具备:摄像机,其安装于上述机器人的可动部;至少一个校正用标记,其设于上述机床;第一标记坐标取得部,其取得上述校正用标记在对上述机床定义的机械坐标系中的第一坐标值;第二标记坐标取得部,其通过用上述摄像机拍摄上述校正用标记,来取得上述校正用标记在对上述机器人设定的机器人坐标系中的第二坐标值;以及坐标变换部,其基于上述校正用标记的上述第一坐标值以及上述第二坐标值的多个组,来求出从上述机器人坐标系向上述机械坐标系的坐标变换手段。
[0017]在优选的实施方式中,上述校正用标记安装于上述机床的可动部,上述第一标记坐标取得部分别在上述机床的可动部的多个位置中,多个取得上述校正用标记在上述机械坐标系中的第一坐标值,上述第二标记坐标取得部分别在上述机床的可动部的多个位置中,通过用上述摄像机拍摄上述校正用标记,来取得多个上述校正用标记在对上述机器人设定的机器人坐标系中的第二坐标值。
[0018] 在优选的实施方式中,上述机器人控制装置自动地控制上述机器人,以使上述摄像机与上述校正用标记的相对位置关系成为能够用上述摄像机测量上述校正用标记的位置的关系。
[0019]通过参照附图对以下的优选的实施方式进行说明,本发明的上述或者其它的目的、特征以及优点会变得更加清楚。
附图说明
[0020]图1是表示本发明的第一实施方式的协作系统的简要结构的图。
[0021]图2是表示在图1的协作系统中设定有各坐标系的状态的图。
[0022]图3是表不第一实施方式的处理的一个例子的流程图。
[0023]图4是表示在第一实施方式中正在用测量用探测器测量第二校正用标记的位置的状态的图。
[0024]图5是表示在第一实施方式中正在用摄像机测量第二校正用标记的位置的状态的图。
[0025]图6是表示在第一实施方式中正在用摄像机测量第一校正用标记的位置的状态的图。
[0026]图7是说明在第一实施方式中用于求出第一校正用标记与工具前端点之间的差量(偏置)的处理的图。
[0027]图8是表示在第一实施方式中正在用摄像机测量第二校正用标记的位置的状态的图。
[0028]图9是说明在第一实施方式中用于求出从机器人坐标系向机械坐标系的坐标变换矩阵的处理的图。
[0029]图10是表示本发明的第二实施方式的协作系统的简要结构的图。
[0030]图11是表示在图10的协作系统中设定有各坐标系的状态的图。
[0031]图12是说明在第二实施方式中用于求出从机器人坐标系向机械坐标系的坐标变换矩阵的处理的图。
[0032]图13是表示本发明的第三实施方式的协作系统的简要结构的图。
[0033]图14是说明在第三实施方式中用于求出从机器人坐标系向机械坐标系的坐标变换矩阵的处理的图。
[0034]图15是表示本发明的第四实施方式的协作系统的简要结构的图。
[0035]图16是表示在图15的协作系统中设定有各坐标系的状态的图。
[0036]图17是表示第四实施方式的处理的一个例子的流程图。
[0037]图18是说明在第四实施方式中用于求出从机器人坐标系向机械坐标系的坐标变换矩阵的处理的图。
[0038]图19是表示本发明的第五实施方式的协作系统的简要结构的图。
[0039]图20是表示在图19的协作系统中设定有各坐标系的状态的图。
[0040]图21a是第五实施方式中所使用的带校正用标记的夹具的主视图。
[0041]图21b是第五实施方式中所使用的带校正用标记的夹具的侧视图。
[0042]图22是表示在第五实施方式中正在用摄像机测量校正用标记的位置的状态的图。
具体实施方式
[0043]以下,参照附图,对本发明的优选的实施方式进行说明。此外,在本申请说明书中,“坐标变换手段”这一用语,除包括用于进行后述的坐标变换的变换矩阵、旋转矩阵之外,还包括用于规定该矩阵的矢量、标量,另外还包括用于进行与使用了该矩阵的坐标变换实质上同等的运算处理的计算式等。并且,“校正用标记”这一用语,是指能够由安装于机器人的摄像机检测的、配置或形成于机床的规定位置的标记、刻印等打印物或者形状物,通过用该摄像机拍摄校正用标记,能够得到机器人坐标系中的该校正用标记的位置(测量值)。并且在后述的实施方式中,本申请发明中的第一标记坐标取得部的功能由机床的控制装置来担负,第二标记坐标取得部以及坐标变换部的功能由机器人控制装置来担负,但并不限定于此。
[0044]图1是表示本发明的第一实施方式的协作系统的简要结构的图。协作系统10具备由NC控制装置等控制装置11控制的机床12、进行机床12的加工对象物的处理等相对于机床12的作业的机器人14、以及用于进行机器人14的动作控制的机器人控制装置16,且具有将后述的机械坐标系设定为机器人控制装置16的功能。机器人14例如是六轴多关节机器人,具有臂18、安装于臂18的前端的手20等机器人可动部,在该机器人可动部(优选为手20的前端)安装有摄像机22。并且,机床12的控制装置11也可以与机床12的箱体分别设置,也可以与该箱体一体构成,也可以与机器人控制装置16—体构成。
[0045]另一方面,机床12具有:构成为把持工具且能够绕(图示例子中大致铅垂方向的)中心轴线旋转、并且能够沿该中心轴线方向移动的主轴24;以及构成为能够在相对于主轴24、至少在相对于主轴24的中心轴线方向垂直的平面内移动的可动部(此处,是构成为能够载置机床12的加工对象物(工件)等的工作台)26。并且,在主轴24,能够代替工具而安装(例如接触式的)测量用探测器28,在测量用探测器28的附近的主轴24的部位设置第一校正用标记30。另外,在工作台26上设置第二校正用标记32。
[0046]在第一实施方式中,设定了以下的定义或者条件(al)〜(a6)。
[0047] (al)如图2所示,用{Μ}表示对机床12定义的坐标系(机械坐标系),并用{R}表示对机器人14定义的坐标系(机器人坐标系)。
[0048] (a2)机械坐标系{Μ}以及机器人坐标系{R}均是具有相互正交的三个轴(x、y、z)的正交坐标系,但也可以使用极坐标。并且,在图2所示的机械坐标系{M}中,X轴是与纸面垂直的方向3轴是左右方向,Z轴是上下方向,另一方面,在机器人坐标系{R}中,X轴是左右方向4轴是与纸面垂直的方向,Z轴是上下方向。
[0049] (a3)机械坐标系{M}的原点固定于工作台26,该原点的位置(x、y、z)在从机器人14侧观察工作台26时的工作台26的左内的角落(参照图9)成为(x、y) = (0、0),另外在安装于主轴24的工具(未图示)的前端点(工具前端点)处于工具更换位置时成为z = 0。其中,机械坐标系{M}的原点位置、各基本轴的方向并不限定于此。
[0050] (a4)机械坐标系{M}、机器人坐标系{R}以及对摄像机22定义的摄像机坐标系分别结束校正。并且,机器人坐标系{R}与摄像机坐标系之间的位置关系(坐标变换手段)是已知的。
[0051] (a5)如图2所示,为方便计算,对机床12的规定位置(例如工作台26)定义坐标系(机械基体坐标系),并用{B}表示。图2中举例表示的机械基体坐标系(以下,也简称作基体坐标系){ B}以主轴24的中心轴线与工作台26的表面(上表面)交叉的点作为原点,基体坐标系{B}的各基本轴(X、y、z)的方向与机械坐标系{M} —致。也就是说,基体坐标系{B}相当于使机械坐标系{M}平行移动后的坐标系。
[0052] (a6)测量用探测器28以及第一校正用标记30能够同时使用。
[0053]接下来,在协作系统10中,参照图1〜图10,说明在上述的定义或者条件下、取得用于进行从机器人坐标系{R}向基体坐标系{B}的坐标变换的坐标变换矩阵T的顺序。
[0054]首先,如图1所示,将机床12以及机器人14配置于预先决定的位置,(图3的步骤Sll)。将第一校正用标记30以及第二校正用标记32分别安装于主轴24以及工作台26(机床12的可动部)(图3的步骤S12)。
[0055]接下来,如图4所示,使用安装于机床12的主轴24的测量用探测器28(具体而言,使测量用探测器28以及工作台26中的至少一方移动而使探测器28抵接于第二校正用标记32),对安装于工作台26的第二校正用标记32的位置进行测量。通过该测量,得到第二校正用标记32在机械坐标系{M}中的位置〒》:(第一坐标值)。
[0056]接下来,如图5所示,使主轴24向上方移动,使用设于机器人14的摄像机22(具体而言,以使第二校正用标记32进入摄像机22的视场内、且该标记的位置能够以足够的精度测量的方式控制机器人14),而拍摄第二校正用标记32。通过该处理,得到第二校正用标记32在机器人坐标系{R}中的位置%_(第二坐标值)。
[0057]接下来,使用机器人14测量从机器人坐标系{R}向基体坐标系{B}的坐标变换矩阵T在未知的条件下从工具前端点的位置至第一校正用标记30的中心位置的、以机械坐标系{M}为基准的偏^Pqffi = ( Pxoff1、PyQFF1、Pzqffi )(参照图2)中的x、y成分。以下,对其详细内容进行说明。
[0058]如图6所示,首先使主轴24向任意的位置移动,用摄像机22拍摄第一校正用标记30,并测定(取得)在机器人坐标系{R}中的第一位置rPu1。接下来,使主轴24向其它的任意位置移动,用摄像机22拍摄第一校正用标记30,并测定(取得)在机器人坐标系{R}中的第二位置RPu2。根据第一位置rPu1以及第二位置RPu2,得到在机器人坐标系{R}中在这些位置通过的直线(的式子)(此处为Z 〃轴)。
[0059]接下来,如图7所示,在机器人坐标系{R}中,计算与通过第一位置叩^以及第二位置rPu2的直线(Z〃轴)垂直地交叉、并且包括第二校正用标记32在机器人坐标系{R}中的位置叩!^的平面S1,将该平面S1与通过第一位置叩^以及第二位置rPu2的直线交叉的点设为RPdl。使摄像机22向能够拍摄该点卞也的(优选为点RPdl位于摄像机22的视场的中心)位置移动。
[0060]接下来,使工作台26移动,以使ARPdl与第二校正用标记32的中心位置重叠。其中,由于在当前时刻,未得到坐标变换矩阵T,所以无法唯一地决定工作台26的移动方向。因此,由于第二校正用标记32在机械坐标系{M}中的位置%^与在机器人坐标系{R}中的点RPd^间的距离非常短,所以若以位坐标为起点,使工作台26移动微小距离而用摄像机22拍摄第二校正用标记32,则在机器人坐标系{R}中,能够检测第二校正用标记32的中心是否接近点RPdl。基于这样的想法,通过使工作台26向任意的方向移动,并用摄像机22测量第二校正用标记32的测量位置的变化,由此能够适当地修正测量位置的变化量和工作台26的移动方向,而能够以使摄像机22所进行的第二校正用标记32的测量位置与ARPdl—致的方式使工作台26移动。
[0061]如图7所示,将摄像机22所进行的第二校正用标记32的测量位置与ARPdl—致时的、机械坐标系{M}中的工具前端点的位置设为MPn。通过求出该位置%11与第二校正用标记32的位置mPmai的差,来得到上述的偏置mPqffi的x、y成分(Pxoff1、PyOFFi)。
[0062]接下来,如图8所示,在机床12中,使可动部(此处为工作台26)向任意的位置移动(图3的步骤S13)。其中,第二校正用标记32的中心不与主轴24的中心轴线重叠。使用此时的第二校正用标记32在机械坐标系{M}中的坐标值mPmm,来将第二校正用标记32在机械坐标系{M}中的位置变换为在基体坐标系{B}中的坐标值,并将变换后的坐标值设为bPm2。使用适当的手段向机器人控制装置16发送坐标值bPM2。
[0063]而且,以使安装于工作台26的第二校正用标记32与安装于机器人14的手指尖的摄像机22之间的距离变得适当、并且能够以足够的精度测量第二校正用标记32的位置的方式,使用机器人控制装置16来使机器人14动作。而且用摄像机22拍摄第二校正用标记32,而得到第二校正用标记32在机器人坐标系{R}中的位置(测量值)RPM2(图3的步骤S14)。
[0064]此处,将通过第一校正用标记30在机器人坐标系{R}中的第一位置rPuJP第二位置rPu2的直线(参照图7)定义为假定的Z 〃轴,求出与Z 〃轴垂直地交叉并且包括点rPm2的平面&,当将该平面S2与Z〃轴的交点设为原点时,将从该原点朝向rPu1的方向设为Z轴的正向。
[0065]接下来,如图9所示,决定将从平面52的原点朝向第二校正用标记32的位置rPm2的方向设为正向的假定的X,轴,并对由该X7轴、在平面S2上延长且与X7轴正交的Y'轴、以及与X7轴及V轴双方正交的Z'轴构成的假定的坐标系{B' }进行定义,由此能够得到从机器人坐标系{R}向坐标系{B'}的坐标变换矩阵f。此外,坐标系{B'}的定义方法并不限定于此。
[0066]另外,求出相当于第二校正用标记32在基体坐标系{B}中的位置%.的x、y成分与上述的偏置量mPciffi的X、y成分(PxciFF1、PyQFFi)的差的位置矢量,并且求出以使该位置矢量与基体坐标系{B}的X轴的正向直线重叠的方式使之旋转角度Θ的旋转变换矩阵4。
[0067]此处,如图9所示,为了使假定的坐标系{BM的Z'轴、与通过第一校正用标记30的第一位置1^和第二位置rPu2的直线(Z〃轴)处于平行关系,而预先求出坐标变换矩阵I"以及根据旋转变换矩阵4而得到的坐标变换矩阵τ〃,并将使用坐标变换矩阵τ〃而从机器人坐标系{R}变换后的坐标系设为{B〃}。该坐标系{B〃}的χ-y平面与基体坐标系{B}的平面相互重叠,坐标系{B〃}与基体坐标系{B}处于相互平行移动后的位置关系,另外其平行移动量由bPm2的x、y成分表示。因此,通过使用BPM2,来得到用于从坐标系{B〃}向基体坐标系{B}平行移动的坐标变换矩阵f"。
[0068]综上所述,能够求出坐标变换矩阵T〃(坐标变换矩阵f以及旋转变换矩阵BR),并且能够根据坐标变换矩阵!"〃而求出从机器人坐标系{R}向基体坐标系{B}的坐标变换矩阵T(图3的步骤S15)。由于基体坐标系{B}与机械坐标系{M}处于相互平行移动后的关系,所以若求出坐标变换矩阵T,则也能够容易地求出从机器人坐标系{R}向机械坐标系{M}的坐标变换矩阵。
[0069]在第一实施方式中,通过使用安装于主轴24的第一校正用标记30在机器人坐标系{R}中的任意两个位置的测量值、相对于主轴24的中心轴(Z轴)直至该两个位置的中任一个位置的点为止的x、y成分的偏置量、以及工作台26上的第二校正用标记32在机器人坐标系{R}以及基体坐标系{B}各个中的一个测量值,能够得到坐标变换矩阵T。这样,由于测量工作台26上的任意一个位置足以,所以能够扩大机器人14的能够配置区域。另外,由于安装于主轴24的第一校正用标记30固定于主轴24足以,所以能够提高设计的自由度。
[0070]接下来,参照图10〜图12对本申请发明的第二实施方式进行说明。
[0071 ]在第二实施方式中,如图10所示,作为协作系统的结构,除第一校正用标记30能够与在第一实施方式中已说明的测量用探测器28更换这一点之外,可以与第一实施方式相同,从而对于实质上同等的构成要素赋予与第一实施方式相同的符号,并省略详细的说明。
[0072]在第二实施方式中,设定了以下的定义或者条件(bl)〜(b6)。此外,(bl)〜(b5)与第一实施方式的(al)〜(a5)实质上相同。
[0073] (bl)如图11所示,用{M}表示对机床12定义的坐标系(机械坐标系),并用{R}表示对机器人14定义的坐标系(机器人坐标系)。
[0074] (b2)机械坐标系{M}以及机器人坐标系{R}均是具有相互正交的三个轴(x、y、z)的正交坐标系,但也可以使用极坐标。并且,在图11所示的机械坐标系{M}中,X轴是与纸面垂直的方向,Y轴是左右方向,Ζ轴是上下方向,另一方面,在机器人坐标系{R}中,Χ轴是左右方向4轴是与纸面垂直的方向,Ζ轴是上下方向。
[0075] (b3)机械坐标系{Μ}的原点固定于工作台26,该原点的位置(x,y,z)在从机器人14侧观察工作台26时的工作台26的左内的角落(参照图12)成为(x、y) = (0、0),另外在安装于主轴24的工具(未图示)的前端点(工具前端点)处于工具更换位置时成为z = 0。其中,机械坐标系{M}的原点位置、各基本轴的方向并不限定于此。
[0076] (b4)机械坐标系{M}、机器人坐标系{R}以及对摄像机22定义的摄像机坐标系分别结束校正。并且,机器人坐标系{R}与摄像机坐标系之间的位置关系(坐标变换手段)是已知的。
[0077] (b5)如图11所示,为方便计算,在机床12的规定位置(例如工作台26)定义坐标系(机械基体坐标系),并用{B}表示。图11中举例表示的机械基体坐标系(以下,也简称作基体坐标系){ B}以主轴24的中心轴线与工作台26的表面(上表面)交叉的点作为原点,基体坐标系{B}的各基本轴(X、y、z)的方向与机械坐标系{M} —致。也就是说,基体坐标系{B}相当于使机械坐标系{M}平行移动后的坐标系。
[0078] (b6)第一校正用标记30能够以与工具相同的形态安装于主轴24,其中心点位于主轴的轴线上。
[0079] (b7)第一校正用标记30能够与测量用探测器更换。
[0080]接下来,在第二实施方式的协作系统10中,参照图10〜图12,说明在上述的定义或者条件下、取得用于进行从机器人坐标系{R}向基体坐标系{B}的坐标变换的坐标变换矩阵T的顺序。
[0081]首先,与第一实施方式相同,在机床12的主轴24安装测量用探测器,对安装于工作台26的第二校正用标记32的位置进行测量。通过该测量,得到第二校正用标记32在机械坐标系{M}中的位置〒》:。之后,将测量用探测器更换为第一校正用标记30。
[0082]与图6类似,使主轴24向任意的位置移动,使用设于机器人14的摄像机22(具体而言,以使第一校正用标记30进入摄像机22的视场内、且该标记的位置能够以足够的精度测量的方式控制机器人14),而拍摄第一校正用标记30,从而测定(取得)在机器人坐标系{R}中的第一位置rPu1。接下来,使主轴24向其它的任意的位置移动,用摄像机22拍摄第一校正用标记30,从而测定(取得)在机器人坐标系{R}中的第二位置rPu2。
[0083]接下来,与图8类似,使工作台26向任意的位置移动。其中,第二校正用标记32的中心不与主轴24的中心轴线重叠。使用此时的第二校正用标记32在机械坐标系{M}中的坐标^ImPmai,来求出第二校正用标记32在机械坐标系{M}中的位置,并将其变换为在基体坐标系{B}中的坐标值,将变换后的坐标值设为BPM2。使用适当的手段向机器人控制装置16发送坐标值ΒΡΜ2 ο
[0084]接下来,以使安装于工作台26的第二校正用标记32与安装于机器人14的手指尖的摄像机22之间的距离变得适当、并且能够以足够的精度测量第二校正用标记32的位置的方式,使用机器人控制装置16来使机器人14动作。而且用摄像机22拍摄第二校正用标记32,而得到第二校正用标记32在机器人坐标系{R}中的位置(测量值)rPM2。
[0085]将通过上述的第一校正用标记30的第一位置rPu1和第二位置rPu2的直线设为Z轴,求出与Z轴垂直地交叉并且包括点rPm2的平面S,当将该平面S与Z轴的交点设为原点时,将从该原点朝向RPui的方向设为Z轴的正向。
[0086]接下来,如图12所示,决定将从平面S的原点朝向第二校正用标记32的位置rPm2的方向设为正向的假定的X,轴,并对由该X,轴、在平面S上延伸且与X7轴正交的Y'轴、以及与X7轴及V轴双方正交的Z'轴构成的假定的坐标系{B' }进行定义,由此能够得到从机器人坐标系{R}向坐标系{B'}的坐标变换矩阵f。此外,坐标系{B'}的定义的方法并不限定于此。
[0087]另外,根据第二校正用标记32在基体坐标系{B}中的位置%2的^7成分,来求出以使该位置与基体坐标系{B}的X轴的正向直线重叠的方式使之旋转角度Θ的旋转变换矩阵V。
[0088]此处,如图12所示,由于假定的坐标系{BM的Z'轴与基体坐标系{B}的Z轴处于平行关系,所以根据坐标变换矩阵Iv以及旋转变换矩阵bR,能够求出从机器人坐标系{R}向基体坐标系{B}的坐标变换矩阵T。
[0089]在第二实施方式中,通过使用安装于主轴24的第一校正用标记30在机器人坐标系{R}中的任意的两个位置的测量值、以及工作台26上的第二校正用标记32在机器人坐标系{R}以及基体坐标系{B}各个中的一个测量值,能够得到坐标变换矩阵T。这样,由于测量工作台26上的任意一个位置足以,所以能够扩大机器人14的能够配置区域。并且,在第二实施方式中,不需要如第一实施方式那样考虑偏置量,但第一校正用标记30需要具备能够作为工具而安装于主轴24的构造。
[0090]接下来,参照图13以及图14对本申请发明的第三实施方式进行说明。
[0091]在第三实施方式中,如图13所示,作为协作系统的结构,除不使用第一或者第二实施方式中的第一校正用标记这一点之外,可以与第一实施方式相同,从而对于实质上同等的构成要素赋予与第一实施方式相同的符号,并省略详细的说明。
[0092]在第三实施方式中,设定了以下的定义或者条件(Cl)〜(c5)。此外,(Cl)〜(c5)与第一实施方式的(al)〜(a5)实质上相同。
[0093] (Cl)如图14所示,用{M}表示对机床12定义的坐标系(机械坐标系),并用{R}表示对机器人14定义的坐标系(机器人坐标系)。
[0094] (c2)机械坐标系{Μ}以及机器人坐标系{R}均是具有相互正交的三个轴(x、y、z)的正交坐标系,但也可以使用极坐标。并且,在图14所示的机械坐标系{M}中,X轴是上下方向,Y轴是左右方向,Z轴是与纸面垂直的方向,另一方面,在机器人坐标系{R}中,X轴是左右方向,Y轴是上下方向7轴是与纸面垂直的方向。
[0095] (c3)机械坐标系{Μ}的原点固定于工作台26,该原点的位置(x、y、z)在从机器人14侧观察工作台26时的工作台26的左内的角落(参照图14)成为(x、y) = (0、0),另外,在安装于主轴24的工具(未图示)的前端点(工具前端点)处于工具更换位置时成为z = 0。其中,机械坐标系{M}的原点位置、各基本轴的方向并不限定于此。
[0096] (c4)机械坐标系{M}、机器人坐标系{R}以及对摄像机22定义的摄像机坐标系分别结束校正。并且,机器人坐标系{R}与摄像机坐标系之间的位置关系(坐标变换手段)是已知的。
[0097] (c5)如图14所示,为方便计算,在机床12的规定位置(例如工作台26)定义坐标系(机械基体坐标系),并用{B}表示。图14中举例表示的机械基体坐标系(以下,也简称作基体坐标系){ B}以主轴24的中心轴线与工作台26的表面(上表面)交叉的点作为原点,基体坐标系{B}的各基本轴(X、y、z)的方向与机械坐标系{M} —致。也就是说,基体坐标系{B}相当于使机械坐标系{M}平行移动后的坐标系。
[0098]接下来,在第三实施方式的协作系统10中,说明在上述的定义或者条件下、取得用于进行从机器人坐标系{R}向基体坐标系{B}的坐标变换的坐标变换矩阵T的顺序。
[0099]首先,使用安装于机床12的主轴24的测量用探测器28,与第一实施方式相同地对安装于工作台26的第二校正用标记32的位置进行测量。通过该测量,得到第二校正用标记32在机械坐标系{M}中的位置%»1。
[0100]接下来,使工作台26向任意的位置移动。其中,第二校正用标记32的中心不与主轴24的中心轴线重叠。使用此时的第二校正用标记32在机械坐标系{M}中的坐标值%(^1,来求出第二校正用标记32在机械坐标系{M}中的位置,并将其变换为在基体坐标系{B}中的坐标值,将变换后的坐标值设为bPm1。使用适当的手段向机器人控制装置16发送坐标值BPM1。
[0101]接下来,以使安装于工作台26的第二校正用标记32与安装于机器人14的手指尖的摄像机22之间的距离变得适当、并且能够以足够的精度测量第二校正用标记32的位置的方式,使用机器人控制装置16来使机器人14动作。而且用摄像机22拍摄第二校正用标记32,而得到第二校正用标记32在机器人坐标系{R}中的位置(测量值)RPM1。
[0102]通过以上的操作,得到一组第二校正用标记32在机器人坐标系{R}以及基体坐标系{B}中的各个位置、即位置的组(BPM1、RPM1)。如图14所示,改变工作台26的位置而另外进行两次得到该位置的组的操作,另外取得两组第二校正用标记32的位置的组((BPM2、RPM2)、(BPM3、RPM3))。
[0103]根据像这样得到的第二校正用标记32在机器人坐标系{R}中的三个坐标(RPM1、rPM2、rPM3),能够规定一个平面。与该平面垂直的轴与基体坐标系{B}的Z轴平行,将在基体坐标系{B}中的三个坐标(bPm1、bPm2、bPm3 )中的一个(所朝向的方向)设为Z轴的正向。
[0104]接下来,如图14所示,将上述平面上的任意一点(此处为叩祖丨设为原点,决定将从rPm1朝向rPm2的方向设为正向的假定的X7轴,并对由该X7轴、在由机器人坐标系{R}中的三个坐标规定的平面上延伸且与V轴正交的V轴、以及与V轴及V轴双方正交的Z7轴构成的假定的坐标系{B' }进行定义,来求出用于进行从机器人坐标系{R}向坐标系{B' }的坐标变换的坐标变换矩阵T'。基体坐标系{B}的Z轴与假定的坐标系{B,丨的^轴平行,其正向也一致。此外,坐标系{B' }的定义的方法并不限定于此。
[0105]接下来,求出从BPMl至BPM2的差(矢量),并求出用于使该矢量与基体坐标系{B}中表示X轴的正向的直线一致的、绕Z轴的旋转变换矩阵bIT。根据坐标变换矩阵Iv以及旋转变换矩阵bIT,来得到用于从机器人坐标系{R}向假定的坐标系{B〃}进行坐标变换的坐标变换矩阵T〃。
[0106]假定的坐标系{Β〃}和基体坐标系{B}处于相互平行移动后的位置关系,能够根据由中^表示的坐标值求出其平行移动的方向以及距离。因此,根据bPm1以及坐标变换矩阵Τ〃,能够求出从机器人坐标系{R}向基体坐标系{B}的坐标变换矩阵T。
[0107]在第三实施方式中,通过使用工作台26上的第二校正用标记32在机器人坐标系{R}以及基体坐标系{B}各个中的三个测量值(位置的组),能够得到坐标变换矩阵Τ。并且,在第三实施方式中,由于不需要安装于主轴24的第一校正用标记,所以不需要使摄像机22接近主轴24来进行测量,从而能够进一步扩大机器人14的能够配置区域。
[0108]接下来,参照图15〜图18对本申请发明的第四实施方式进行说明。如图15所示,第四实施方式的协作系统40具备加工中心等机床42、进行机床42的加工对象物的处理等相对于机床42的作业的机器人44、以及控制机器人44的动作的机器人控制装置,且具有将后述的机械坐标系设定为机器人控制装置的功能。机器人控制装置与机床42(或者其控制装置)连接,但对此未图示。
[0109]机器人44例如是六轴多关节机器人,具有臂46、安装于臂46的前端的手48等机器人可动部,在该机器人可动部(优选为手48的前端)安装有摄像机50。并且,机器人44在设于机床42的内部的台架轴52安装,并且能够沿台架轴52移动。
[0110]机床42具有:构成为把持工具且(图示例子中铅垂轴线方向)能够旋转的主轴54;以及构成为能够载置机床42的加工对象物(工件)等的工作台56。并且,至少三个校正用标记设置在机床42的内部的相互不同的规定位置(优选为固定位置)。图示例子中,将机床42的内部分割为包括主轴54的加工区域、和包括机器人44进行作业的作业台58的机器人作业区域,在防止来自加工区域的切削油、切肩等的飞散的间隔件60的不同的两个位置(图示例子中间隔件60的上表面和侧面)分别形成有第一校正用标记62以及第二校正用标记64,并且在作业台58上形成第三校正用标记66。
[0111]在第四实施方式中,设定了以下的定义或者条件(dl)〜(d6)。此外,(dl)〜(d5)与第一实施方式的(al)〜(a5)实质上相同。
[0112] (dl)如图16所示,用{M}表示对机床42定义的坐标系(机械坐标系),并用{R}表示对机器人44定义的坐标系(机器人坐标系)。
[0113] (d2)机械坐标系{M}以及机器人坐标系{R}均是具有相互正交的三个轴(x、y、z)的正交坐标系,但也可以使用极坐标。并且,在图16所示的机械坐标系{M}中,X轴是左右方向,Y轴是与纸面垂直的方向,Z轴是上下方向,另一方面,在机器人坐标系{R}中,X轴是左右方向4轴是与纸面垂直的方向,Z轴是上下方向。
[0114] (d3)机械坐标系{M}的原点固定于工作台56,该原点的位置(x、y、z)在从机器人44侧观察工作台56时的工作台56的左内的角落成为(x、y) = (0、0),另外,在安装于主轴54的工具(未图示)的前端点(工具前端点)处于工具更换位置时成为z = 0。
[0115] (d4)机械坐标系{Μ}、机器人坐标系{R}以及对摄像机50定义的摄像机坐标系分别结束校正。并且,机器人坐标系{R}与摄像机坐标系之间的位置关系(坐标变换手段)是已知的
[0116] (d5)如图16所示,为方便计算,在机床42的规定位置(例如工作台56)定义坐标系(机械基体坐标系),并用{B}表示。图16中举例表示的机械基体坐标系(以下,也简称作基体坐标系){ B}以主轴54的中心轴线与工作台56的表面(上表面)交叉的点作为原点,基体坐标系{B}的各基本轴(X、y、z)的方向与机械坐标系{M} —致。也就是说,基体坐标系{B}相当于使机械坐标系{M}平行移动后的坐标系。
[0117] (d6)设于机床42的内部的三个校正用标记在基体坐标系{B}中的位置(坐标值)全部已知。此时,从基体坐标系{B}的原点向第一〜第三校正用标记的坐标矢量分别由叩祖、BPM2、以及%3表不。
[0118]接下来,在协作系统40中,参照图15〜图18,说明在上述的定义或者条件下、取得用于进行从机器人坐标系{R}向基体坐标系{B}的坐标变换的坐标变换矩阵T的顺序。
[0119]首先,如图15所示,将机床42以及机器人44配置于预先决定的位置(图17的步骤S21),在机床42的规定位置(此处为间隔件60以及作业台58)形成第一〜第三校正用标记62、64以及66(图17的步骤S22)。
[0120] 此处,由于基体坐标系{B}中的三个校正用标记的坐标值BPM1、BPM2、以及bPm3全部已知,所以使用这些坐标值来定义假定的坐标系{B' },而求出从坐标系{B' }向基体坐标系{B}的坐标变换矩阵Tb。此处,如图16所示,定义ώΒΡΜ1、ΒΡΜ2、以及bPm3这三点规定的平面,将第一校正用标记62的位置bPm1S为原点,将在该平面上延伸并且与从原点朝向bPm3的方向相反的方向设为假定的V轴,将在该平面上延伸并且与X,轴正交的方向设为假定的Z'轴,并将与V轴及Z'轴双方正交的方向设为假定的矿轴,由此能够定义坐标系{B' }。此外,坐标系{B' }的定义的方法并不限定于此,例如也能够定义以bPm2或者bPm3为原点的假定的坐标系。
[0121]接下来,如图18所示,使用设于机器人44的摄像机50(具体而言,以使第一校正用标记62进入摄像机50的视场内的方式控制机器人44),拍摄第一校正用标记62。通过该处理,得到第一校正用标记62在机器人坐标系{R}中的位置%祖。同样,使用摄像机50拍摄第二校正用标记64,而取得第二校正用标记64在机器人坐标系{R}中的位置中似。另外同样地,使用摄像机50拍摄第三校正用标记66,而取得第三校正用标记66在机器人坐标系{R}中的位置%1«3(图17的步骤S23)。
[0122]通过使用由摄像机50得到的三个校正用标记在机器人坐标系{R}中的三个坐标值(■^、■^^、■^^,来求出从机器人坐标系㈨向假定的坐标系…丨的坐标变换矩阵^另外,使用该坐标变换矩阵Tr和上述的坐标变换矩阵Tb,来求出从机器人坐标系{R}向基体坐标系{B}的坐标变换矩阵T(图17的步骤S24)。即,T = TR(TB)—工(其中,(Tb)—1是指Tb的逆矩阵)。
[0123]在第四实施方式中,通过将至少三个校正用标记设为在定义于机床的规定位置的坐标系中的位置已知,能够仅使用机器人的摄像机来测量上述校正用标记,就能够得到机器人和机床共用的坐标系。因此,不需要根据校正用标记的位置而使机器人接近机床的主轴、工作台,从而例如能够使机器人仅在由间隔件分隔了的机器人作业区域内进行动作等,而能够与其作业内容对应地适当地设定机器人的动作范围,也能够扩大机器人的能够配置区域。
[0124]接下来,参照图19〜图22对本申请发明的第五实施方式进行说明。如图19所示,第五实施方式的协作系统70具备机床(图示例子中为NC车床)72、以及与机床72连接并且进行机床72的加工对象物的处理等相对于机床72的作业的机器人74,且具有将后述的机械坐标系设定为机器人控制装置的功能。机器人74例如是六轴多关节机器人,具有臂76、安装于臂76的前端的手78等机器人可动部,在该机器人可动部(优选为手78的前端)安装有摄像机80 ο机器人控制装置与NC车床72连接,但对此未图示。
[0125]另一方面,机床72具备:床身82;配置在床身82上的主轴座84;具有把持工具的卡盘86并且以(图示例子中沿水平轴线方向)旋转的方式设于主轴座84的主轴88;配置在床身82上的尾座90;构成为能够相对于床身82移动的横向滑板92;以及设于横向滑板92的刀架转塔94。并且,在第五实施方式中,机器人74配置在主轴座84上,测量用探测器96以与工具相同的形态(通常为以能够装卸的方式)安装于刀架转塔94。此外,能够在卡盘86安装具备至少三个校正用标记的带标记的夹具98。
[0126]在第五实施方式中,设定了以下的定义或者条件(el)〜(e5)。
[0127] (el)如图20所示,用{Μ}表示对NC车床72定义的坐标系(机械坐标系),并用{R}表示对机器人74定义的坐标系(机器人坐标系)。
[0128] (e2)机械坐标系{Μ}的原点固定在主轴88的中心轴线上,并且,机械坐标系{Μ}的朝向以JIS B6310为基准,图20中上方相当于其X轴的正向。
[0129] (e3)机械坐标系{M}、机器人坐标系{R}以及对摄像机80定义的摄像机坐标系分别结束校正。并且,机器人坐标系{R}与摄像机坐标系之间的位置关系(坐标变换手段)是已知的。
[0130] (e4)如图21a以及21b所示,带标记的夹具98的主体呈大致圆筒形状,在其侧面的相同圆周上的不同角度位置形成有第一〜第三校正用标记100、102以及104。三个标记的角度位置关系能够任意决定,但在图示例子中,成为相互分离120度的等间隔配置。
[0131] (e5)带标记的夹具98的三个标记100、102以及104的相对位置关系通过预先的测量等而已知。
[0132]接下来,在第五实施方式的协作系统70中,说明在上述的定义或者条件下、取得用于进行从机器人坐标系{R}向机械坐标系{M}的坐标变换的坐标变换矩阵T的顺序。
[0133]首先,如图20所示,将带标记的夹具98安装于NC车床72的卡盘86,以低速进给主轴88,直至夹具98的一个校正用标记(此处为第一校正用标记100)的中心与工具(测量用探测器96)前端抵接。之后,使用安装于刀架转塔94的测量用探测器96,对第一校正用标记100在机械坐标系{M}的Z-X平面上的位置(坐标值)进行测量。此处,由于第一〜第三校正用标记的相对位置关系是已知的,所以通过测量第一校正用标记100的位置,能够使用其相对位置关系来求出第二校正用标记102以及第三校正用标记104的位置(坐标值)。
[0134]根据在机械坐标系{M}中得到的三个(校正用标记的)坐标值来定义坐标系{M, },并求出从机械坐标系{M}向坐标系{iT }的坐标变换矩阵Tm。此外,对于坐标系{iT }的定义的方法,可以与第三或者第四实施方式中的假定的坐标系{BM的定义相同,从而省略详细的说明。
[0135]接下来,如图22所示,使刀架转塔94(横向滑板92)从主轴88退避,以使第一校正用标记100与安装于机器人74的手指尖的摄像机80之间的距离变得适当、并且能够以足够的精度测量第一校正用标记100的位置的方式,使机器人74动作。而且用摄像机80拍摄第一校正用标记100,而得到第一校正用标记100在机器人坐标系{R}中的位置(测量值)。同样,也使用摄像机80对第二校正用标记102以及第三校正用标记104在机器人坐标系{R}中的位置进行测量。
[0136]此处,只要带校正用标记的夹具98的三个校正用标记处于主轴88的中心轴线的相同圆周上,能够以任意的角度间隔安装,但安装于机器人74的摄像机80优选配置在能够容易进行各标记的测量那样的角度位置。
[0137]根据在机器人坐标系{R}中得到的三个(校正用标记的)坐标值,求出从机器人坐标系{R}向坐标系{Μ,}的坐标变换矩阵TR。
[0138]使用像这样得到的坐标变换矩阵Tm以及TR,能够求出从机器人坐标系{R}向机械坐标系{M}的坐标变换矩阵T。即,T = Tr(Tm)—H其中,(Tm)—1是指Tm的逆矩阵)。
[0139]在第五实施方式中,通过使用带校正用标记的夹具,来取得在机械坐标系{M}中的三点坐标值、和与其对应的机器人坐标系中的三点坐标值,由此能够得到从机器人向机床(NC车床)的坐标变换矩阵。也就是说,由于机器人并不是仅取得加工对象的坐标系,所以除加工对象的处理以外,也能够使机器人进行NC车床的检查以及诊断、切肩的清扫等作业。
[0140]此外,在NC车床72是车削加工中心的情况下,由于车削加工中心具有主轴分度(C轴进给)功能,所以在带校正用标记的夹具98仅设置一个校正用标记足以。具体而言,对于一个校正用标记而言,在进行了测量用探测器96的(机械坐标系{M}中的)测量、和使用了摄像机80的(机器人坐标系{R}中的)测量之后,进行第一次的C轴进给。根据此时的进给量,来求出该校正用标记在机械坐标系{M}中的位置,并且进行使用了摄像机80的测量。另外,进行第二次的C轴进给,并根据此时的进给量,来求出该校正用标记在机械坐标系{M}中的位置,并且进行使用了摄像机80的测量。综上所述,对于校正用标记而言,由于得到三组机械坐标系{M}中的坐标值和机器人坐标系{R}中的坐标值,所以能够求出坐标变换矩阵T。
[0141]在上述的各实施方式中,机器人控制装置能够自动地控制机器人,以使摄像机与校正用标记的相对位置关系成为能够用摄像机测量校正用标记的位置的关系。具体而言,当以使校正用标记与机器人的摄像机的相对距离变得适当的方式控制机器人时,在使机器人动作前(即处于初始位置时)用摄像机拍摄校正用标记,利用得到的拍摄信息,而能够进行使机器人自动地接近校正用标记这样的控制。此外,这能够应用上述的日本特开2009-279677号公报所记载的技术。这样的话,能够自动地进行测量校正用标记在机器人坐标系中的位置的一系列的动作,从而作业者的负担减少。
[0142]根据本发明,由于能够以简易的结构且精度良好地得到从设定于机器人的机器人坐标系向定义于机床的规定位置的机械坐标系的坐标变换手段,所以能够容易地作成相对于机床进行包括加工对象的处理的各种作业的机器人程序。并且,能够扩大机器人的能够配置范围,也能够缩小在离线模拟装置中无法考虑的非线形的模型化误差。
[0143]并且,根据本发明,由于能够在机器人和机床中得到共用坐标系,所以当分别在机器人和机床中保有三维CAD模型信息时,在机器人作业时得到与机床相关的信息,而能够确认干涉的有无等。此时,由于机床的加工对象物等的定位的状态对于机器人是已知的,所以在进行机床的作业时,产生不需要必须使机器人退避至安全位置的情况,此时,由于也能够不等待机器人的移动结束就进行机床的作业,所以能够改善协作系统整体的作业效率。并且,由于在机器人中也能够利用机床的三维CAD模型信息,所以当机床产生异常时,也能够用安装于机器人的摄像机自动地检查机床。

Claims (3)

1.一种协作系统,具有机床和相对于上述机床进行作业的机器人,其特征在于,具备: 摄像机,其安装于上述机器人的可动部; 至少一个校正用标记,其设于上述机床; 第一标记坐标取得部,其取得上述校正用标记在对上述机床定义的机械坐标系中的第一坐标值; 第二标记坐标取得部,其通过用上述摄像机拍摄上述校正用标记,来取得上述校正用标记在对上述机器人设定的机器人坐标系中的第二坐标值;以及 坐标变换部,其基于上述校正用标记的上述第一坐标值以及上述第二坐标值的多个组,来求出从上述机器人坐标系向上述机械坐标系的坐标变换手段。
2.根据权利要求1所述的协作系统,其特征在于, 上述校正用标记安装于上述机床的可动部, 上述第一标记坐标取得部分别在上述机床的可动部的多个位置中,取得多个上述校正用标记在上述机械坐标系中的第一坐标值, 上述第二标记坐标取得部分别在上述机床的可动部的多个位置中,通过用上述摄像机拍摄上述校正用标记,来取得多个上述校正用标记在对上述机器人设定的机器人坐标系中的第二坐标值。
3.根据权利要求1或2所述的协作系统,其特征在于, 自动地控制上述机器人,以使上述摄像机与上述校正用标记的相对位置关系成为能够用上述摄像机测量上述校正用标记的位置的关系。
CN201510688224.0A 2014-11-28 2015-10-21 机床以及具备机器人的协作系统 Active CN105643369B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2014242393A JP6126067B2 (ja) 2014-11-28 2014-11-28 工作機械及びロボットを備えた協働システム
JP2014-242393 2014-11-28

Publications (2)

Publication Number Publication Date
CN105643369A true CN105643369A (zh) 2016-06-08
CN105643369B CN105643369B (zh) 2018-04-10

Family

ID=55967992

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510688224.0A Active CN105643369B (zh) 2014-11-28 2015-10-21 机床以及具备机器人的协作系统

Country Status (4)

Country Link
US (1) US9895810B2 (zh)
JP (1) JP6126067B2 (zh)
CN (1) CN105643369B (zh)
DE (1) DE102015015094B4 (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108326837A (zh) * 2017-01-17 2018-07-27 发那科株式会社 离线编程装置和位置参数校正方法
WO2018209592A1 (zh) * 2017-05-17 2018-11-22 深圳配天智能技术研究院有限公司 一种机器人的运动控制方法、机器人及控制器
WO2020051748A1 (zh) * 2018-09-10 2020-03-19 深圳配天智能技术研究院有限公司 标定方法及标定装置

Families Citing this family (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10179407B2 (en) * 2014-11-16 2019-01-15 Robologics Ltd. Dynamic multi-sensor and multi-robot interface system
JP6181687B2 (ja) * 2015-03-13 2017-08-16 ファナック株式会社 加工により発生した切粉を除去可能な加工機システム
US9857786B2 (en) * 2015-03-31 2018-01-02 Recognition Robotics, Inc. System and method for aligning a coordinated movement machine reference frame with a measurement system reference frame
JP2016221645A (ja) * 2015-06-02 2016-12-28 セイコーエプソン株式会社 ロボット、ロボット制御装置およびロボットシステム
EP3147086B1 (de) * 2015-09-22 2020-11-04 Airbus Defence and Space GmbH Automatisieren von roboteroperationen im flugzeugbau
JP6333871B2 (ja) * 2016-02-25 2018-05-30 ファナック株式会社 入力画像から検出した対象物を表示する画像処理装置
US10551821B2 (en) * 2016-06-30 2020-02-04 Seiko Epson Corporation Robot, robot control apparatus and robot system
DE102016213663A1 (de) * 2016-07-26 2018-02-01 Siemens Aktiengesellschaft Verfahren zum Steuern eines Endelementes einer Werkzeugmaschine und eine Werkzeugmaschine
AT519176B1 (de) 2016-10-14 2019-02-15 Engel Austria Gmbh Robotersystem
JP2018094648A (ja) * 2016-12-09 2018-06-21 セイコーエプソン株式会社 制御装置、ロボットおよびロボットシステム
JP6922204B2 (ja) * 2016-12-09 2021-08-18 セイコーエプソン株式会社 制御装置、ロボットおよびロボットシステム
CN106926277A (zh) * 2017-03-07 2017-07-07 深圳华用科技有限公司 一种用于工业机器人定位的一体化智能相机
JP6880982B2 (ja) * 2017-04-21 2021-06-02 セイコーエプソン株式会社 制御装置およびロボットシステム
JP6490154B2 (ja) 2017-06-21 2019-03-27 ファナック株式会社 ワイヤ放電システムおよび相対位置算出方法
JP2019040264A (ja) * 2017-08-22 2019-03-14 ファナック株式会社 工作機械とロボットの連携システム
CN107953333B (zh) * 2017-12-20 2021-04-20 深圳大学 一种机械手末端工具标定的控制方法及系统
US10871366B2 (en) 2018-08-16 2020-12-22 Mitutoyo Corporation Supplementary metrology position coordinates determination system for use with a robot
US11002529B2 (en) 2018-08-16 2021-05-11 Mitutoyo Corporation Robot system with supplementary metrology position determination system
US10751883B2 (en) * 2018-08-16 2020-08-25 Mitutoyo Corporation Robot system with supplementary metrology position coordinates determination system
US10913156B2 (en) 2018-09-24 2021-02-09 Mitutoyo Corporation Robot system with end tool metrology position coordinates determination system
JPWO2020090042A1 (ja) * 2018-10-31 2021-06-10 株式会社ソニー・インタラクティブエンタテインメント トラッカーのキャリブレーション装置、トラッカーのキャリブレーション方法及びプログラム
CN110238849A (zh) * 2019-06-13 2019-09-17 深圳市汇川技术股份有限公司 机器人手眼标定方法及装置

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6681151B1 (en) * 2000-12-15 2004-01-20 Cognex Technology And Investment Corporation System and method for servoing robots based upon workpieces with fiducial marks using machine vision
JP2011048467A (ja) * 2009-08-25 2011-03-10 Fanuc Ltd 加工システム
CN102483621A (zh) * 2009-08-28 2012-05-30 瑞尼斯豪公司 机床校准方法
CN102554711A (zh) * 2010-12-07 2012-07-11 巨浪有限公司 用于确定工具位置的方法

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS59177607A (en) 1983-03-28 1984-10-08 Fanuc Ltd Automatic programming method
JPH05212652A (ja) 1992-02-05 1993-08-24 Toyoda Mach Works Ltd オンマシン計測装置を搭載した精密加工機
JPH05324034A (ja) 1992-05-20 1993-12-07 Meidensha Corp ロボットの制御方法
JPH08229774A (ja) * 1995-03-02 1996-09-10 Toshiba Mach Co Ltd 工作機械の変形補正加工法
GB9515311D0 (en) 1995-07-26 1995-09-20 3D Scanners Ltd Stripe scanners and methods of scanning
US6615112B1 (en) * 1999-06-26 2003-09-02 Kuka Schweissanlagen Gmbh Method and device for calibrating robot measuring stations, manipulators and associated optical measuring devices
US6873880B2 (en) * 2001-12-26 2005-03-29 Lockheed Martin Corporation Machine for performing machining operations on a workpiece and method of controlling same
JP2005138223A (ja) * 2003-11-06 2005-06-02 Fanuc Ltd ロボット用位置データ修正装置
JP4271232B2 (ja) * 2006-12-20 2009-06-03 ファナック株式会社 ロボットのオフラインプログラミングを実行するための装置、方法、プログラム及び記録媒体
JP5113623B2 (ja) 2008-05-20 2013-01-09 ファナック株式会社 計測装置を用いてロボットの位置教示を行うロボット制御装置
JP5744587B2 (ja) * 2011-03-24 2015-07-08 キヤノン株式会社 ロボット制御装置、ロボット制御方法、プログラム及び記録媒体
JP6108860B2 (ja) * 2013-02-14 2017-04-05 キヤノン株式会社 ロボットシステム及びロボットシステムの制御方法
JP6415190B2 (ja) * 2014-09-03 2018-10-31 キヤノン株式会社 ロボット装置、ロボット制御プログラム、記録媒体、およびロボット装置の制御方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6681151B1 (en) * 2000-12-15 2004-01-20 Cognex Technology And Investment Corporation System and method for servoing robots based upon workpieces with fiducial marks using machine vision
JP2011048467A (ja) * 2009-08-25 2011-03-10 Fanuc Ltd 加工システム
CN102483621A (zh) * 2009-08-28 2012-05-30 瑞尼斯豪公司 机床校准方法
CN102554711A (zh) * 2010-12-07 2012-07-11 巨浪有限公司 用于确定工具位置的方法

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108326837A (zh) * 2017-01-17 2018-07-27 发那科株式会社 离线编程装置和位置参数校正方法
US10406691B2 (en) 2017-01-17 2019-09-10 Fanuc Corporation Offline programming device and position-parameter correcting method
WO2018209592A1 (zh) * 2017-05-17 2018-11-22 深圳配天智能技术研究院有限公司 一种机器人的运动控制方法、机器人及控制器
WO2020051748A1 (zh) * 2018-09-10 2020-03-19 深圳配天智能技术研究院有限公司 标定方法及标定装置

Also Published As

Publication number Publication date
JP6126067B2 (ja) 2017-05-10
JP2016101640A (ja) 2016-06-02
DE102015015094B4 (de) 2018-11-15
US20160151915A1 (en) 2016-06-02
US9895810B2 (en) 2018-02-20
CN105643369B (zh) 2018-04-10
DE102015015094A1 (de) 2016-06-02

Similar Documents

Publication Publication Date Title
CN105643369A (zh) 机床以及具备机器人的协作系统
CN105091807B (zh) 机器人工具坐标系的校正方法
US8457786B2 (en) Method and an apparatus for calibration of an industrial robot system
CN103365246B (zh) 用于数控机床的误差校正的装置
JP2008152733A (ja) ロボットのオフラインプログラミングを実行するための装置、方法、プログラム及び記録媒体
KR20160010868A (ko) 비전을 갖는 자동화 기계가공 헤드 및 방법
JP4087841B2 (ja) ロボット制御装置
JP5459486B2 (ja) ロボットのキャリブレーション方法および装置
CN102802883B (zh) 工业机器人的基座坐标系的校准
JP2015136770A (ja) 視覚センサのデータ作成システム及び検出シミュレーションシステム
JP2015203567A (ja) 計測システム
WO2009123956A1 (en) Robot parts assembly on a workpiece moving on an assembly line
CN107995885B (zh) 一种坐标系标定方法 、系统及装置
CN110148187B (zh) 一种SCARA机械手Eye-in-Hand的高精度手眼标定方法和系统
CN107073714A (zh) 用于修正机器人引导工具的加工轨迹的方法和系统
JP2019014011A (ja) ロボットの教示位置補正方法
CN107717988A (zh) 一种基于泛克里金的工业机械臂精度标定方法
TW201816531A (zh) 具有空間位置誤差補償的數值控制工具機
JP5645760B2 (ja) ロボットのツールパラメータの補正方法
JP6647308B2 (ja) 多関節ロボットのティーチングシステム
Mako Principles of Mastering at KUKA Robots
CN204585243U (zh) 一种无动力关节臂结构
DE102014012670A1 (de) Verfahren zum Kalibrieren eines zumindest einfach kinematisch redundanten Roboters
JP2012110983A (ja) 主軸定位置停止の指令方法及びワーク測定方法
TW202128378A (zh) 校準方法及校準系統

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant