CN103608151A - 机器人的刀具参数的修正方法 - Google Patents

机器人的刀具参数的修正方法 Download PDF

Info

Publication number
CN103608151A
CN103608151A CN201280029259.8A CN201280029259A CN103608151A CN 103608151 A CN103608151 A CN 103608151A CN 201280029259 A CN201280029259 A CN 201280029259A CN 103608151 A CN103608151 A CN 103608151A
Authority
CN
China
Prior art keywords
cutter
robot
parameters
angle
cutter parameters
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
CN201280029259.8A
Other languages
English (en)
Other versions
CN103608151B (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.)
Kobe Steel Ltd
Original Assignee
Kobe Steel Ltd
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
Application filed by Kobe Steel Ltd filed Critical Kobe Steel Ltd
Publication of CN103608151A publication Critical patent/CN103608151A/zh
Application granted granted Critical
Publication of CN103608151B publication Critical patent/CN103608151B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23KSOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
    • B23K9/00Arc welding or cutting
    • B23K9/12Automatic feeding or moving of electrodes or work for spot or seam welding or cutting
    • B23K9/127Means for tracking lines during arc welding or cutting
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/401Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for measuring, e.g. calibration and initialisation, measuring workpiece for machining purposes
    • G05B19/4015Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for measuring, e.g. calibration and initialisation, measuring workpiece for machining purposes going to a reference at the beginning of machine cycle, e.g. for calibration
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23KSOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
    • B23K37/00Auxiliary devices or processes, not specially adapted to a procedure covered by only one of the preceding main groups
    • B23K37/02Carriages for supporting the welding or cutting element
    • B23K37/0252Steering means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23KSOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
    • B23K9/00Arc welding or cutting
    • B23K9/24Features related to electrodes
    • B23K9/28Supporting devices for electrodes
    • B23K9/287Supporting devices for electrode holders
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Mechanical Engineering (AREA)
  • Plasma & Fusion (AREA)
  • Optics & Photonics (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Robotics (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

本发明提供通过简单的机器人的动作、不依赖于作业者的熟练度、技能等而在短时间内高精度地修正刀具参数的方法。在导出用于确定安装于在焊接机器人(2)的臂前端设置的凸缘部(7)的焊接刀具(6)的前端位置的刀具参数的方法中,使焊接刀具(6)采取不同的三个以上的姿势角,在各姿势角下使焊接刀具(6)的前端点(P)沿基础坐标系的-Zb方向移动至作为基准面的平板(8)。而且,在各姿势角下,计测焊接刀具(6)的前端点(P)到达平板(8)时的前端点(P)的位置偏移量,求出平移成分变化量,基于该求出的平移成分变化量修正刀具参数。

Description

机器人的刀具参数的修正方法
技术领域
本发明涉及安装于焊接机器人等的前端的刀具,涉及简单且在短时间内高精度地修正刀具参数的技术。
背景技术
例如,在相对于工件自动地进行焊接的焊接机器人中,在该焊接机器人的前端部分(凸缘部)安装有具备焊炬等的刀具(工具)。
在该焊接刀具的前端部设定有刀具坐标系,该刀具坐标系通过使用利用了刀具参数的变换炬阵能从凸缘坐标系进行坐标变换。凸缘坐标系是在形成于焊接机器人的前端部的凸缘部设定的坐标系,该凸缘坐标系通过控制装置基于焊接机器人的各轴的数据计算出。
由以上明确可知,为了在控制装置中正确地把握刀具前端的位置,需要预先正确地导出坐标变换不可缺少的刀具参数。刀具参数的导出作业有时在更换焊接机器人的刀具之后进行,但在刀具与作业工件等碰撞时等而刀具参数发生改变时也进行。
作为涉及刀具参数的导出、校正的技术,例如有专利文献1~3公开的技术。
在专利文献1中公开有这样的机器人的工具位置设定方式:设置至少指定了三个位置的夹具,使该夹具的任意一个位置与工具的应设定的位置一致,能自动地设定所述工具的应设定的位置。
在专利文献2中公开有这样的机器人的刀具参数校正方法:基于对安装于机器人的臂前端的刀具在空间上的一点至少以不同的三个姿势定位时的各定位数据运算出上述刀具的安装部的坐标系,基于相对于从使用刀具参数表现的上述安装部的坐标系看出的刀具位置候补的平均值的偏差推定上述刀具参数的校正值。
在专利文献3中公开有一种机器人的偏芯修正方法,该机器人的偏芯修正方法具有下述工序:在机器人的动作范围内对具有导电性的三个平板和设于所述作业工具的一部分的具有导电性的触头之间施加电压,使机器人向预先设定的方向动作的工序;检测该平板与该触头的电接触的工序;算出该机器人的前次的位置数据和本次的位置数据的差分而运算出该作业工具的作业点和基准点的误差的工序;使该作业工具的作业点向吸收该误差的方向移动的工序。
在先技术文献
专利文献
专利文献1:日本特开昭61-25206号公报
专利文献2:日本特许第2774939号公报
专利文献3:日本特开平1-257593号公报
发明内容
发明要解决的课题
通过使用专利文献1、专利文献2公开的技术能导出及校正机器人的刀具(工具)位置、刀具参数。但是,在专利文献1、专利文献2的技术中,在校正作业中不仅需要专用的夹具、销,还必需通过操作员的操作使刀具的前端正确地向夹具的规定位置、销的前端移动。这样的定位作业受操作员的熟练度、目视的方向等的影响,难以正确地进行。另外,由于校正后的验证也通过操作员的目视进行,因此,也难以定量的把握。换言之,在这些技术中,操作员的熟练度、技能等给刀具的定位、精度、刀具参数的导出精度带来影响。
专利文献3公开的技术使用使三个平板正交地组装成的专用夹具和接触传感器,使刀具前端分别与该夹具的三个平板各接触一次共接触三次。利用这样的传感动作求出规定的基准点和刀具前端的差分矢量,基于求出的差分矢量修正机器人的偏芯。
在这样的专利文献3的技术中,需要将专用夹具设置为相对于机器人高精度地定位。但是,在根据差分矢量计算刀具参数时,从机器人坐标看出的夹具的方向角(α,β,γ)必需是已知的。但是,由于无法通过目视确认机器人坐标,因此,相对于无法目视的机器人坐标高精度地设置夹具或计测从机器人坐标看出的夹具的方向角(α,β,γ)是非常困难的。
另外,为了高精度地获得刀具前端和夹具的三个平板的差分矢量,需要使刀具前端相对于各平板“大致垂直地点接触”。因此,每次改变夹具的设置场所、角度,都必须通过示教改变传感动作方法。在这样的传感动作中,在保持刀具的姿势角的状态下使刀具前端沿机器人坐标的X轴、Y轴、Z轴这三个方向移动。此时,操纵装置的所有轴进行动作,因此,不能排除机器人的所有关节的定位误差与要获得的差分矢量重叠的可能性。
如上述那样,专利文献1~专利文献3公开的刀具参数的导出及修正技术不仅对操作员要求较高的熟练度,而且需要花费较多的劳力和时间的负担较大的作业。而且,需要将专用的夹具相对于机器人高精度地定位,很难说是在实际的现场中能简单地采用的技术。
因此,本发明是鉴于上述问题点而做成的,其目的在于提供通过简单的机器人的动作、不依赖作业者的熟练度、技能等而在短时间内高精度地修正刀具参数的方法。
用于解决课题的手段
为了达到上述的目的,在本发明中采取了以下的技术手段。
本发明涉及的机器人的刀具参数的修正方法是导出用于确定安装于凸缘部的刀具的前端位置的刀具参数的方法,该凸缘部设置在机器人的臂前端上,所述机器人的刀具参数的修正方法的特征在于,使所述刀具采取不同的三个以上的姿势角,在各姿势角下,使所述刀具的前端在保持姿势角的状态下沿一方向移动至基准面,在各姿势角下,计测所述刀具的前端到达所述基准面时的该刀具前端的位置偏移量而求出平移成分变化量,基于该求出的平移成分变化量修正刀具参数。
在此,优选为,在所述刀具的各姿势角下,使所述刀具的前端沿机器人的基础坐标中的垂直轴方向移动至所述基准面,而求出所述平移成分变化量。
另外,优选为,在所述机器人采取的三个以上的姿势角中的最初的姿势角下,所述凸缘部相对于所述基准面垂直或水平。
此外,优选为,所述各姿势角通过使所述刀具绕所述机器人的基础坐标中的各垂直轴旋转来指定。
另外,优选为,在所述机器人采取的多个姿势角中的最初的姿势角下,绕基础坐标中的Y轴的旋转角为0度或90度。
发明效果
使用本发明涉及的技术,能通过简单的机器人的动作、不依赖于作业者的熟练度、技能等而在短时间内高精度地修正刀具参数。
附图说明
图1是本发明的实施方式的机器人系统的整体结构图。
图2A是表示机器人与各坐标系的关系的、整体的概略图。
图2B是表示机器人与各坐标系的关系的图,是放大表示机器人的臂前端附近(刀具部分)的图。
图3A是表示在本实施方式的刀具参数的修正方法中用于求出接触距离的动作的、整体的概略图。
图3B是表示在本实施方式的刀具参数的修正方法中用于求出接触距离的动作的图,是放大表示机器人的臂前端附近的图。
图4是表示本实施方式的刀具参数的修正方法的动作步骤的流程图。
图5是表示本实施方式的刀具参数的修正方法的变形例的图。
具体实施方式
基于附图说明本发明的实施方式。需要说明的是,在以下的说明中,对于同一部件标注同一符号。它们的名称及功能也相同。因此,不重复关于它们的详细的说明。
首先,说明本实施方式的机器人系统1的整体结构。
如图1所示,机器人系统1包括焊接机器人2、具备示教手持控制器3的控制装置4、个人计算机(personal computer)5。焊接机器人2是垂直多关节型的六轴的工业用机器人(多关节操纵装置),在设于其前端的凸缘部7安装有由焊炬等构成的焊接刀具6。该焊接机器人2也可以搭载于使其自身移动的滑动件(未图示)。
控制装置4按照预先指示的程序控制焊接机器人2。指示程序有使用连接于控制装置4的示教手持控制器3作成的情况、使用利用了个人计算机5的离线示教系统作成的情况。在任一場合下,指示程序在焊接机器人2实际动作之前预先作成。利用个人计算机5离线地作成的示教程序通过磁性地或电气地存储数据的介质等转送给控制装置4或通过数据通信传送给控制装置4。
个人计算机5、即离线示教系统作为显示装置具备能进行图表显示的显示器,作为输入装置具备键盘、鼠标。另外,为了引进工件W的CAD信息,设有读取装置或通信装置。
顺便说一下,本申请发明涉及用于准确地修正为了正确地把握焊接刀具6的前端点的位置(前端位置)所必需的刀具参数的方法。该方法大体具有以下所示的三个工序。
<工序i>使已经设定有刀具参数的焊接机器人2及焊接刀具6采取规定的姿势(姿势角),使焊接刀具6的前端点P沿Zb轴方向移动至作为基准面的平板8。此时,根据焊接刀具6的前端点P到达平板8时的前端点P的位置求出焊接刀具6的前端点P的移动距离作为接触距离。
<工序ii>使焊接机器人2及焊接刀具6采取不同的三个以上的姿势(姿势角),在各姿势(姿势角)下实施工序i。
<工序iii>根据在各姿势(姿势角)下求出的接触距离算出基础坐标系中的焊接刀具6的更换前后的前端点P的位置变化量(位置偏移量)。在此基础上,基于算出的前端点P的位置变化量求出刀具参数的平移成分变化量,基于求出的平移成分变化量修正刀具参数。
具有工序i~工序iii的刀具参数的修正处理通过存储于控制装置4或个人计算机5内的程序实现。
顺便说一下,如图2A、图2B所示,刀具参数是进行从凸缘坐标系向刀具坐标系的坐标变换时必需的变换参数(变换炬阵)。刀具坐标系是用于表现焊接刀具6的前端点P(焊接点)的位置(TCP:Tool Center Point)的坐标系。
凸缘坐标系是在形成于焊接机器人2的前端的凸缘部7设定的坐标系,在以焊接机器人2的第六轴(J6)的旋转中心为原点的坐标系。另外,如图2A所示,在焊接机器人2的基端部(第一轴J1)设定有焊接机器人2的基础坐标系。
焊接机器人2的刀具参数有(Tx,Ty,Tz,α,β,γ)的平移的三个成分和旋转的三个成分,在本实施方式中,主要仅着眼于三个平移成分(Tx、Ty、Tz)而将它们称作刀具参数,公开了修正该刀具参数的方法。
需要说明的是,姿势角相当于用于确定焊接机器人2、焊接刀具6的姿势的各关节的旋转角(例如凸缘部7的旋转角)。
以下,参照图3A~图5详细地说明本实施方式的刀具参数的修正方法。
[刀具矢量的修正方法<工序i>]
参照图3A及图3B说明使采取规定的姿势角的焊接刀具6的前端点P沿Zb轴方向(沿Zb轴的负方向)移动至平板8而求出前端点P的移动量(接触距离)的方法。
首先,在求出接触距离之前,将平板8设置于相对于焊接机器人2的位置固定的位置、换言之设置于在基础坐标系中固定的位置。以使设定于平板8上的面上的垂线与基础坐标系的Zb轴平行的方式设置平板8。需要说明的是,平板8不需要是为了修正刀具参数而新设置的专用夹具。使用存在于焊接机器人2周围的作业台、工件搭载用工作台及转动换位器等、具有与基础坐标系的XY平面平行的面的构件即可。
另外,焊接刀具6内置用于检测工件W的错位而通常使用的接触传感器,能检测焊条是否与作为基准面的平板8接触。
如图3A所示,焊接机器人2使内置了接触传感器的焊接刀具6在平板8的上方从动作开始TCP位置P0(X0,Y0,Z0,α0,β0,γ0)朝向动作完成TCP位置P1(X0,Y0,Z1,α0,β0,γ0)沿-Zb方向移动。
但是,由于在其移动途中存在有平板8,因此,焊接刀具6与平板8接触。焊接刀具6与平板8接触时,接触传感器检测到该接触,焊接机器人2在接触位置Ps(X0,Y0,Xs,α0,β0,γ0)处停止。由此,从动作开始TCP位置P0到接触位置Ps的移动距离ΔS通过式(1)获得。将利用该式得到的移动距离ΔS作为接触距离。
ΔS=Z0-Zs   (1)
[刀具矢量的修正方法<工序ii>]
接着,参照图4说明使焊接机器人2及焊接刀具6采取不同的三个以上的姿势角、在各姿势角下实施工序i并求出各姿势角下的接触距离的方法。
需要说明的是,在本实施方式中,考虑在焊接刀具6由于破损、故障等而更换为形状不同的新的焊接刀具6的情况、焊接刀具6由于与工件干涉等而发生变形、产生一些位置偏移的情况。也就是说,关于更换前、干涉前的焊接刀具6的刀具参数的平移成分(Xt,Yt,Zt)、不同的三个姿势角下的接触距离(Z1,Z2,Z3)是已知的,能确保精度。
在该条件下,通过图4的步骤S1~S3测定关于更换后、干涉后的焊接刀具6的、不同的三个姿势角下的接触距离(Z1’,Z2’,Z3’)。
首先,在图4的步骤S1中,以使焊接机器人2的凸缘面相对于平板8成为水平的方式、也就是使凸缘坐标系的Z轴(Zf轴)方向朝向与基础坐标系的Z轴(Zb轴)平行的Zb轴的负方向的方式确定焊接机器人2及焊接刀具6的姿势角。
而且,以使从基础坐标系看出的凸缘部7的旋转角(凸缘坐标系的Zf轴的旋转角)为以下所示的值的方式确定焊接机器人2及焊接刀具6的姿势角,将该姿势角作为第一姿势角。关于凸缘坐标系的Zf轴的旋转角,绕基础坐标系的Zb轴的角度为倾滚角α,绕基础坐标系的Y轴(Yb轴)的角度为俯仰角β,绕基础坐标系的X轴(Xb轴)的角度为偏摆角γ时,在第一姿势角下,(α,β,γ)=(任意,0°,180°)。
通过在保持这样的第一姿势角的状态下进行工序i的处理,能计测出接触距离。设在第一姿势角下获得的接触距离为Z1’。
接着,在步骤S2中,使焊接机器人2的第五轴(J5)移动,成为凸缘面相对于平板8倾斜规定角度的第二姿势角。也就是说,俯仰角β从步骤S1中的第一姿势角改变规定角度。在第一姿势角下,俯仰角β为0度,但在步骤S2的第二姿势角下,俯仰角β为Δθ5度。该Δθ5度不需要是某个特定的数值,只要是关节角的定位精度以上的值,可以为任意的值。
在第二姿势角下,(α,β,γ)=(任意,Δθ5°,180°)。
保持这样的第二姿势角的状态进行工序i的处理,计测出接触距离Z2’。
最后,在步骤S3中,使焊接机器人2的第六轴(J6)移动,成为凸缘面相对于平板8旋转了的第三姿势角。
也就是说,偏摆角γ从步骤S2中的第二姿势角改变规定角度。在第二姿势角下,偏摆角γ为180度,但在步骤S3的第三姿势角下,偏摆角γ为旋转了Δθ6度的γ3度。该Δθ6度不需要是某个特定的数值,可以为任意的值。此时,伴随偏摆角γ的改变,俯仰角β从Δθ5度变化为β3度。
在第三姿势角下,(α,β,γ)=(任意,β3°,γ3°)。
保持这样的第三姿势角的状态进行工序i的处理,测定接触距离Z3’。
将在上述步骤S1~S3中得到的三个接触距离(Z1’,Z2’,Z3’)存储于控制装置4或个人计算机5。
[刀具矢量的修正方法(工序iii)]
经过以上所述的工序i、工序ii,更换后的焊接刀具6的接触距离(Z1’,Z2’,Z3’)成为已知。而且,更换前的刀具参数的平移成分(Xt,Yt,Zt)和接触距离(Z1,Z2,Z3)如前所述是已知的。
说明在该状况下、在工序iii中求出更换后的焊接刀具6的刀具参数的平移成分(Xt’,Yt’,Zt’)的方法、换言之将已知的刀具参数的平移成分(Xt,Yt,Zt)修正为适于更换后的焊接刀具6的刀具参数的方法。
焊接刀具6的更换后的刀具参数平移成分的变化量(ΔTx,ΔTy,ΔTz)使用更换前的刀具参数平移成分(Tx,Ty,Tz)和更换后的刀具参数平移成分(Tx’,Ty’,Tz’)作为凸缘坐标系上的矢量flgV用式(2)表示。
V flg = &Delta;Tx &Delta;Ty &Delta;Tz = Tx &prime; Ty &prime; Tz &prime; - Tx Ty Tz - - - ( 2 )
也就是说,只要求出flgV,在式(2)中应用已知的更换前的刀具参数平移成分(Tx,Ty,Tz),就能求出刀具更换后的刀具参数(Tx’,Ty’,Tz’)。
现在,从焊接机器人2的基础坐标系看,凸缘坐标系的旋转炬阵为baseRflg,基础坐标系中的焊接刀具6的更换前后的前端点P的位置变化量(位置偏移量)为baseV=(ΔX,ΔY,ΔZ)。此时,式(3)成立。
baseV=baseRflg·flgV   (3)
从基础坐标系看出的凸缘坐标系的旋转角为倾滚角α、俯仰角β、偏摆角γ时,旋转炬阵baseRflg如式(4)那样表示。
R flg base = cos &alpha; cos &beta; cos &alpha; sin &beta; sin &gamma; - sin &alpha; cos &gamma; cos &alpha; sin &beta; cos &gamma; + sin &alpha; sin &gamma; sin &alpha; cos &beta; sin &alpha; sin &beta; sin &gamma; + cos &alpha; cos &gamma; sin &alpha; sin &beta; cos &gamma; - cos &alpha; sin &gamma; - sin &beta; cos &beta; sin &gamma; cos &beta; cos &gamma; - - - ( 4 )
仅关注式(3)的Z成分,获得表示焊接刀具6的前端点P的位置变化量ΔZ和刀具参数平移成分的变化量的关系的式(5)。
ΔZ=-ΔTx·sinβ+ΔTy·cosβsinγ+ΔTz·cosβcosγ   (5)
通过在如此获得的式(5)的ΔZ中依次应用位置变化量ΔZ1~ΔZ3,如表1所示,能依次求出平移成分变化量ΔTx,ΔTy,ΔTz。需要说明的是,ΔZ1=Z1’-Z1、ΔZ2=Z2’-Z2、ΔZ3=Z3’-Z3,Z1’,Z2’,Z3’是在工序ii的步骤S1~S3中测定的焊接刀具6的前端点P的接触距离。
【表1】
Figure BDA0000437543330000101
也就是说,在表1的步骤S1中,位置变化量ΔZ1是已知的,sinβ及sinγ为0,cosβ为1,cosγ为-1。将其应用于式(5)中,位置变化量ΔZ1与-ΔTz相等,刀具参数的平移成分的Z成分的修正量ΔTz如式(6)那样确定为-ΔZ1。
ΔTz=-ΔZ1   (6)
接着,在表1的步骤S2中,sinβ为0以外的值,sinγ为0,cosγ为-1。将其应用于式(5)中,能将式(5)如式(7)那样变形。
ΔTx=-(ΔZ2+ΔTz·cosβ)/sinβ   (7)
在此,式(7)中应用已知的位置变化量ΔZ2和在表1的步骤S1中已经求出的ΔTz,确定刀具参数的平移成分的X成分的修正量ΔTx。
最后,在表1的步骤S3中,sinβ及sinγ为0以外的值。将其应用于式(5)中,式(5)能如式(8)那样变形。
ΔTy=(ΔZ3+ΔTx·sinβ-ΔTz·cosβcosγ)/cosβsinγ   (8)
在此,在式(8)中应用已知的位置变化量ΔZ3和在表1的步骤S1中已经求出的ΔTz和在表1的步骤S2中求出的ΔTx,确定刀具参数的平移成分的Y成分的修正量ΔTy。
如以上所述,使用式(2)根据经由表1的步骤S1~S3求出的刀具参数平移成分的变化量(ΔTx,ΔTy,ΔTz)和更换前的刀具参数平移成分(Tx,Ty,Tz)求出更换后的刀具参数平移成分(Tx’,Ty’,Tz’)。其结果是,更换后的刀具参数平移成分为如式(9)所示的值,作为新的刀具参数的平移成分设定于控制装置4或个人计算机5中。
(Tx′,Ty′,Tz′)=(Tx+ΔTx,Ty+ΔTy,Tz+ΔTz)   (9)
这样,通过使焊接机器人2及焊接刀具6采取简单的不同的三个姿势角,使焊接刀具6在基础坐标系中向-Z方向移动,能重新设定新的刀具参数的平移成分。
也就是说,根据本实施方式的刀具参数的修正方法,即使直接应用更换焊接刀具6前指示的机器人程序也能确保刀具参数的精度,能在更换焊接刀具6后立即使焊接机器人2重新运转。
[变形例(1)]
在上述的本实施方式中,使焊接刀具6在基础坐标系中向Zb轴方向(Zb轴的负方向)移动。但是,只要使用在本实施方式中说明的方法,使焊接刀具6向Xb轴方向或Yb轴方向移动,也能修正刀具参数。
例如,如图5所示,以使凸缘坐标系的Z轴(Zf轴)方向与基础坐标系的X轴(Xb轴)方向平行且Zf轴朝向Xb轴的正方向的方式确定焊接机器人2及焊接刀具6的姿势角。然后,使焊接刀具6在基础坐标系中向Xb轴方向移动,能测定焊接机器人2及焊接刀具6的三个姿势角下的接触距离X1~X3。换言之,使Zf轴的朝向为绕基础坐标系的Yb轴的角度即俯仰角β为90度,使焊接刀具6在基础坐标系中向Xb轴方向移动,能测定接触距离X1~X3。
在该情况下,平板8设置为设定于平板8上的面上的垂线与基础坐标系的Xb轴平行。
通过将在本实施方式中说明的方法应用于这样测定的接触距离X1~X3,也能可靠地修正刀具参数。
[变形例(2)]
如上所述,本发明的刀具参数的修正方法用于专业焊接机器人2的实际运转开始后由于刀具的变形及更换而焊接刀具6的尺寸发生变化的情况下的修正。
但是,若使用被高精度地机械加工后的调整用“基准刀具”,则在焊接机器人2的交货及组装时,在以焊接刀具6为代表的安装于焊接机器人2的凸缘部7时的刀具参数的调整中也能应用本发明。关于其步骤,以下进行说明。
(1)首先,使用被高精度地机械加工后的基准刀具,先通过在本发明的实施方式中说明的步骤S1~S3的动作测定接触距离(Z1,Z2,Z3)并存储。
此时,基准刀具的尺寸被高精度地调整,因此,通过计算能求出刀具参数(Tx,Ty,Tz)。因此,基准刀具的刀具参数可以视作是已知的。
(2)接着,更换为实际使用的焊接刀具6,通过图4的步骤S1~S3的动作测定接触距离(Z1’,Z2’,Z3’),并存储于控制装置4或个人计算机5。根据基准刀具的接触距离(Z1,Z2,Z3)和焊接刀具6的接触距离(Z1’,Z2’,Z3’)求出位置变化量(ΔZ1,ΔZ2,ΔZ3),根据这些位置变化量使用上述的式(5)求出刀具参数平移成分的变化量(ΔTx,ΔTy,ΔTz)。
(3)将焊接刀具6的刀具参数修正为(Tx+ΔTx,Ty+ΔTy,Tz+ΔTz),并存储于控制装置4或个人计算机5。
使用该方法也能可靠地修正刀具参数。
顺便说一下,应该认为本次公开的实施方式的所有点是例示,不是限制性的内容。特别是在本次公开的实施方式中没有明确公开的事项、例如动作条件、测定条件、各种参数、构成物的尺寸、重量、体积等在不脱离本领域技术人员通常实施的范围内采用普通的本领域技术人员能容易想到的值。
符号说明
1   机器人系统
2   焊接机器人
3   示教手持控制器
4   控制装置
5   个人计算机
6   焊接刀具
7   凸缘部
8   平板
P   前端点
W   工件

Claims (5)

1.一种机器人的刀具参数的修正方法,其是导出用于确定安装于凸缘部的刀具的前端位置的刀具参数的方法,该凸缘部设置在机器人的臂前端上,
所述机器人的刀具参数的修正方法的特征在于,
使所述刀具采取不同的三个以上的姿势角,
在各姿势角下,使所述刀具的前端在保持姿势角的状态下沿一方向移动至基准面,
在各姿势角下,计测所述刀具的前端到达所述基准面时的该刀具前端的位置偏移量而求出平移成分变化量,
基于该求出的平移成分变化量修正刀具参数。
2.根据权利要求1所述的机器人的刀具参数的修正方法,其特征在于,
在所述刀具的各姿势角下,使所述刀具的前端沿机器人的基础坐标中的垂直轴方向移动至所述基准面,而求出所述平移成分变化量。
3.根据权利要求1或2所述的机器人的刀具参数的修正方法,其特征在于,
在所述机器人采取的三个以上的姿势角中的最初的姿势角下,所述凸缘部相对于所述基准面垂直或水平。
4.根据权利要求1~3中任一项所述的机器人的刀具参数的修正方法,其特征在于,
所述各姿势角通过使所述刀具绕所述机器人的基础坐标中的各垂直轴旋转来指定。
5.根据权利要求4所述的机器人的刀具参数的修正方法,其特征在于,
在所述机器人采取的多个姿势角中的最初的姿势角下,绕基础坐标中的Y轴的旋转角为0度或90度。
CN201280029259.8A 2011-06-21 2012-06-12 机器人的刀具参数的修正方法 Expired - Fee Related CN103608151B (zh)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2011-137391 2011-06-21
JP2011137391A JP5645760B2 (ja) 2011-06-21 2011-06-21 ロボットのツールパラメータの補正方法
PCT/JP2012/064958 WO2012176649A1 (ja) 2011-06-21 2012-06-12 ロボットのツールパラメータの補正方法

Publications (2)

Publication Number Publication Date
CN103608151A true CN103608151A (zh) 2014-02-26
CN103608151B CN103608151B (zh) 2016-08-31

Family

ID=47422489

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201280029259.8A Expired - Fee Related CN103608151B (zh) 2011-06-21 2012-06-12 机器人的刀具参数的修正方法

Country Status (4)

Country Link
JP (1) JP5645760B2 (zh)
KR (1) KR101581523B1 (zh)
CN (1) CN103608151B (zh)
WO (1) WO2012176649A1 (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016185572A (ja) * 2015-03-27 2016-10-27 セイコーエプソン株式会社 ロボット、ロボット制御装置およびロボットシステム
CN107253413B (zh) * 2017-05-12 2019-05-21 哈工大机器人集团股份有限公司 一种模仿人手雕刻动作的机器人雕刻系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07121214A (ja) * 1993-10-25 1995-05-12 Fanuc Ltd ロボット用計測センサ装置並びに該装置を用いたキャリブレーション方法及び計測方法
US6192298B1 (en) * 1997-05-30 2001-02-20 Matsushita Electric Industrial Co., Ltd. Method of correcting shift of working position in robot manipulation system
JP2009125857A (ja) * 2007-11-22 2009-06-11 Mitsubishi Electric Corp ロボットのキャリブレーション装置及び方法
CN101456182A (zh) * 2007-12-12 2009-06-17 中国科学院自动化研究所 大型工件焊接智能机器人装置
CN101486123A (zh) * 2008-01-15 2009-07-22 株式会社神户制钢所 焊接机器人

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6125206A (ja) 1984-07-12 1986-02-04 Fanuc Ltd ロボツトの工具位置設定方式
JPS61240304A (ja) * 1985-04-17 1986-10-25 Hitachi Ltd 産業用ロボツトのエンド・エフエクタ取付け誤差演算装置
JPH01257593A (ja) 1988-04-06 1989-10-13 Hitachi Ltd ロボットの芯ずれ補正方法
JPH0871968A (ja) * 1994-09-01 1996-03-19 Kobe Steel Ltd ロボットのツールパラメータ導出方法及び較正方法
JP2774939B2 (ja) 1994-09-16 1998-07-09 株式会社神戸製鋼所 ロボットのツールパラメータ導出方法及び較正方法
JP5411810B2 (ja) * 2010-06-14 2014-02-12 株式会社神戸製鋼所 ツールパラメータ導出装置,ロボット
JP5425006B2 (ja) * 2010-07-12 2014-02-26 株式会社神戸製鋼所 ロボットのツールベクトルの導出に用いる治具

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07121214A (ja) * 1993-10-25 1995-05-12 Fanuc Ltd ロボット用計測センサ装置並びに該装置を用いたキャリブレーション方法及び計測方法
US6192298B1 (en) * 1997-05-30 2001-02-20 Matsushita Electric Industrial Co., Ltd. Method of correcting shift of working position in robot manipulation system
JP2009125857A (ja) * 2007-11-22 2009-06-11 Mitsubishi Electric Corp ロボットのキャリブレーション装置及び方法
CN101456182A (zh) * 2007-12-12 2009-06-17 中国科学院自动化研究所 大型工件焊接智能机器人装置
CN101486123A (zh) * 2008-01-15 2009-07-22 株式会社神户制钢所 焊接机器人

Also Published As

Publication number Publication date
KR101581523B1 (ko) 2015-12-30
KR20140025520A (ko) 2014-03-04
JP2013000870A (ja) 2013-01-07
JP5645760B2 (ja) 2014-12-24
WO2012176649A1 (ja) 2012-12-27
CN103608151B (zh) 2016-08-31

Similar Documents

Publication Publication Date Title
CN108748159B (zh) 一种机械臂工具坐标系自标定方法
US8401692B2 (en) System and method for tool testing and alignment
CN107639635B (zh) 一种机械臂位姿误差标定方法及系统
JP2011224672A (ja) ロボットのツールベクトルの導出方法及び較正方法
CN107042528A (zh) 一种工业机器人的运动学标定系统及方法
CN112318498B (zh) 一种考虑参数耦合的工业机器人标定方法
CN102458779A (zh) 机械手校正装置及其方法
CN107972071A (zh) 一种基于末端点平面约束的工业机器人连杆参数标定方法
CN113352345B (zh) 快换装置的更换系统、方法、装置、电子设备及存储介质
US11289303B2 (en) Calibrating method and calibrating system
KR20080088165A (ko) 로봇 캘리브레이션 방법
CN107053216A (zh) 机器人和末端执行器的自动标定方法及系统
US7957834B2 (en) Method for calculating rotation center point and axis of rotation, method for generating program, method for moving manipulator and positioning device, and robotic system
CN113618738A (zh) 一种机械臂运动学参数标定方法及系统
CN112902898B (zh) 三维测量装置及所适用的机械手臂的校正方法
CN108445765A (zh) 一种飞机自动钻铆并联调姿托架的标定方法
CN109397259B (zh) 用于确定机器人设备的绝对位置的方法和机器人设备
CN102328314B (zh) 机器人的工具矢量的导出中使用的夹具
CN114029982A (zh) 一种相机在机器臂外的手眼标定装置及其标定方法
CN112762822B (zh) 一种基于激光跟踪仪的机械臂校准方法及系统
CN103608151A (zh) 机器人的刀具参数的修正方法
CN113240753A (zh) 机器人与双轴变位机构基坐标系标定球面拟合法
JPS63302310A (ja) 座標測定機の測定ボリューム内の点の絶対位置を決定する方法および装置
WO2008145184A1 (en) A method and an apparatus for calibration of a linear track
CN116494254B (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
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20160831

CF01 Termination of patent right due to non-payment of annual fee