CN116964535A - 生成用于摆动动作的信号的装置、控制装置以及方法 - Google Patents

生成用于摆动动作的信号的装置、控制装置以及方法 Download PDF

Info

Publication number
CN116964535A
CN116964535A CN202280020502.3A CN202280020502A CN116964535A CN 116964535 A CN116964535 A CN 116964535A CN 202280020502 A CN202280020502 A CN 202280020502A CN 116964535 A CN116964535 A CN 116964535A
Authority
CN
China
Prior art keywords
parameter
wobble signal
unit
robot
filter
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.)
Pending
Application number
CN202280020502.3A
Other languages
English (en)
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
Application filed by Fanuc Corp filed Critical Fanuc Corp
Publication of CN116964535A publication Critical patent/CN116964535A/zh
Pending legal-status Critical Current

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23K—SOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
    • B23K9/00—Arc welding or cutting
    • B23K9/12—Automatic feeding or moving of electrodes or work for spot or seam welding or cutting
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00—Manipulators not otherwise provided for
    • B25J11/005—Manipulators for mechanical processing tasks
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/18—Numerical 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/4155—Numerical 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 programme execution, i.e. part programme or machine function execution, e.g. selection of a programme
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/45—Nc applications
    • G05B2219/45104—Lasrobot, welding robot
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/45—Nc applications
    • G05B2219/45135—Welding
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/49—Nc machine tool, till multiple
    • G05B2219/49384—Control of oscillatory movement like filling a weld, weaving

Landscapes

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

Abstract

以往以来一直寻求一种能够使机器人以操作员所期望的方式执行摆动动作的技术。装置(70)具备：输入受理部(52)，其受理摆动信号的参数的输入；信号生成部(44)，其生成具有所受理到的参数的摆动信号；参数获取部(54)，其获取针对摆动信号执行了滤波处理的情况下的该摆动信号的参数来作为滤波处理后参数；条件判定部(56)，其判定滤波处理后参数是否满足预先决定的条件；以及参数调整部(58)，在判定为不满足条件的情况下，该参数调整部(58)对所受理到的参数进行调整。信号生成部(44)生成具有由参数调整部(58)进行了调整后的参数的摆动信号。

Description

生成用于摆动动作的信号的装置、控制装置以及方法
技术领域
本公开涉及一种生成用于摆动动作的信号的装置、控制装置以及方法。
背景技术
已知一种使机器人执行摆动动作的控制装置(例如专利文献1)。
现有技术文献
专利文献
专利文献1：日本特开2014-83605号公报
发明内容
发明要解决的问题
以往以来，一直寻求一种使向机器人示教摆动动作的作业简单化并且能够使该机器人以操作员所期望的方式执行该摆动动作的技术。
用于解决问题的方案
在本公开的一个方式中，提供一种装置，所述装置生成用于摆动动作的信号，该摆动动作是通过机器人使工具沿着预先决定的作业路径移动并且使该工具向与该作业路径交叉的方向摇摆的动作，所述装置具备：输入受理部，其受理用于机器人使工具摇摆的摆动信号的参数的输入；信号生成部，其生成具有输入受理部所受理到的参数的摆动信号；参数获取部，其获取针对信号生成部所生成的摆动信号执行了用于去除高频成分的滤波处理的情况下的该摆动信号的参数来作为滤波处理后参数；条件判定部，其判定滤波处理后参数是否满足预先决定的条件；以及参数调整部，在条件判定部判定为不满足条件的情况下，所述参数调整部对输入受理部所受理到的参数进行调整，以使得满足该条件。信号生成部生成具有由参数调整部进行了调整后的参数的摆动信号。
一种方法，生成用于摆动动作的信号，该摆动动作是通过机器人使工具沿着预先决定的作业路径移动并且使该工具向与该作业路径交叉的方向摇摆的动作，在所述方法中，处理器进行以下处理：受理用于机器人使工具摇摆的摆动信号的参数的输入；生成具有所受理到的参数的摆动信号；获取针对所生成的摆动信号执行了用于去除高频成分的滤波处理的情况下的该摆动信号的参数来作为滤波处理后参数；判定滤波处理后参数是否满足预先决定的条件；在判定为不满足条件的情况下，对所受理到的参数进行调整，以使得满足该条件；以及生成具有被进行了调整后的参数的摆动信号。
发明的效果
根据本公开，能够自动地调整摆动信号的参数，以使得能够生成满足操作员任意地决定的条件的摆动信号。由此，能够使机器人以操作员所期望的方式执行摆动动作，并且能够使向机器人示教所期望的摆动动作的作业简单化。
附图说明
图1是一个实施方式所涉及的机器人系统的图。
图2是图1所示的机器人系统的框图。
图3示出图1所示的机器人执行的摆动动作的轨道。
图4是图1所示的控制装置中的生成摆动动作指令的功能的框图。
图5示出摆动信号的波形。
图6示出针对图5所示的摆动信号执行了滤波处理的情况下的波形。
图7是示出生成摆动信号的方法的一例的流程图。
图8示出被设定了端点停止时间的摆动信号的波形。
图9是用于说明通过运算求出滤波处理后参数的方法的图。
图10示出振幅作为摆动信号的参数被进行了调整的情况下的波形。
图11示出针对图10所示的参数调整后的摆动信号执行了滤波处理的情况下的波形。
图12示出设定了端点停止时间来作为摆动信号的参数的情况下的波形。
图13示出针对图12所示的参数调整后的摆动信号执行了滤波处理的情况下的波形。
图14示出被设定了端点停止时间的摆动信号的波形。
图15示出频率作为图14所示的摆动信号的参数被进行了调整的情况下的波形。
图16示出振幅和频率作为摆动信号的参数被进行了调整的情况下的波形。
图17示出针对图16所示的参数调整后的摆动信号执行了滤波处理的情况下的波形。
图18是示出生成摆动信号的方法的其它例的流程图。
图19示出通过针对摆动信号执行滤波处理而相位发生了变化的波形。
图20示出通过将一部分的波形的振幅作为摆动信号的参数进行调整来调整了其它部分的波形的频率的情况下的摆动信号的波形。
图21示出针对图20所示的参数调整后的摆动信号执行了滤波处理的情况下的波形。
图22示出摆动动作的轨道的其它例。
图23示出用于使机器人以图22所示的轨道执行摆动动作的摆动信号的波形。
具体实施方式
下面，基于附图来详细说明本公开的实施方式。此外，在下面说明的各种实施方式中，对同样的要素标注相同的附图标记，并省略重复的说明。首先，参照图1和图2来说明一个实施方式所涉及的机器人系统10。机器人系统10具备机器人12和控制装置14。
在本实施方式中，机器人12对工件W执行焊接作业。具体地说，机器人12是垂直多关节型机器人，具有机器人基座16、旋转主体18、下臂部20、上臂部22、手腕部24以及工具26。机器人基座16被固定于作业室的地板上。旋转主体18以能够绕铅直轴转动的方式设置于机器人基座16。
下臂部20以能够绕水平轴转动的方式设置于旋转主体18。上臂部22以能够转动的方式设置于下臂部20的前端部。手腕部24具有以能够绕相互正交的两个轴转动的方式设置于上臂部22的前端部的手腕基座24a以及以能够转动的方式设置于该手腕基座24a的手腕凸缘24b。
工具26以能够装卸的方式安装于手腕凸缘24b。在本实施方式中，工具26为焊炬，根据来自控制装置14的指令来与工件W之间产生放电，使从焊料进给装置(未图示)进给的焊丝熔融来对工件W进行焊接。此外，工具26也可以是射出激光束并利用该激光束使焊丝熔融来对工件W进行焊接的激光加工头。
多个伺服马达28(图2)分别被内置于机器人基座16、旋转主体18、下臂部20、上臂部22以及手腕部24。这些伺服马达28根据来自控制装置14的指令来使机器人12的各可动要素(即旋转主体18、下臂部20、上臂部22、手腕部24、手腕凸缘24b)转动，由此使工具26移动。
控制装置14对机器人12的动作进行控制。如图2所示，控制装置14是具有处理器30、存储器32以及I/O接口34的计算机。处理器30具有CPU或GPU等，处理器30经由总线36而与存储器32及I/O接口34以能够进行通信的方式连接，处理器30与这些组件进行通信并且进行用于后述的各种功能的运算处理。
存储器32具有RAM或ROM等，临时或永久地存储在处理器30执行的运算处理中利用的各种数据以及在运算处理的中途生成的各种数据。I/O接口34例如具有以太网(注册商标)端口、USB端口、光纤连接器、或HDMI(注册商标)端子，I/O接口34基于来自处理器30的指令来与外部设备之间以有线或无线方式通信数据。在本实施方式中，机器人12的伺服马达28与I/O接口34以能够进行通信的方式连接。
对控制装置14设置有输入装置38和显示装置40。输入装置38具有键盘、鼠标或触摸面板等，用于从操作员处受理数据输入。显示装置40具有液晶显示器或有机EL显示器等，用于显示各种数据。
输入装置38及显示装置40也可以与I/O接口34以能够进行有线通信或无线通信的方式连接。另外，输入装置38和显示装置40既可以与控制装置14的壳体分开地设置，或者也可以成一体地嵌入于控制装置14的壳体。
如图1所示，针对机器人12设定有机器人坐标系C1和工具坐标系C2。机器人坐标系C1是用于自动控制机器人12的各可动要素的坐标系。在本实施方式中，机器人坐标系C1是以其原点配置于机器人基座16的中心且其z轴与旋转主体18的旋转轴一致的方式针对机器人12设定的。此外，在下面的说明中，为了方便，将机器人坐标系C1的x轴正方向称为右方，将y轴正方向称为前方，将z轴正方向称为上方。
工具坐标系C2是用于自动控制工具26在机器人坐标系C1中的位置的坐标系，是针对工具26设定的。此外，在本文中，“位置”有时是指位置和姿势。在本实施方式中，工具坐标系C2是以其原点位于工具26的作业点(例如，工具26使焊丝熔融的点)且其z轴方向与工具26的作业方向(例如，焊炬前端的中心轴线的方向、或激光束的射出方向)一致的方式针对工具26设定的。
在使工具26移动时，处理器30在机器人坐标系C1中设定工具坐标系C2，并以将工具26定位于通过所设定的工具坐标系C2表示的位置的方式向机器人12的各伺服马达28发送指令来使机器人12的各可动要素进行动作。通过这样，处理器30通过机器人12的动作来将工具26定位于机器人坐标系C1的任意的位置。
接着，参照图3来说明在对工件W进行焊接作业时处理器30使机器人12执行的摆动动作。摆动动作是为了扩大在对工件W进行了焊接时形成于该工件W上的焊道的宽度而执行的。具体地说，在摆动动作中，处理器30通过机器人12使工具26沿着预先决定的作业路径WP移动并且使该工具26向与该作业路径WP交叉的方向摇摆。
在图3所示的例子中，作业路径WP以沿机器人坐标系C1的x轴方向呈直线状延伸的方式设定在工件W上。在该例子的情况下，处理器30在摆动动作中通过机器人12使工具26沿着作业路径WP向右方移动并且使工具26在前侧的端点P1与后侧的端点P2之间向前后方向摇摆。其结果是，工具26一边相对于工件W沿着波线状的轨道TR移动一边对该工件W进行焊接。
处理器30生成用于在摆动动作中使工具26摇摆的摆动信号WS。下面，参照图4～图6来说明摆动信号WS的生成。如图4所示，控制装置14具有主动作指令生成部42、信号生成部44、滤波器部46及48、以及摆动动作指令生成部50。主动作指令生成部42生成用于在上述的摆动动作中机器人12使工具26向作业路径WP的方向移动的主动作指令CM1。
滤波器部46是数字滤波器(FIR滤波器或IIR滤波器)，以规定的滤波时间τ1针对主动作指令生成部42所生成的主动作指令CM1执行用于去除高频成分的滤波处理FR1。例如，滤波器部46通过每隔滤波时间τ1针对主动作指令CM1的数字信号进行移动平均处理，来执行作为低通滤波处理的滤波处理FR1。
可替代的是，滤波器部46也可以构成为将滤波处理FR1设为带通滤波处理或陷波滤波处理来执行。滤波器部46通过针对主动作指令CM1执行滤波处理FR1，来生成主动作指令CM2并向摆动动作指令生成部50输出该主动作指令CM2。
信号生成部44生成摆动信号WS1。在图5中示出摆动信号WS1的一例。此外，图5的纵轴示出使工具26向前后方向摇摆的振幅A(换言之，相对于作业路径WP的距离A)，横轴示出时间t。在图5所示的例子中，摆动信号WS1为具有振幅A1且周期为T1(也就是频率为f1＝1/T1)的三角波，与基准时间t0(例如摆动动作的开始时间)对应的相位φ1为零。这些振幅A1、频率f1(或周期T1)以及相位φ1构成用于规定摆动信号WS1的参数PR1。
再次参照图4，滤波器部48为与上述的滤波器部46同样的数字滤波器，以规定的滤波时间τ2针对信号生成部44所生成的摆动信号WS1执行用于去除高频成分的滤波处理FR2。滤波处理FR2既可以与上述的滤波处理FR1相同，也可以不同。
例如，滤波器部48通过每隔滤波时间τ2针对作为数字信号的摆动信号WS1进行移动平均处理，来执行作为低通滤波处理的滤波处理FR2。可替代的是，滤波器部48也可以构成为将滤波处理FR2设为带通滤波处理或陷波滤波处理来执行。
当由滤波器部48针对摆动信号WS1执行了滤波处理FR2时，摆动信号WS1发生变化，生成图6中用实线表示的摆动信号WS2。该摆动信号WS2具有包括振幅A2、周期T2(频率f2＝1/T2)以及相位φ2的参数PR2。
摆动信号WS2的参数PR2(振幅A2、频率f2以及相位φ2)中的至少一者能够通过滤波处理FR2而相对于摆动信号WS1的参数PR1(振幅A1、频率f1以及相位φ1)发生变化。此外，在下面的说明中，有时将参数PR2称为滤波处理后参数PR2。
此外，在图6所示的例子中，滤波处理FR2的结果是，三角波的摆动信号WS1变化为与三角函数的波形类似的摆动信号WS2(即，通过去除高频成分而使频率特性发生变化)，并且摆动信号WS2的振幅A2衰减从而变得小于摆动信号WS1的振幅A1(A2＜A1)。滤波器部48将所生成的摆动信号WS2输出到摆动动作指令生成部50。
再次参照图4，摆动动作指令生成部50通过在主动作指令CM2中应用摆动信号WS2，来生成用于使机器人12执行摆动动作的摆动动作指令CM3。具体地说，摆动动作指令生成部50为加法运算器，通过将主动作指令CM2与摆动信号WS2相加来生成摆动动作指令CM3(＝CM2+WS2)。
由摆动动作指令生成部50生成的摆动动作指令CM3通过I/O接口34和伺服放大器(未图示)被输出到机器人12的伺服马达28。机器人12按照该摆动动作指令CM3执行摆动动作，来使工具26沿着图3所示的轨道TR移动。
此外，主动作指令生成部42、信号生成部44、滤波器部46以48、以及摆动动作指令生成部50能够是通过由处理器30执行的计算机程序实现的功能模块。在该情况下，处理器30作为主动作指令生成部42、信号生成部44、滤波器部46及48、以及摆动动作指令生成部50发挥功能。可替代的是，信号生成部44、滤波器部46及48、以及摆动动作指令生成部50中的至少一者(例如滤波器部46及48)也可以作为模拟电路而被安装于控制装置14。
接着，参照图7来更详细地说明生成摆动信号WS的方法。图7所示的流程例如在控制装置14启动时开始进行。在步骤S1中，处理器30判定是否受理了摆动信号WS1(图5)的参数PR1的输入以及该参数PR1的优先级PO的输入。
具体地说，处理器30在图7的流程开始之后，生成用于输入参数PR1和优先级PO的输入图像并使显示装置40显示该输入图像。操作员目视显示装置40并操作输入装置38来输入参数PR1。在此，操作员能够输入的参数PR1除了包括上述的振幅A1、频率f1以及相位φ1以外，还包括端点停止时间ts。
该端点停止时间ts用于规定将工具26维持于摆动动作中的该工具26的摇摆动作的端点P1和P2(即，图5中振幅A为A1和-A1的位置)的时间。在图8中示出设定了端点停止时间ts时的摆动信号WS1的一例。
例如，假设操作员输入了振幅A1、频率f1、端点停止时间ts以及相位φ1＝0来作为参数PR1。在该情况下，处理器30维持图5所示的作为具有振幅A1和频率f1的三角波的摆动信号WS1的斜率并且在该摆动信号WS1中的振幅A1和-A1的点(三角波的顶点)设定端点停止时间ts。其结果是，摆动信号WS1被设定为图8所示的梯形波。因而，在该情况下，摆动信号WS1的频率f从操作员所输入的频率f1变更为频率f3(＝1/T3＜f1 T3＝T1+2ts)。
处理器30通过输入装置38受理参数PR1的输入。像这样，在本实施方式中，处理器30作为受理摆动信号WS1的参数PR1的输入的输入受理部52(图2)发挥功能。处理器30将所受理到的参数PR1作为摆动信号WS1的参数设定值PR1V存储于存储器32。下面，对处理器30受理了图5所示的摆动信号WS1的参数PR1(振幅A1、频率f1、相位φ1＝0、端点停止时间ts＝0)的输入的情况进行说明。
操作员操作输入装置38来输入参数PR1并且输入优先级PO。在此，如参照图6所说明的那样，原始的摆动信号WS1的参数PR1(例如振幅A1)能够通过滤波处理FR2而发生变化。优先级PO用于决定在参数PR1发生了变化的情况下应优先再现操作员在步骤S1中输入的值的参数PR1的优先级。
例如，在该步骤S1中，操作员输入振幅A1、频率f1、相位φ以及端点停止时间ts来作为参数PR1，并且输入决定为应优先再现振幅A1的值的优先级PO(也就是决定为振幅A1的优先级为第一位的优先级PO)。处理器30作为输入受理部52发挥功能，用于受理优先级PO的输入。
在步骤S2中，处理器30决定滤波处理FR2的滤波时间τ2。具体地说，处理器30读取特有滤波时间τa。该特有滤波时间τa是按机器人12的种类特别地决定的，被预先保存于存储器32。另一方面，处理器30基于在步骤S1中受理到的参数PR1，来求出容许滤波时间τb。
该容许滤波时间τb是能够使通过滤波处理FR2而相对于原始的摆动信号WS1的参数PR1(例如振幅A1)发生了变化而得到的滤波处理后参数PR2(例如振幅A2)收敛于规定的容许范围内(例如，振幅A2为振幅A1的50％以上的范围)的滤波时间。
例如，处理器30也可以通过τb＝T1/2来求出容许滤波时间τb。然后，处理器30将特有滤波时间τa和容许滤波时间τb中的较长一方决定为滤波时间τ2。像这样，在本实施方式中，处理器30基于所受理到的参数PR1来决定滤波时间τ2。
在步骤S3中，处理器30作为信号生成部44发挥功能，生成具有在步骤S1中受理到的参数PR1的摆动信号WS1。由此，处理器30生成如图5所示那样的具有振幅A1、频率f1、相位φ1(＝0)以及端点停止时间ts(＝0)的摆动信号WS1。
在步骤S4中，处理器30获取滤波处理后参数PR2。滤波处理后参数PR2是针对在步骤S3中所生成的摆动信号WS1执行了滤波处理FR2的情况下的、该摆动信号WS1变化后的参数PR2。作为一例，处理器30在步骤S4中通过针对在上述的步骤S3中所生成的摆动信号WS1模拟地执行实际的滤波处理FR2来获取滤波处理后参数PR2。
作为其它例子，处理器30也可以基于在步骤S1中受理到的参数PR1以及在步骤S2中决定的滤波时间τ2来通过运算求出滤波处理后参数PR2。下面，参照图9来说明通过运算求出滤波处理后参数PR2的方法。
图9示出具有振幅A1、频率f3(＝1/T3＝1/(T1+2ts))、相位φ1(＝0)以及端点停止时间ts的摆动信号WS1，针对该摆动信号WS1设定了滤波处理FR2的滤波时间τ2。在该例中，处理器30能够根据下面的式(1)来通过运算求出针对摆动信号WS1进行滤波处理FR2而得到的摆动信号WS2的振幅A2。
A2＝Ab+Aa(1+ts/τ2)/2…(1)
在此，根据下面的式(2)和式(3)分别求出式(1)中的Aa和Ab。
Aa＝A1(2(τ2-ts)/T1)…(2)
Ab＝A1-Aa＝A1-A1(2(τ2-ts)/T1)…(3)
此外，在本实施方式中，在步骤S1中受理到的端点停止时间ts为零，因此在上述的式(1)～(3)中代入ts＝0。像这样，处理器30能够根据式(1)来通过运算求出振幅A2作为滤波处理后参数PR2。即，在该情况下，处理器30无需针对在步骤S3中生成的摆动信号WS1执行实际的滤波处理FR2就能够获取滤波处理后参数PR2。
像这样，在本实施方式中，处理器30作为获取滤波处理后参数PR2的参数获取部54(图2)发挥功能。此外，在本实施方式中，设为即使针对摆动信号WS1执行了滤波处理FR2，频率f1和相位φ1也不变化。因此，滤波处理后参数PR2中的频率f2和相位φ2与频率f1和φ1相同(f2＝f1、φ2＝φ1)。
再次参照图7，在步骤S5中，处理器30判定在步骤S4中获取到的滤波处理后参数PR2是否满足预先决定的第一条件CD1。在本实施方式中，该第一条件CD1被决定为滤波处理后参数PR2与在步骤S1中受理到的参数PR1实质相同这一条件。
例如，在滤波处理后参数PR2为振幅A2的情况下，处理器30在振幅A2收敛于以振幅A1为基准决定的容许范围(例如，振幅A1的90％以上的范围)的情况下，判定为滤波处理后参数PR2(振幅A2)与参数PR1(振幅A1)实质相同，因此判定为满足第一条件CD1(即，“是”)。另一方面，处理器30在振幅A2处于容许范围外的情况下，判定为滤波处理后参数PR2与参数PR1不同，因此判定为不满足第一条件CD1(即，“否”)。
此外，也可以是，处理器30在该步骤S5中仅针对在步骤S1中受理到的优先级PO高的参数PR1(例如振幅A1)判定是否满足第一条件CD1。可替代的是，处理器30也可以针对在步骤S1中受理到的全部的参数PR1(振幅A1、频率f1、相位φ1、端点停止时间ts)判定是否满足第一条件CD1。
像这样，在本实施方式中，处理器30作为判定滤波处理后参数PR2是否满足条件CD1的条件判定部56(图2)发挥功能。处理器30在该步骤S5中判定为“是”的情况下进入步骤S7，另一方面，在判定为“否”的情况下进入步骤S6。
在步骤S6中，处理器30对在步骤S1中受理到的参数PR1进行调整，以使得满足第一条件CD1。具体地说，处理器30对在步骤S1中受理到的参数PR1进行调整，以使得能够使在步骤S4中获取到的滤波处理后参数FR2与该参数PR1一致。
例如，如图10所示，处理器30使作为在步骤S1中受理到的参数PR1的振幅A1增加，并将其设为振幅A1’(＞A1)。其结果是，由信号生成部44(图4)生成的摆动信号WS1被变更为具有振幅A1’的摆动信号WS1’。
在图11中示出在针对参数调整后的摆动信号WS1’执行了滤波处理FR1的情况下生成的摆动信号WS2。如图11所示，通过使参数PR1的振幅A1增大为振幅A1’，能够使摆动信号WS2的振幅A2与在步骤S1中受理到的振幅A1一致(A2＝A1)。
通过这样，使得摆动信号WS2的滤波处理后参数PR2(振幅A2、频率f2、相位φ2)与摆动信号WS1的参数PR1一致(A2＝A1、f2＝f1、φ2＝φ1＝0、ts＝0)，由此，能够满足第一条件CD1。
此外，处理器30也可以基于图6所示的从振幅A1向振幅A2的变化量来决定在该步骤S6中使振幅A1增加的变化量。作为一例，处理器30在步骤S4中获取图6中的振幅A1与振幅A2之差Δ1(＝A1-A2)。然后，处理器30在步骤S6中通过对振幅A1加上Δ1×α(α为规定的系数)来设为振幅A1’(＝A1+Δ1×α)。作为其它例子，处理器30在步骤S4中获取图6中的振幅A1与振幅A2之比R1(＝A1/A2)。然后，处理器30在步骤S6中通过对振幅A1乘以比R1来设为振幅A1’(＝A1×R1)。
通过这样，处理器30将参数PR1(例如振幅A1)调整为参数PR1’(振幅A1’)，以使得满足第一条件CD1。因而，在本实施方式中，处理器30作为参数调整部58(图2)发挥功能。处理器30将保存于存储器32中的参数设定值PR1V更新为在该步骤S6中进行了调整后的参数PR1’。
在步骤S7中，处理器30获取动作状态参数OPR。动作状态参数OPR是表示按照摆动信号WS2使机器人12执行了摆动动作时的该机器人12的动作状态的参数，例如包括机器人12的速度V、加速度a以及加加速度j。
例如，当在步骤S5中判定为“是”之后执行步骤S7的情况下，动作状态参数OPR包括按照图6所示的摆动信号WS2使机器人12执行了摆动动作时的该机器人12的速度V、加速度a以及加加速度j。图6所示的摆动信号WS2具有与在步骤S1中受理到的参数PR1对应的滤波处理后参数PR2(振幅A2＜A1、频率f2＝f1、相位φ2＝φ1)。
另一方面，在步骤S6之后执行步骤S7的情况下，动作状态参数OPR包括按照图11所示的摆动信号WS2使机器人12执行了摆动动作时的该机器人12的速度V、加速度a以及加加速度j。图11的摆动信号WS2具有与步骤S6的调整后的参数PR1’对应的滤波处理后参数PR2(振幅A2＝A1、频率f2＝f1、相位φ2＝φ1)。
处理器30通过在该步骤S7中执行与上述的步骤S3和步骤S4同样的过程，来获取图6或图11的摆动信号WS2的滤波处理后参数PR2。具体地说，在步骤S5中判定为“是”之后执行步骤S7的情况下，处理器30模拟地生成具有在步骤S1中受理到的参数PR1的摆动信号WS1，接下来，获取与该摆动信号WS1对应的滤波处理后参数PR2(振幅A2＜A1、频率f2＝f1、相位φ2＝φ1)。
另一方面，在步骤S5中判定为“是”之后执行步骤S7的情况下，处理器30模拟地生成具有步骤S6的调整后的参数PR1’的摆动信号WS1’，接下来，获取与该摆动信号WS1’对应的滤波处理后参数PR2(振幅A2＝A1、频率f2＝f1、相位φ2＝φ1)。
接下来，处理器30模拟地生成具有所获取到的滤波处理后参数PR2的摆动信号WS2。与此同时，处理器30作为主动作指令生成部42发挥功能，模拟地生成主动作指令CM1，处理器30作为滤波器部46发挥功能，通过针对主动作指令CM1执行滤波处理FR1来生成主动作指令CM2。
然后，处理器30作为摆动动作指令生成部50发挥功能，通过在主动作指令CM2中应用所生成的摆动信号WS2，来模拟地生成摆动动作指令CM3(＝CM2+WS2)。处理器30基于模拟地生成的摆动动作指令CM3，来求出按照该摆动动作指令CM3使机器人12执行了摆动动作时的该机器人12的速度V、加速度a以及加加速度j。
此时，处理器30也可以通过进行按照摆动动作指令CM3使机器人12执行摆动动作的仿真，来获取速度V、加速度a以及加加速度j。像这样，在本实施方式中，处理器30作为获取动作状态参数OPR(速度V、加速度a、加加速度j)的动作获取部60(图2)发挥功能。
在步骤S8中，处理器30作为条件判定部56发挥功能，判定滤波处理后参数PR2是否满足预先决定的第二条件CD2。在本实施方式中，该第二条件CD2被决定为在步骤S7中获取到的动作状态参数OPR(速度V、加速度a、加加速度j)不超过规定的容许值这一条件。
例如，处理器30针对在步骤S7中获取到的速度V、加速度a以及加加速度j分别判定是否超过了容许值。然后，在速度V、加速度a以及加加速度j中的至少一者超过了对应的容许值的情况下，处理器30判定为在步骤S7中被获取了动作状态参数OPR的摆动信号WS2的滤波处理后参数PR2不满足第二条件CD2(即，“否”)。
另一方面，在速度V、加速度a以及加加速度j全部没有超过对应的容许值的情况下，处理器30判定为滤波处理后参数PR2满足第二条件CD2(即，“是”)。速度V、加速度a以及加加速度j的容许值被预先保存于存储器32。
此外，处理器30也可以在步骤S7中仅获取一个动作状态参数OPR(例如速度V)，并且在该步骤S8中判定该一个动作状态参数OPR是否超过了容许值。处理器30在该步骤S8中判定为“是”的情况下进入步骤S10，在判定为“否”的情况下进入步骤S9。
在步骤S9中，处理器30作为参数调整部58发挥功能，对参数PR1或PR1’进行调整，以使得满足第二条件CD2。具体地说，处理器30按照在步骤S1中受理到的优先级PO，来如下面那样对参数PR1或PR1’进行调整。
即，处理器30以使优先级PO高的第一参数PR1或PR1’所对应的滤波处理后参数PR2与该第一参数PR1或PR1’一致而容许优先级低的第二参数PR1或PR1’所对应的滤波处理后参数PR2与该第二参数PR1或PR1’不同的方式对参数PR1或PR1’进行调整。
下面，对处理器30在步骤S1中受理了决定为应优先再现振幅A1的优先级PO的输入的情况进行说明。例如，在步骤S5中判定为“是”之后(也就是说不执行步骤S6)执行步骤S9的情况下，处理器30以设定端点停止时间ts(＞0)的方式对图5所示的摆动信号WS1的参数PR1进行调整。在图12中示出像这样被设定了端点停止时间ts的摆动信号WS1’。
图12所示的摆动信号WS1’的频率f1’(＝1/T1’)低于原始的摆动信号WS1的频率f1。即，在该情况下，处理器30要将参数PR1调整为具有振幅A1、频率f1’、相位φ(＝0)以及端点停止时间ts(＞0)的参数PR1’。
在针对具有调整后的参数PR1’的摆动信号WS1’执行了滤波处理FR2的情况下，得到图13所示的摆动信号WS2。该摆动信号WS2具有振幅A2＝A1来作为滤波处理后参数PR2。
像这样，通过以延长端点停止时间ts的方式进行调整，能够将振幅A1再现为滤波处理后参数PR2的振幅A2。此时调整的端点停止时间ts是以使得能够满足第二条件CD2的方式决定的。例如，端点停止时间ts能够被决定为与滤波时间τ2一致的值(或者对滤波时间τ2乘以规定的系数所得到的值)。
另一方面，在图7的步骤S5中判定为“否”之后(也就是执行步骤S6之后)执行步骤S9的情况下，处理器30首先取消在步骤S6中被进行了调整的参数PR1’(换言之，删除在该时间点作为参数设定值PR1V存储的参数PR1’)。
然后，处理器30与通过图12所说明的方法同样地以设定端点停止时间ts的方式对在步骤S1中受理到的参数PR1进行调整。其结果，生成具有在步骤S9中新调整后的参数PR1’的摆动信号WS1’(图12)，其结果，能够将振幅A1再现为参数PR2的振幅A2。
此外，处理器30还能够不设定端点停止时间ts而再现振幅A1。例如，在步骤S5中判定为“否”之后执行步骤S9的情况下，处理器30以使在步骤S6中进行了调整后的参数PR1’的频率f1降低为f1’的方式进一步调整该参数PR1’。
即，在该情况下，图10所示的摆动信号WS1’的周期T1增加为更长的周期T1’(＞T1)。因此，进一步调整后的参数PR1’具有振幅A1’和频率f1’。此时使频率f1降低为频率f1’的变化量也可以以使得能够满足第二条件CD2的方式基于振幅A1’来决定。
作为一例，也可以是，在存储器32中预先保存有能够满足第二条件CD2的振幅A和频率f的数据表DT。该数据表DT能够通过实验方法或仿真来预先制作。然后，处理器30也可以从数据表DT读取与振幅A1’对应的频率f并将该频率f决定为参数PR1’的频率f1’。
像这样，在按照优先级PO而应使振幅A1优先的情况下，处理器30以使滤波处理后参数PR2的振幅A2与在步骤S1中受理到的参数PR1的振幅A1一致而容许滤波处理后参数PR2的频率f2与在步骤S1中受理到的频率f1不同的方式对参数PR1或PR1’进行调整。
接着，对处理器30在步骤S1中受理了决定为应优先再现频率f1的优先级PO的输入的情况进行说明。例如，在步骤S5中判定为“是”之后执行步骤S9的情况下，处理器30以使振幅A1减少的方式调整图5所示的摆动信号WS1的参数PR1。另外，在步骤S5中判定为“否”之后执行步骤S9的情况下，处理器30以使振幅A1’减少的方式进一步调整图10所示的摆动信号WS1’的参数PR1’。
在此，是否能够满足第二条件CD2(也就是说，动作状态参数OPR是否不超过容许值)依赖于摆动信号WS2的振幅A2与频率f2的组合。具体地说，振幅A2越大，并且频率f2越高，则不能够满足第二条件CD2的可能性越大。
因而，能够通过在该步骤S9中使频率f1降低或者使振幅A1、A1’减少来对参数PR1或PR1’进行调整，以使得满足第二条件CD2(也就是使得动作状态参数OPR不超过容许值)。处理器30将保存于存储器32中的参数设定值PR1V更新为在该步骤S9中调整后的参数PR1’。
再次参照图7，在步骤S10中，处理器30判定是否从操作员、上级控制器或计算机程序受理了作业开始指令。处理器30在判定为受理了作业开始指令(即，“是”)的情况下进入步骤S10，另一方面，在判定为“否”的情况下循环进行步骤S10。
在步骤S11中，处理器30生成摆动动作指令CM3。具体地说，处理器30如参照图4所说明的那样作为信号生成部44发挥功能，使用在该时间点作为参数设定值PR1V存储的参数PR1或PR1’来生成具有该参数PR1或PR1’的摆动信号WS1(图5)或WS1’(图10或图12)。
然后，处理器30作为滤波器部48发挥功能，针对摆动信号WS1或WS1’执行滤波处理FR2，来生成摆动信号WS2(图6、图11或图13)。在此处所生成的摆动信号WS2的参数PR2中，如上述那样再现了优先级PO高的参数PR1(例如，振幅A1或频率f1)。
然后，处理器30如上述那样基于摆动信号WS2来生成摆动动作指令CM3，通过按照该摆动动作指令CM3使机器人12的伺服马达28进行动作，来使机器人12执行如图3所示那样的摆动动作。与此同时，处理器30启动工具26来对工件W进行焊接。
再次参照图7，在步骤S12中，处理器30判定焊接作业是否结束。处理器30在判定为焊接作业结束(即，“是”)的情况下，结束图7所示的流程，另一方面，在判定为“否”的情况下循环进行步骤S12。通过这样，处理器30在对工件W执行焊接作业的期间，使机器人12执行摆动动作。
如上所述，在本实施方式中，处理器30作为输入受理部52、信号生成部44、参数获取部54、条件判定部56、参数调整部58以及动作获取部60发挥功能，生成用于摆动动作的信号WS1、WS1’、WS2。
因而，输入受理部52、参数获取部54、信号生成部44、条件判定部56、参数调整部58以及动作获取部60构成生成信号WS1、WS1’、WS2的装置70(图2)。装置70(输入受理部52、参数获取部54、信号生成部44、条件判定部56、参数调整部58以及动作获取部60)能够是通过由处理器30执行的计算机程序实现的功能模块。
在该装置70中，在条件判定部56判定为不满足条件CD1、CD2的情况下，参数调整部58对输入受理部52所受理到的参数PR1进行调整，以使得满足该条件CD1、CD2(步骤S6、S9)。然后，在参数调整部58对参数PR1进行了调整的情况下，信号生成部44生成具有调整后的参数PR1’的摆动信号WS1’(步骤S11)。
根据该结构，能够自动地调整参数PR1，以使得能够生成满足操作员任意地决定的条件CD1、CD2的摆动信号WS。由此，能够使机器人12以操作员所期望的方式执行摆动动作，并且能够使向机器人12示教所期望的摆动动作的作业简单化。
另外，在装置70中，在滤波处理后参数PR2与参数PR1不同的情况下，条件判定部56判定为不满足第一条件CD1(步骤S5：“否”)，参数调整部58对参数PR1进行调整，以使得能够使滤波处理后参数PR2与该参数PR1一致(步骤S6)。
根据该结构，在通过针对具有调整后的参数PR1’的摆动信号WS1’执行滤波处理FR2而得到的摆动信号WS2中，能够再现操作员所输入的参数PR1(例如振幅A1)。由此，能够使机器人12更有效地执行操作员所期望的摆动动作。
另外，在装置70中，参数调整部58按照多个参数PR1(例如振幅A1、频率f1)的优先级PO，来以使该优先级PO高的第一参数PR1(例如振幅A1)所对应的滤波处理后参数PR2(振幅A2)与该第一参数PR1一致而容许优先级PO低的第二参数PR1(例如频率f1)所对应的滤波处理后参数PR2(频率f2)与该第二参数PR1不同的方式对多个参数PR1进行调整(步骤S9)。
然后，输入受理部52还受理优先级PO的输入，参数调整部58按照输入受理部52受理到的优先级PO来对多个参数PR1进行调整。根据该结构，在摆动信号WS2中能够优先再现操作员所输入的优先级PO高的参数PR1，因此操作员能够考虑条件CD1、CD2来任意地设计使机器人12执行的摆动动作。另外，由于操作员易于预想到所生成的摆动信号WS2，因此能够使摆动动作时的机器人12的行为的验证容易化。
另外，在装置70中，动作获取部60获取动作状态参数OPR(步骤S7)，在动作获取部60获取到的动作状态参数OPR超过了规定的容许值的情况下，条件判定部56判定为不满足第二条件CD2(步骤S8：“否”)。在该情况下，参数调整部58对参数PR1进行调整以使得动作状态参数OPR不超过容许值(步骤S9)。
根据该结构，能够防止在摆动动作时机器人12成为不适当的动作状态(例如，速度、加速度或加加速度过大的状态)，因此能够防止对机器人12施加过度的负荷，进而能够防止机器人12发生故障。另外，能够防止由于机器人12以不适当的动作状态执行摆动动作而导致针对工件W的焊接品质降低。
此外，如参照图8所说明的那样，在步骤S1中操作员输入了振幅A1、频率f1以及端点停止时间ts(＞0)的情况下，摆动信号WS1的频率f会从操作员所输入的频率f1变更为频率f3。
在图14中示出作为具有振幅A1、频率f1以及端点停止时间ts＝0的三角波的信号WS0和具有振幅A1、频率f3(＝1/T3)以及端点停止时间ts(＞0)的摆动信号WS1。处理器30当在步骤S1中受理了端点停止时间ts的输入时，将频率f3作为参数PR1的参数设定值PR1V存储于存储器32。
然后，处理器30在上述的步骤S4中获取频率f3来作为滤波处理后参数PR2。这样一来，处理器30在步骤S5中由于作为滤波处理后参数PR2的频率f3与在步骤S1中受理到的频率f1不同而判定为“否”。
在该情况下，当操作员在步骤S1中输入了决定为应优先再现频率f1的优先级PO时，处理器30在步骤S6中对参数PR1进行调整，以将被设定为参数设定值PR1V的频率f3变更为受理到输入的频率f1。
其结果是，由信号生成部44生成的摆动信号WS1如图15所示那样被变更为作为具有频率f1的梯形波的摆动信号WS1’。然后，处理器30将具有频率f1的摆动信号WS1’的参数PR1’作为参数设定值PR1V存储于存储器32。
此外，也可以是，从装置70中省略动作获取部60，从图7所示的流程中省略步骤S7～S9。在该情况下，在图7所示的流程中，处理器30在步骤S6之后执行步骤S10。在该流程中，设为操作员在步骤S1中输入了决定为应优先再现振幅A1的优先级PO。在该情况下，处理器30也可以在步骤S6中通过参照图12所说明的方法来以延长端点停止时间ts的方式对参数PR1进行调整。
可替代的是，处理器30也可以在步骤S6中以使振幅A1和频率f1双方变化的方式对参数PR1进行调整。参照图16来对这种参数调整方法进行说明。图16示出了具有作为处理器30在步骤S1中受理到的参数PR1的振幅A1、频率f1(＝1/T1)、相位φ1(＝0)以及端点停止时间ts(＝0)的摆动信号WS1。
在受理了这样的参数PR1的情况下，处理器30在步骤S6中以使振幅A1增大为振幅A1’并且使频率f1降低为频率f1’(＝1/T1’＜f1)的方式对参数PR1进行调整。其结果是，信号生成部44生成如图16所示那样具有调整后的参数PR1’(振幅A1’、频率f1’、相位φ1＝0、端点停止时间ts＝0)的摆动信号WS1’。
在图17中示出在针对图16所示的摆动信号WS1’执行了滤波处理FR2的情况下得到的摆动信号WS2。在该摆动信号WS2的滤波处理后参数PR2中，振幅A2与在步骤S1中受理到的振幅A1一致，另一方面，频率f2(＝f1’)与在步骤S1中受理到的频率f1不同。
在这样的参数调整方法中，处理器30也可以以使得滤波处理后参数PR2满足第二条件CD2的方式决定在步骤S6中使振幅A1和频率f1变化的变化量。例如，处理器30也可以通过使用上述的数据表DT来决定该变化量。
此外，在从图7所示的流程中省略了步骤S7～S9的情况下，当操作员在步骤S1中输入了决定为应优先再现频率f1的优先级PO时，处理器30也可以在步骤S6中不对参数PR1进行调整。
具体地说，如图6所示，当针对摆动信号WS1执行了滤波处理FR2时，振幅A1衰减，但是频率f1被维持。因此，处理器30即使在步骤S6中不对参数PR1进行调整，也能够再现优先级PO高的频率f1。
接着，参照图18来说明处理器30(装置70)执行的用于生成摆动信号WS的方法的其它方式。此外，在图18所示的流程中，对与图7所示的流程同样的过程标注相同的步骤编号，并省略重复的说明。下面，对处理器30在步骤S1中受理了决定为应优先再现振幅A1的优先级PO的输入的情况进行说明。在本实施方式中，处理器30在步骤S5或S8中判定为“否”之后，执行步骤S6’。
在步骤S6’中，处理器30作为参数调整部58发挥功能，对在该时间点设定为参数设定值PR1V的参数PR1或PR1’进行调整，以使得满足条件CD1和CD2。例如，在步骤S5中判定为“否”之后执行步骤S6’的情况下，处理器30与上述的步骤S6同样地使在步骤S1中受理到的振幅A1增加并设为振幅A1’。
另一方面，在步骤S8中判定为“否”之后执行步骤S6’的情况下，处理器30例如设定图12所示的端点停止时间ts(也就是使频率f1或f1’变化)、或者如参照图16所说明的那样使振幅A1或A1’以及频率f1或f1’双方变化。
在此，在步骤S8中判定为“否”之后执行步骤S6’的情况下，处理器30也可以使用例如上述的数据表DT来以使得能够满足第二条件CD2的方式决定使参数PR1或PR1’变化的变化量。可替代的是，处理器30也可以每当执行步骤S6’时使优先级PO低的参数PR1或PR1’(例如频率f1或f1’)随机地变化。
处理器30在执行步骤S6’之后，返回到步骤S3，并重复执行步骤S3～S5、S6’、S7以及S8的循环直到在步骤S8中判定为“是”为止。由此，处理器30能够按照优先级PO来自动地检索能够满足条件CD1和CD2的参数PR1’。
此外，在图18所示的流程中，处理器30也可以在步骤S5中仅针对在步骤S1中受理到的优先级PO高(也就是说处于第一位)的参数PR1(例如振幅A1)判定是否满足第一条件CD1。
可替代的是，处理器30也可以在第一次执行的步骤S5中针对在步骤S1中受理到的全部的参数PR1判定是否满足第一条件CD1，另一方面，在第n次(n为2以上的整数)执行的步骤S5中仅针对在步骤S1中受理到的优先级PO高的参数PR1(例如振幅A1)判定是否满足第一条件CD1。
根据本实施方式，由于处理器30自动地检索最佳的参数PR1’，因此能够有效地设计与操作员所期望的方式相符的摆动动作，并且能够使向机器人12示教这种摆动动作的作业简单化。
此外，在上述的实施方式中，记述了相位φ1不会通过滤波处理FR2而变化的情况。然而，根据滤波处理FR2的种类的不同，相位φ1有时会变化。在这样的情况下，在步骤S1中受理了决定为应优先再现相位φ1的优先级PO的输入的情况下，处理器30在上述的步骤S6、S6’或S9中对参数PR1、PR1’进行调整，以使得再现相位φ1。
下面，参照图19～图21来说明再现相位φ1的方法。在图19中，用虚线示出了具有振幅A1、频率f1(＝1/T1)以及相位φ1(＝0)来作为参数PR1的摆动信号WS1。另一方面，用实线示出了通过针对该摆动信号WS1执行滤波处理FR2而得到的摆动信号WS2。在图19所示的例子中，摆动信号WS2的相位φ2相对于摆动信号WS1的相位φ1延迟了相位φv(也就是φ2＝φ1-φv)。
在这样的情况下，为了再现优先级PO高的相位φ1，处理器30对参数PR1进行调整，以生成图20所示的摆动信号WS1’。图20所示的摆动信号WS1’包含用点划线表示的第一个波长的波形WSa和用实线表示的第二个波长以后的波形WSb。
摆动信号WS1’的波形WSa是通过维持摆动信号WS1的第一个波长的波形的斜率并且使该波形的振幅A1降低为振幅A1’而得到的。另一方面，摆动信号WS1’的波形WSb具有与摆动信号WS1的第二个波长以后的波形相同的振幅A1。由于具有像这样降低后的振幅A1’的波形WSa而使波形WSb的相位φ1’相对于原始的摆动信号WS1的相位提前相位φv(也就是φ1’＝φ1+φv)。
处理器30为了生成图20所示的摆动信号WS1’，将原始的摆动信号WS1的参数PR1向该摆动信号WS1’的参数PR1’(振幅A1’、相位φ1’)进行调整。此外，使振幅A1向振幅A1’变化的变化量被决定为使得波形WSb的相位φ1’为φ1’＝φ1+φv的值。处理器30将调整后的参数PR1’(A1’、φ1’)作为参数设定值PR1V存储于存储器32。
在图21中示出通过针对图20所示的摆动信号WS1’执行滤波处理FR2而得到的摆动信号WS2。此外，在图21中，用点划线表示摆动信号WS2的与波形WSa对应的第一个波长的波形，另一方面，用实线表示摆动信号WS2的与波形WSb对应的第二个波长以后的波形。
如图21所示，摆动信号WS2的相位φ2在第二个波长以后的波形中变得与在步骤S1中受理到的摆动信号WS1的相位φ1一致。通过像这样调整参数PR1，处理器30能够再现相位φ1。
此外，处理器30也可以在摆动动作中与使工具26向前后方向的摇摆同步地使该工具26向上下方向摇摆。关于这样的摆动动作，参照图3和图22进行说明。在图22所示的例子中，处理器30以使工具26在端点P1与端点P2之间向前后方向摇摆的期间相对于移动路径WP的位置向上方位移距离δ、并且在端点P1和端点P2的位置抵接于工件W的表面的方式执行摆动动作。
在图23中示出用于使机器人12执行如图22所示的向上下方向的摇摆动作的摆动信号WS1z。此外，图23的纵轴示出使工具26向上下方向摇摆的振幅A，横轴示出时间t。图23所示的摆动信号WS1z具有正的振幅A1、频率f1(＝1/T1)、相位φ1(＝0)以及端点停止时间ts(＝0)来作为参数PR1。
通过针对该摆动信号WS1z执行滤波处理FR2而得到的摆动信号WS2z能够具有振幅A2(＜A1)来作为参数PR2。针对图23所示的摆动信号WS1z的参数PR1，也能够通过与上述的实施方式同样的方法进行调整。
而且，处理器30在上述的步骤S11中作为信号生成部44发挥功能，分别生成上述的摆动信号WS1和图23所示的摆动信号WS1z，通过将它们相加来生成合成摆动信号WS1S，并向滤波器部48输出该合成摆动信号WS1S。
通过如本实施方式那样执行与使工具26向前后方向的摇摆同步地使工具26向上下方向摇摆的摆动动作，能够提高焊接品质。而且，能够再现操作员所期望的摆动信号WS1和WS1z的参数PR1，因此能够任意地设计向前后上下摇摆的摆动动作。
此外，处理器30也可以使用上述的特有滤波时间τa来作为滤波处理FR1的滤波时间τ1。另外，在上述的步骤S2中，处理器30也可以将滤波时间τ2唯一地决定为特有滤波时间τa(或者容许滤波时间τb)。
另外，也可以从图7或图18所示的流程中省略步骤S2。在该情况下，操作员也可以操作输入装置38来输入所期望的滤波时间τ2。而且，处理器30也可以以受理了输入的滤波时间τ2来执行滤波处理FR2。在该情况下，在从操作员处受理到的滤波时间τ2比特有滤波时间τa短的情况下，处理器30也可以输出警报。
此外，在上述的实施方式中，记述了处理器30在步骤S1中受理优先级PO的输入的情况。然而，不限于此，也可以预先决定优先级PO的数据并保存于存储器32。另外，也可以不设定优先级PO。例如，处理器30也可以在上述的步骤S6’或S9中，以针对全部的参数PR1容许对应的滤波处理后参数PR2与原始的参数PR1不同的方式对该全部的参数PR1进行调整，以使得满足第二条件CD2。
另外，处理器30也可以在步骤S1中受理摆动信号WS1的波形的种类(三角波、梯形波、锯齿形波、三角函数等)的输入。另外，生成摆动动作指令CM3的结构不限定于图4所示的方式。例如，也可以省略滤波器部46，并且将滤波器部48设置在摆动动作指令生成部50的后级。
在该情况下，在摆动动作指令生成部50中将主动作指令生成部42所生成的主动作指令CM1与信号生成部44所生成的摆动信号WS1、WS’相加，来生成摆动动作指令CM3。然后，由滤波器部48针对摆动动作指令生成部50所生成的摆动动作指令CM3执行滤波处理FR2，并向伺服马达28输出执行了滤波处理FR2后的摆动动作指令。
另外，在上述的实施方式中，记述了装置70的功能被安装于控制装置14的情况。然而，不限于此，装置70的功能也可以安装于与控制装置14以能够进行通信的方式连接的其它计算机(示教器、平板型PC、桌上型PC等)。在该情况下，该其它计算机的处理器作为装置70发挥功能。而且，该其它计算机的处理器也可以作为信号生成部44发挥功能，生成摆动信号WS1、WS1’并将其发送到控制装置14。
另外，在上述的实施方式中，记述了工具26为焊炬、并且用于对工件W执行焊接作业的情况。然而，不限于此，工具26例如也可以构成为使从钎焊材料进给装置(未图示)进给的钎焊材料熔融来对工件W执行硬钎焊作业，或者也可以构成为对工件W执行任何的作业。
另外，机器人12不限于是垂直多关节型机器人，例如也可以是水平多关节型机器人、并联连杆型机器人等能够使工具26移动的任何类型的机器人。上面通过实施方式对本公开进行了说明，但是上述的实施方式并不是要对权利要求书所涉及的发明进行限定。
附图标记说明
10：机器人系统；12：机器人；14：控制装置；26：工具；30：处理器；42：主动作指令生成部；44：信号生成部；46、48：滤波器部；50：摆动动作指令生成部；52：输入受理部；54：参数获取部；56：条件判定部；58；参数调整部；60：动作获取部。

Claims (10)

1.一种装置，生成用于摆动动作的信号，该摆动动作是通过机器人使工具沿着预先决定的作业路径移动并且使该工具向与该作业路径交叉的方向摇摆的动作，所述装置具备：
输入受理部，其受理用于所述机器人使所述工具摇摆的摆动信号的参数的输入；
信号生成部，其生成具有所述输入受理部所受理到的所述参数的所述摆动信号；
参数获取部，其获取针对所述信号生成部所生成的所述摆动信号执行了用于去除高频成分的滤波处理的情况下的该摆动信号的所述参数来作为滤波处理后参数；
条件判定部，其判定所述滤波处理后参数是否满足预先决定的条件；以及
参数调整部，在所述条件判定部判定为不满足所述条件的情况下，所述参数调整部对所述输入受理部所受理到的所述参数进行调整，以使得满足该条件，
其中，所述信号生成部生成具有由所述参数调整部进行了调整后的所述参数的所述摆动信号。
2.根据权利要求1所述的装置，其中，
在所述滤波处理后参数与所述输入受理部所受理到的所述参数不同的情况下，所述条件判定部判定为不满足所述条件，
所述参数调整部对所述输入受理部所受理到的所述参数进行调整，以使得能够使所述滤波处理后参数与该参数一致。
3.根据权利要求2所述的装置，其中，
所述参数调整部按照所述输入受理部所受理到的多个所述参数的优先级，以使该优先级高的第一所述参数所对应的所述滤波处理后参数与该第一参数一致而容许所述优先级比该第一参数的所述优先级低的第二所述参数所对应的所述滤波处理后参数与该第二参数不同的方式对所述多个参数进行调整。
4.根据权利要求3所述的装置，其中，
所述输入受理部还受理所述优先级的输入，
所述参数调整部按照所述输入受理部所受理到的所述优先级来对所述多个参数进行调整。
5.根据权利要求1～4中的任一项所述的装置，其中，
还具备动作获取部，所述动作获取部获取动作状态参数，所述动作状态参数表示按照具有所述滤波处理后参数的所述摆动信号使所述机器人执行了所述摆动动作时的该机器人的动作状态，
在所述动作获取部所获取到的所述动作状态参数超过规定的容许值的情况下，所述条件判定部判定为不满足所述条件，
所述参数调整部对所述参数进行调整以使得所述动作状态参数不超过所述容许值。
6.根据权利要求5所述的装置，其中，
所述动作状态参数包括所述机器人的速度、加速度以及加加速度中的至少一者。
7.根据权利要求1～6中的任一项所述的装置，其中，
所述参数包括所述摆动信号的振幅、所述摆动信号的频率、所述摆动信号的相位、以及用于确定将所述工具维持于所述摆动动作中的该工具的摇摆动作的端点的时间的端点停止时间中的至少一者。
8.一种控制装置，具备根据权利要求1～7中的任一项所述的装置，所述控制装置对所述机器人进行控制以使得所述机器人执行所述摆动动作。
9.根据权利要求8所述的控制装置，还具备：
主动作指令生成部，其生成用于所述机器人使所述工具向所述作业路径的方向移动的主动作指令；
滤波器部，其针对所述信号生成部所生成的所述摆动信号执行所述滤波处理；以及
摆动动作指令生成部，其通过在所述主动作指令中应用由所述滤波器部执行了所述滤波处理后的所述摆动信号，来生成用于使所述机器人执行所述摆动动作的摆动动作指令。
10.一种方法，生成用于摆动动作的信号，该摆动动作是通过机器人使工具沿着预先决定的作业路径移动并且使该工具向与该作业路径交叉的方向摇摆的动作，在所述方法中，处理器执行以下处理：
受理用于所述机器人使所述工具摇摆的摆动信号的参数的输入；
生成具有所受理到的所述参数的所述摆动信号；
获取针对所生成的所述摆动信号执行了用于去除高频成分的滤波处理的情况下的该摆动信号的所述参数来作为滤波处理后参数；
判定所述滤波处理后参数是否满足预先决定的条件；
在判定为不满足所述条件的情况下，对所受理到的所述参数进行调整，以使得满足该条件；以及
生成具有被进行了调整后的所述参数的所述摆动信号。
CN202280020502.3A 2021-03-30 2022-03-23 生成用于摆动动作的信号的装置、控制装置以及方法 Pending CN116964535A (zh)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2021058154 2021-03-30
JP2021-058154 2021-03-30
PCT/JP2022/013687 WO2022210202A1 (ja) 2021-03-30 2022-03-23 ウィービング動作のための信号を生成する装置、制御装置、及び方法

Publications (1)

Publication Number Publication Date
CN116964535A true CN116964535A (zh) 2023-10-27

Family

ID=83456797

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202280020502.3A Pending CN116964535A (zh) 2021-03-30 2022-03-23 生成用于摆动动作的信号的装置、控制装置以及方法

Country Status (6)

Country Link
US (1) US20240131707A1 (zh)
JP (1) JPWO2022210202A1 (zh)
CN (1) CN116964535A (zh)
DE (1) DE112022000782T5 (zh)
TW (1) TW202237351A (zh)
WO (1) WO2022210202A1 (zh)

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5916583B2 (ja) 2012-10-19 2016-05-11 株式会社神戸製鋼所 多関節ロボットのウィービング制御装置
JP2019028909A (ja) * 2017-08-03 2019-02-21 パナソニックＩｐマネジメント株式会社 溶接ロボット装置
JP7199952B2 (ja) * 2018-12-18 2023-01-06 日本電産サンキョー株式会社 ロボットの制御装置及び制御方法
JP6811908B1 (ja) * 2019-06-28 2021-01-13 三菱電機株式会社 数値制御装置、機械学習装置および数値制御方法

Also Published As

Publication number Publication date
TW202237351A (zh) 2022-10-01
JPWO2022210202A1 (zh) 2022-10-06
DE112022000782T5 (de) 2024-02-15
US20240131707A1 (en) 2024-04-25
WO2022210202A1 (ja) 2022-10-06

Similar Documents

Publication Publication Date Title
KR20180037114A (ko) 파라미터 설정의 실시간 픽토그래프 표현을 갖는 사용자 인터페이스
CN110871433B (zh) 示教装置、示教方法以及存储介质
JP6426662B2 (ja) スカイビング加工制御を行う数値制御装置
JP3592628B2 (ja) 数値制御方法
TW201312308A (zh) 加工程式作成裝置、數值控制裝置、加工系統、加工程式作成方法及數值控制方法
US9891618B2 (en) Program correcting device and program correcting method of industrial robot
CN109954955B (zh) 机器人系统
CN108375957B (zh) 数值控制装置和控制方法
JPH10254526A (ja) 数値制御装置
JP2008046899A (ja) 数値制御装置
CN116964535A (zh) 生成用于摆动动作的信号的装置、控制装置以及方法
JP7002072B2 (ja) 数値制御装置と制御方法
JP2016194860A (ja) 振動切削加工装置および振動切削加工方法
JP6487490B2 (ja) 数値制御装置
JP7252040B2 (ja) 数値制御装置
JP6324616B1 (ja) 数値制御装置
KR100898035B1 (ko) 공구경로 수정 방법
JP7433570B1 (ja) 数値制御装置および数値制御方法
JP2018060242A (ja) 数値制御装置
TW202306724A (zh) 產生用於織動動作之信號之裝置及控制裝置
JP2021071895A (ja) 振動抑制方法及び振動抑制装置
JP7238673B2 (ja) 数値制御装置及び制御方法
JP2019175027A (ja) 数値制御装置と制御方法
JPS60237505A (ja) ロボツト制御方法
JP2022107350A (ja) 溶接ロボット

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination