CN102854901B - 同步控制装置、同步控制方法 - Google Patents

同步控制装置、同步控制方法 Download PDF

Info

Publication number
CN102854901B
CN102854901B CN201210148360.7A CN201210148360A CN102854901B CN 102854901 B CN102854901 B CN 102854901B CN 201210148360 A CN201210148360 A CN 201210148360A CN 102854901 B CN102854901 B CN 102854901B
Authority
CN
China
Prior art keywords
driven shaft
control
main shaft
cam curve
shaft
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.)
Active
Application number
CN201210148360.7A
Other languages
English (en)
Other versions
CN102854901A (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.)
Omron Corp
Original Assignee
Omron 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 Omron Corp filed Critical Omron Corp
Publication of CN102854901A publication Critical patent/CN102854901A/zh
Application granted granted Critical
Publication of CN102854901B publication Critical patent/CN102854901B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • 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/416Numerical 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 of velocity, acceleration or deceleration

Abstract

本发明提供一种同步控制装置、同步控制方法、同步控制程序以及记录了同步控制程序的计算机可读取的记录介质,其能够缓和对从动轴施加的冲击,且能够在同步开始位置可靠地开始同步控制。用户指令部(62)指定主轴和从动轴开始同步的同步开始位置。凸轮曲线生成部(64)生成凸轮曲线。检测部(65)检测每个控制周期的主轴的位置信息。控制部(66)在同步开始位置之前,基于凸轮曲线和主轴的位置信息,在每个控制周期计算对于从动轴的速度指令值,在同步开始位置之后,基于主轴和从动轴的齿轮比,在每个控制周期计算对于从动轴的速度指令值,并以计算出的速度指令值来控制从动轴。

Description

同步控制装置、同步控制方法
技术领域
本发明涉及同步控制装置、同步控制方法、同步控制程序以及记录了同步控制程序的计算机可读取的记录介质,尤其涉及使主轴和从动轴根据任意的齿轮比来进行同步动作的同步控制装置、同步控制方法、同步控制程序以及记录了同步控制程序的计算机可读取的记录介质。
背景技术
可编程逻辑控制器(Programmable Logic Controller:以下,称为“PLC”)例如由执行用户程序的运算单元、负责来自外部的开关或传感器的信号输入和对于外部的继电器(relay)或致动器(actuator)的信号输出的IO(输入输出)单元等的多个单元构成。PLC在这些单元之间,在每个用户程序执行循环,经由PLC系统总线和/或现场网络而进行数据的授受的同时,执行控制动作。
作为机械、设备等的动作的控制,有时包括用于控制电动机的运动的动作控制。作为这样的动作控制的典型例,设想着定位表(table)或进行机器人等机械机构的定位的应用。
在动作控制器中,同步动作或同步控制意味着主轴和从动轴保持着某种关系的同时动作的方式,一般包括凸轮(cam)动作或齿轮动作。凸轮动作是如下方式:在每个控制周期,从凸轮表中检索与主轴的位置(相位)对应的从动轴的位置(位移),从而决定从动轴的指令位置。齿轮动作是如下方式:将对主轴的速度乘以齿轮比的值作为从动轴的指令速度,从而决定从动轴的指令位置。
接着,说明齿轮动作。
为了使从动轴从停止的状态起到与主轴同步,需要以阶梯状地变化从动轴的速度。
这对应于如下情况:在手动传送(manual transmission)方式的汽车中,将主轴换作引擎、将从动轴换作车轮来考虑的情况下,不半踩离合器而立即进行了齿轮变速的情况。即,若踩下离合器,则与对从动轴(=车轮)产生不合理的力的情况相同。为了缓和因这样的从动轴速度急剧变化而对从动轴施加的机械冲击,考虑降低主轴的速度的方法和在同步开始之前开始从动轴的动作的方法(以下,称为“追赶动作”)。
在降低主轴的速度的方法中,存在装置的吞吐量(在单位时间内可处理的数目)减少或者在CNC(Computerized Numerically Controlled,计算机数字控制机床)中加工精度下降等的问题。因此,实现追赶动作是非常重要的。作为实现例,例如在专利文献1(日本专利第3452899号公报)中,公开了一种“追赶动作”的实现方法。即,在专利文献1中记载的动作方式中,预先定义了加减速的直线或曲线,从动轴在同步开始位置之前进行加减速,在同步开始位置之后主轴和从动轴同步。
现有技术文献
【专利文献】
【专利文献1】日本专利第3452899号公报
但是,在专利文献1(日本专利第3452899号公报)中,在追赶动作中,从动轴单独动作。因此,存在在追赶动作中主轴的速度产生了变化的情况下,不能在同步开始位置开始同步控制的问题。
这是因为,专利文献1(日本专利第3452899号公报)想要解决的课题是“缓和在同步开始时的从动轴的机械冲击”,并没有考虑追赶动作时的主轴的速度变化。
在如CNC(Computerized Numerically Controlled,计算机数字控制机床)工作机械这样主轴的速度微小的情况下,即使在追赶动作中主轴和从动轴没有同步,也有可能不会成为大的问题。但是,在所谓的通用动作控制器中,有时主轴的速度大幅变化。在这样的情况下,不能在同步开始位置开始同步控制。
发明内容
因此,本发明的目的在于,提供一种同步控制装置、同步控制方法、同步控制程序以及记录了同步控制程序的计算机可读取的记录介质,其能够缓和对从动轴施加的冲击,且能够在同步开始位置可靠地开始同步控制。
为了解决上述课题,本发明是一种同步控制装置,在每个控制周期执行主轴和从动轴的同步控制,其中,所述同步控制装置包括:指定部,指定主轴和从动轴开始同步的同步开始位置;凸轮曲线生成部,生成凸轮曲线;检测部,检测每个控制周期的主轴的位置信息;以及控制部,在同步开始位置之前,基于凸轮曲线和主轴的位置信息,在每个控制周期计算对于从动轴的速度指令值,在同步开始位置之后,基于主轴和从动轴的齿轮比,在每个控制周期计算对于从动轴的速度指令值,控制部以计算出的速度指令值来控制从动轴。
优选地,凸轮曲线生成部基于在同步开始位置之前的期间中的指定的目标加速度、目标减速度、以及目标速度,生成凸轮曲线。
此外,本发明是一种同步控制方法,在每个控制周期执行主轴和从动轴的同步控制,其中,所述同步控制方法包括:指定主轴和从动轴开始同步的同步开始位置的步骤;生成凸轮曲线的步骤;检测每个控制周期的主轴的位置信息的步骤;在同步开始位置之前,基于凸轮曲线和主轴的位置信息,在每个控制周期计算对于从动轴的速度指令值,在同步开始位置之后,基于主轴和从动轴的齿轮比,在每个控制周期计算对于从动轴的速度指令值的步骤;以及以计算出的速度指令值来控制从动轴的步骤。
此外,本发明是一种同步控制程序,使计算机在每个控制周期执行主轴和从动轴的同步控制,其中,所述同步控制程序执行:指定主轴和从动轴开始同步的同步开始位置的步骤;生成凸轮曲线的步骤;检测每个控制周期的主轴的位置信息的步骤;在同步开始位置之前,基于凸轮曲线和主轴的位置信息,在每个控制周期计算对于从动轴的速度指令值,在同步开始位置之后,基于主轴和从动轴的齿轮比,在每个控制周期计算对于从动轴的速度指令值的步骤;以及以计算出的速度指令值来控制从动轴的步骤。
此外,本发明是一种记录了同步控制程序的计算机可读取的记录介质,所述同步控制程序使计算机在每个控制周期执行主轴和从动轴的同步控制,其中,所述同步控制程序执行:指定主轴和从动轴开始同步的同步开始位置的步骤;生成凸轮曲线的步骤;检测每个控制周期的主轴的位置信息的步骤;在同步开始位置之前,基于凸轮曲线和主轴的位置信息,在每个控制周期计算对于从动轴的速度指令值,在同步开始位置之后,基于主轴和从动轴的齿轮比,在每个控制周期计算对于从动轴的速度指令值的步骤;以及以计算出的速度指令值来控制从动轴的步骤。
根据本发明,能够缓和对从动轴施加的冲击,且能够在同步开始位置可靠地开始同步控制。
附图说明
图1是表示PLC系统的概略结构的示意图。
图2是表示CPU单元的硬件结构的示意图。
图3是表示在CPU单元中执行的软件结构的示意图。
图4是表示同步控制装置的结构的图。
图5(a)和(b)是表示凸轮曲线的例子的图。
图6是表示第一实施方式的同步控制的动作步骤的流程图。
图7是表示第二实施方式的同步控制的动作步骤的流程图。
图8(a)和(b)是表示凸轮曲线的例子的图。
标号说明
1PLC、2现场网络、3、69、70伺服电动机驱动器、4伺服电动机、5终端、6检测开关、7继电器、8PLC支持装置、10连接电缆、11系统总线、12电源单元、13、14、53 IO单元、15特殊单元、51终端总线、52通信耦合器、53 IO单元、61同步控制装置、62用户指令部、63调度部、64凸轮曲线生成部、65检测部、66控制部、67、68编码器、100微处理器、102芯片组、104主存储器、106非易失性存储器、108系统定时器、110连接器、120系统总线控制器、122、142控制电路、124系统总线控制电路、126、146缓存存储器、130系统总线连接器、140现场网络控制器、144现场网络控制电路、200实时OS、210、220系统程序、212调度器程序、230控制程序、232时序命令运算程序、234动作运算程序、SYS系统。
具体实施方式
以下,参照附图说明本发明的实施方式。
【第一实施方式】
参照附图详细说明本发明的实施方式。另外,关于图中的相同或者相等部分,赋予相同的符号并不重复其说明。
<A.系统结构>
本实施方式的PLC(可编程逻辑控制器)具有用于控制电动机的运动的动作控制功能。首先,参照图1,说明本实施方式的PLC1的系统结构。
图1是表示本发明的实施方式的PLC系统的概略结构的示意图。参照图1,PLC系统SYS包括PLC1、经由现场网络(field network)2与PLC1连接的伺服电动机驱动器3以及远程IO终端5、作为现场设备的检测开关6以及继电器7。此外,在PLC1上,经由连接电缆10等而连接了PLC支持装置8。
PLC1包括执行主要的运算处理的CPU单元13、一个以上的IO单元14以及特殊单元15。这些单元经由PLC系统总线11,能够相互交换数据。此外,通过电源单元12,对这些单元提供适当的电压的电源。
参照图2,在后面叙述CPU单元13的细节。
IO单元14是有关一般的输入输出处理的单元,负责ON/OFF这样被称为二值化的数据的输入输出。即,IO单元14收集检测开关6等的传感器处于正在检测某种对象物的状态(ON)和不检测任何对象物的状态(OFF)中的哪个状态的信息。此外,IO单元14对继电器7或致动器这样的输出目标,输出用于使其有效的指令(ON)和用于使其无效的指令(OFF)中的其中一个。
特殊单元15具有模拟数据的输入输出、温度控制、特定的通信方式的通信等在IO单元14中不支持的功能。
现场网络2传输用于与CPU单元13交换的各种数据。作为现场网络2,典型地,能够使用各种产业用以太网(注册商标)。
另外,在图1中,例示了包括PLC系统总线11和现场网络2的两者的PLC系统SYS,但也可以采用仅搭载其中一个的系统结构。例如,也可以使用现场网络2连接全部单元。或者,也可以不使用现场网络2,将伺服电动机驱动器3直接连接到PLC系统总线11。此外,也可以将现场网络2的通信单元连接到PLC系统总线11,从CPU单元13经由该通信单元,与连接到现场网络2的设备之间进行通信。
伺服电动机驱动器3经由现场网络2与CPU单元13连接,且根据来自CPU单元13的指令值而驱动伺服电动机4。更具体地说,伺服电动机驱动器3以一定周期,从PLC1接受位置指令值、速度指令值、转矩指令值这样的指令值。此外,伺服电动机驱动器3根据连接到伺服电动机4的轴的位置传感器(回转式编码器)或转矩传感器这样的检测器,取得位置、速度(典型地,根据本次位置和前次位置之差而计算出)、转矩这样的有关伺服电动机4的动作的实测值。然后,伺服电动机驱动器3将来自CPU单元13的指令值设定为目标值,将实测值作为反馈值,进行反馈控制。即,伺服电动机驱动器3调整用于驱动伺服电动机4的电流,使得实测值接近目标值。另外,伺服电动机驱动器3也被称为伺服电动机放大器。
此外,在图1中表示了将伺服电动机4和伺服电动机驱动器3进行了组合的系统的例子,但也可以采用其他的结构,例如也可以采用将脉冲电动机和脉冲电动机驱动器进行了组合的系统。
在图1所示的PLC系统SYS的现场网络2中,还连接了远程IO终端5。远程IO终端5基本上与IO单元14同样地,进行有关一般的输入输出处理的处理。更具体地说,远程IO终端5包括用于进行与在现场网络2中的数据传输有关的处理的通信耦合器(coupler)52以及一个以上的IO单元53。这些单元能够经由远程IO终端总线51相互交换数据。
<B.CPU单元的硬件结构>
接着,参照图2说明CPU单元13的硬件结构。图2是表示本发明的实施方式的CPU单元13的硬件结构的示意图。
参照图2,CPU单元13包括微处理器100、芯片组102、主存储器104、非易失性存储器106、系统定时器108、PLC系统总线控制器120、现场网络控制器140、USB连接器110。芯片组102和其他的部件之间经由各个总线分别耦合。
微处理器100和芯片组102典型地基于通用的计算机结构而构成。即,微处理器100对从芯片组102根据内部时钟而依次提供的命令代码进行分析并执行。芯片组102在与所连接的各种部件之间交换内部数据,且生成微处理器100所需的命令代码。此外,芯片组102具有用于对在微处理器100中的运算处理的执行的结果所得到的数据等进行高速缓存(cache)的功能。
CPU单元13作为存储部件而包括主存储器104以及非易失性存储器106。
主存储器104是易失性的存储区域(RAM),在接通了对于CPU单元13的电源之后,保持应在微处理器100中执行的各种程序。此外,主存储器104还用作微处理器100执行各种程序时的作业用存储器。作为这样的主存储器104,使用DRAM(动态随机存取存储器)或SRAM(静态随机存取存储器)的设备。
另一方面,非易失性存储器106以非易失方式保持实时OS(操作系统)、PLC1的系统程序、用户程序、动作运算程序、系统设定参数这样的数据。这些程序或数据以微处理器100能够根据需要进行访问的方式复制到主存储器104中。作为这样的非易失性存储器106,能够使用闪速存储器这样的半导体存储器。或者,还能够使用硬盘驱动器这样的磁记录介质或DVD-RAM(数字视盘随机存取存储器)这样的光学记录介质等。
系统定时器108在每一定周期产生中断信号并提供给微处理器100。典型地说,根据硬件的规格,以多个不同的周期分别产生中断信号,但也可以设定为根据OS(操作系统)或BIOS(基本输入输出系统)等而以任意周期产生中断信号。利用该系统定时器108产生的中断信号,实现后述的每个控制循环的控制动作。
作为通信电路,CPU单元13包括PLC系统总线控制器120和现场网络控制器140。
PLC系统总线控制器120控制经由了PLC系统总线11的数据的交换。更具体地说,PLC系统总线控制器120包括DMA(动态存储器存取)控制电路122、PLC系统总线控制电路124以及缓存存储器126。另外,PLC系统总线控制器120经由PLC系统总线连接器130与PLC系统总线11在内部连接。
缓存存储器126作为经由PLC系统总线11而输出到其他的单元的数据(以下,也称为“输出数据”)的发送缓存以及经由PLC系统总线11而从其他的单元输入的数据(以下,也称为“输入数据”)的接收缓存起作用。另外,通过微处理器100的运算处理而生成的输出数据原本存储在主存储器104中。然后,应传送到特定的单元的输出数据从主存储器104中读出,暂时保持在缓存存储器126中。此外,从其他的单元传送的输入数据暂时保持在缓存存储器126之后,转移到主存储器104中。
DMA控制电路122进行从主存储器104到缓存存储器126的输出数据的传送以及从缓存存储器126到主存储器104的输入数据的传送。
PLC系统总线控制电路124在与连接到PLC系统总线11的其他的单元之间,进行发送缓存存储器126的输出数据的处理以及接收输入数据而存储在缓存存储器126中的处理。典型地说,PLC系统总线控制电路124提供PLC系统总线11中的物理层以及数据链路层的功能。
现场网络控制器140控制经由了现场网络2的数据的交换。即,现场网络控制器140根据所使用的现场网络2的标准,控制输出数据的发送和输入数据的接收。由此,本实施方式的CPU单元13经由现场网络2与作为驱动装置的伺服电动机驱动器3连接。
DMA控制电路142进行从主存储器104到缓存存储器146的输出数据的传送以及从缓存存储器146到主存储器104的输入数据的传送。
现场网络控制电路144在与连接到现场网络2的其他的装置之间,进行发送缓存存储器146的输出数据的处理以及接收输入数据而存储在缓存存储器146中的处理。典型地说,现场网络控制电路144提供现场网络2中的物理层以及数据链路层的功能。
USB连接器110是用于连接PLC支持装置8和CPU单元13的接口。典型地说,从PLC支持装置8传送的、可在CPU单元13的微处理器100中执行的程序等,经由USB连接器110而读入PLC1中。
<C.CPU单元的软件结构>
接着,参照图3说明用于提供本实施方式的各种功能的软件组。在这些软件中包含的命令代码在适当的定时读出,由CPU单元13的微处理器100执行。
图3是表示在本发明的实施方式的CPU单元13中执行的软件结构的示意图。参照图3,作为在CPU单元13中执行的软件,成为实时OS200、系统程序210以及用户程序236的3层。
实时OS200根据CPU单元13的计算机结构而设计,提供用于微处理器100执行系统程序210和用户程序236的基本的执行环境。典型地,由PLC的厂家或者专门的软件公司等提供该实时OS200。
系统程序210是用于提供作为PLC1的功能的软件组。具体地说,系统程序210包括调度器程序212、输出处理程序214、输入处理程序216、时序命令运算程序232、动作运算程序234以及其他的系统程序220。另外,由于一般输出处理程序214和输入处理程序216是连续地(作为一体)执行,所以存在将这些程序统称为IO处理程序218的情况。
用户程序236根据用户的控制目的而生成。即,根据要使用PLC系统SYS而控制的对象的线路(处理)等,任意地设计而成的程序。
如后所述,用户程序236与时序命令运算程序232和动作运算程序234协作而实现用户的控制目的。即,用户程序236通过利用由时序命令运算程序232以及动作运算程序234所提供的命令、函数、功能模块等,实现被编程的动作。因此,也存在将用户程序236、时序命令运算程序232以及动作运算程序234统称为控制程序230的情况。
由此,CPU单元13的微处理器100执行在存储部件中存储的系统程序210以及用户程序236。
以下,进一步详细说明各个程序。
如上所述,用户程序236根据用户的控制目的(例如,对象的线路或处理)而生成。用户程序236典型地成为可在CPU单元13的微处理器100中执行的对象程序形式。通过在PLC支持装置8等中,编译由梯形语言等描述的源程序而生成该用户程序236。然后,生成的对象程序形式的用户程序236从PLC支持装置8经由连接电缆10而传送到CPU单元13,存储在非易失性存储器106等中。
调度器程序212关于输出处理程序214、输入处理程序216以及控制程序230,控制在各个执行循环中的处理开始和处理中断之后的处理再次开始。更具体地说,调度器程序212控制用户程序236以及动作运算程序234的执行。
输出处理程序214将通过用户程序236(控制程序230)的执行而生成的输出数据,再次配置为适合传送到PLC系统总线控制器120和/或现场网络控制器140的形式。在PLC系统总线控制器120和/或现场网络控制器140需要来自微处理器100的、用于执行发送的指示的情况下,输出处理程序214执行这样的指示。
输入处理程序216将由PLC系统总线控制器120和/或现场网络控制器140接收到的输入数据,再次配置为适合控制程序230使用的形式。
时序命令运算程序232是如下程序:在用户程序236中使用的某种时序命令被执行时调用,并用于实现该命令的内容而执行。
动作运算程序234是如下程序:根据用户程序236的指示而执行,并计算对伺服电动机驱动器3或脉冲电动机驱动器这样的电动机驱动器输出的指令值。
其他的系统程序220是将除了图3中分别示出的程序以外的、用于实现PLC1的各种功能的程序组汇总而示出的程序。其他的系统程序220包括设定动作控制循环的周期的程序222。能够根据控制目的而适当设定动作控制循环的周期。设定动作控制循环的周期的程序222设定系统定时器108,使得以从系统定时器108指定的动作控制循环的周期产生中断信号。通过在接通对于CPU单元13的电源时执行用于设定动作控制循环的周期的程序222,从而从非易失性存储器106中读出用于指定动作控制循环的周期的信息,根据所读出的信息而设定系统定时器108。
实时OS200提供用于随着时间的经过而切换多个程序而执行的环境。
<D.动作控制的概略>
接着,说明在上述的用户程序236中包含的典型的结构。用户程序236包括周期性地判断与电动机的运动有关的控制开始的条件是否成立的命令。例如,是用于判断根据电动机的驱动力而进行某种处置的工件(work)是否搬运至规定的处置位置的逻辑。并且,用户程序236还包括以下命令:响应于被判断为该控制开始的条件成立的情况,开始动作控制的命令。随着该动作控制的开始,指示动作命令的执行。于是,与被指示的动作命令对应的动作运算程序234启动,首先,在每次执行动作运算程序234时,执行用于计算对于电动机的指令值所需的初始处理。此外,在与初始处理相同的动作控制循环中,计算在第1循环中的指令值。因此,初始处理和第1个指令值计算处理成为启动的动作运算程序234应在第1个执行中进行的处理。之后,依次计算在各个循环中的指令值。
<E.同步控制的概略>
图4是表示同步控制装置的结构的图。
如图4所示,同步控制装置61包括用户指令值62、调度部63、凸轮曲线生成部64、检测部65、控制部66。这些结构元素通过控制程序230、设定动作控制循环的周期的程序222、以及调度器程序212实现。
调度部63控制控制周期的定时、用户指令部63以及同步处理整体的定时。调度部63在比同步开始时刻早的定时,使从动轴执行追赶主轴的动作(以下,称为追赶动作)。
用户指令部62输入用户指定的同步开始主轴位置SPM、同步开始从动轴位置SPD、齿轮比GR、追赶动作中的目标速度VTD、目标加速度ATD、目标减速度BTD的指令值,并在调度部63的指令定时反映到凸轮曲线生成部64以及控制部66的处理。同步开始主轴位置SPM以及同步开始从动轴位置SPD表示在从动轴和主轴同步的时刻的主轴的位置、从动轴的位置。此外,用户指令部62指示同步控制的开始。
检测部65基于来自主轴用的编码器67和从动轴用的编码器68的脉冲的计数值,检测主轴的位置、从动轴的位置、主轴的速度、从动轴的速度。
凸轮曲线生成部64作为齿轮同步开始时的速度,计算对追赶动作开始时的主轴的速度VM(Ts)乘以齿轮比GR而得的速度。凸轮曲线生成部64使用目标速度VTD、目标加速度ATD、目标减速度BTD、追赶动作开始时的从动轴的速度VD(Ts)以及计算出的齿轮同步开始时的速度,生成如图5所示那样的凸轮曲线。
在本实施方式中,凸轮曲线表示对于时间位移的从动轴的速度。
控制部66在追赶动作时,基于凸轮曲线和主轴的位置信息(具体地说,追赶动作开始之后的移动量),在每个控制周期计算对于从动轴的速度指令值和位置指令值,并输出到从动轴用的伺服电动机驱动器70。控制部66在追赶动作结束后的同步控制时,基于主轴的速度和齿轮比,在每个控制周期计算对于从动轴的速度指令值和位置指令值,并输出到从动轴用的伺服电动机驱动器70。
(同步控制的动作)
图6是表示第一实施方式的同步控制的动作步骤的流程图。
首先,用户指令值62输入由用户指定的同步开始主轴位置SPM、同步开始从动轴位置SPD、齿轮比GR、目标速度VTD、目标加速度ATD、目标减速度BTD的指令值(步骤S101)。
接着,调度部63指示从动轴的追赶动作的开始(步骤S102)。
检测部65在指示了开始的时刻Ts,取得来自主轴用的编码器67的脉冲的计数值(位置)而设为主轴的位置PM(Ts),并根据取得的计数值的时间微分(时间差分)计算主轴的速度VM(Ts)。此外,检测部65在指示了开始的时刻Ts,取得来自从动轴用的编码器68的脉冲的计数值(位置)而设为从动轴的位置PD(Ts),并根据取得的计数值的时间微分(时间差分)计算从动轴的速度VD(Ts)(步骤S 103)。
接着,凸轮曲线生成部64使用目标速度VTD、目标加速度ATD、目标减速度BTD、追赶动作开始时的从动轴的速度VD(Ts)、对追赶动作开始时的主轴的速度VM(Ts)乘以齿轮比GR而得的速度,生成如图5所示的凸轮曲线(速度轮廓)(步骤S104)。
检测部65取得来自主轴用的编码器67的脉冲的计数值(位置)而设为主轴的位置PM(i)。此外,检测部65取得来自从动轴用的编码器68的脉冲的计数值(位置)而设为从动轴的位置PD(i)(步骤S105)。
在不满足检测出的主轴的位置PM(i)与同步开始主轴位置SPM相同且检测出的从动轴的位置PD(i)与同步开始从动轴位置SPD相同的条件的情况下(在步骤S106中“否”),调度部63通过以下的步骤而继续执行追赶动作。
控制部66基于凸轮曲线和追赶动作开始之后的主轴的移动量(PM(i)-PM(Ts)),计算在当前的动作控制周期中的从动轴的速度指令值和位置指令值。具体地说,控制部66在主轴的移动量为P时,作为从动轴的速度指令值而计算在对凸轮曲线进行了积分的值成为P时的从动轴的速度。此外,控制部66对从动轴的速度指令值进行积分,并将积分的值设为从动轴的位置指令值(步骤S107)。
控制部66对从动轴用的伺服电动机驱动器70输出速度指令值和位置指令值(步骤S108)。
调度部63在直到下一个动作控制循环到来为止指示待机。若下一个动作控制循环到来,则增加i(步骤S109)。
另一方面,在满足检测出的主轴的位置PM(i)与同步开始主轴位置SPM相同且检测出的从动轴的位置PD(i)与同步开始从动轴位置SPD相同的条件的情况下(在步骤S106中“是”),调度部63结束追赶动作,并通过以下的步骤而执行齿轮动作。
检测部65取得来自主轴用的编码器67的脉冲的计数值(位置),并根据取得的计数值的时间微分(时间差分),计算主轴的速度VM(i)(步骤S110)。
控制部66通过将检测出的主轴的速度VM(i)和齿轮比GR相乘,从而计算从动轴的速度指令值。此外,控制部66对从动轴的速度指令值进行积分,并将积分的值设为从动轴的位置指令值(步骤S111)。
控制部66对从动轴用的伺服电动机驱动器70输出速度指令值和位置指令值(步骤S112)。
调度部63在直到下一个动作控制循环到来为止指示待机(步骤S113)。
调度部63在齿轮动作结束的结束动作成立之前(在步骤S114中“是”),继续步骤S110~S113的齿轮动作。
如上所述,在本实施方式中,由于在使用了凸轮曲线的同步动作中实现“追赶动作”,在同步开始位置之后,进行使用了齿轮比的同步动作,所以即使在从动轴的“追赶动作”中主轴的速度变化,从动轴的速度也与主轴的速度同步地变化,所以能够在同步开始位置开始同步。保证在“同步开始主轴位置”、“同步开始从动轴位置”中可靠地转移到同步状态(开始齿轮动作)。
【第二实施方式】
在第二实施方式中,说明进一步将用于在主轴的速度从追赶动作时变化时,主轴和从动轴在指定的位置取得同步的方法进行了具体化的方法。
图7是表示第二实施方式的同步控制的动作步骤的流程图。
首先,用户指令值62输入用户指定的同步开始主轴位置SPM、同步开始从动轴位置SPD、齿轮比GR、目标速度VTD、目标加速度ATD、目标减速度BTD的指令值(步骤S101)。
接着,调度部63指示从动轴的追赶动作的开始(步骤S102)。
检测部65在指示了开始的时刻Ts,取得来自主轴用的编码器67的脉冲的计数值(位置)而设为主轴的位置PM(Ts),并根据取得的计数值的时间微分(时间差分)计算主轴的速度VM(Ts)。此外,检测部65在指示了开始的时刻Ts,取得来自从动轴用的编码器68的脉冲的计数值(位置)而设为从动轴的位置PD(Ts),并根据取得的计数值的时间微分(时间差分)计算从动轴的速度VD(Ts)。
控制部66根据同步开始主轴位置SPM和主轴的位置PM(Ts),计算同步开始之前的主轴的移动量SSPM,并根据同步开始从动轴位置SPD和从动轴的位置PD(Ts),计算同步开始之前的从动轴的移动量SSPD。控制部66将从动轴的移动量SSPD除以主轴的移动量SSPM,从而计算移动量比PR。
此外,控制部66根据主轴的速度VM(Ts)和同步开始之前的主轴的移动量SSPM,确定同步开始时刻Te。此外,控制部66维持目标速度VTD的同时将目标加速度ATD和目标减速度BTD的值分别修改为ATD’和BTD’,使得在同步开始时刻Te之前从动轴仅移动移动量SSPD(步骤S203)。
接着,凸轮曲线生成部64使用目标速度VTD、目标加速度ATD’、目标减速度BTD’、追赶动作开始时的从动轴的速度VD(Ts)、对追赶动作开始时的主轴的速度VM(Ts)乘以齿轮比GR而得的速度,生成如图8所示的凸轮曲线(速度轮廓)(步骤S204)。
检测部65取得来自主轴用的编码器67的脉冲的计数值(位置)而设为主轴的位置PM(i)。此外,检测部65取得来自从动轴用的编码器68的脉冲的计数值(位置)而设为从动轴的位置PD(i)(步骤S105)。
在不满足检测出的主轴的位置PM(i)与同步开始主轴位置SPM相同且检测出的从动轴的位置PD(i)与同步开始从动轴位置SPD相同的条件的情况下(在步骤S106中“否”),调度部63通过以下的步骤而继续执行追赶动作。
控制部66基于凸轮曲线和追赶动作开始之后的主轴的移动量P(PM(i)-PM(Ts)),计算在当前的动作控制周期中的从动轴的速度指令值和位置指令值。具体地说,控制部66作为从动轴的速度指令值而计算在对凸轮曲线进行了积分的值成为P×PR时的从动轴的速度。此外,控制部66对从动轴的速度指令值进行积分,并将积分的值设为从动轴的位置指令值(步骤S207)。
控制部66对从动轴用的伺服电动机驱动器70输出速度指令值和位置指令值(步骤S108)。
调度部63在直到下一个动作控制循环到来为止指示待机。若下一个动作控制循环到来,则增加i(步骤S109)。
另一方面,在满足检测出的主轴的位置PM(i)与同步开始主轴位置SPM相同且检测出的从动轴的位置PD(i)与同步开始从动轴位置SPD相同的条件的情况下(在步骤S106中“是”),调度部63结束追赶动作,并通过以下的步骤而执行齿轮动作。
检测部65取得来自主轴用的编码器67的脉冲的计数值(位置),并根据取得的计数值的时间微分(时间差分),计算主轴的速度VM(i)(步骤S110)。
控制部66通过将检测出的主轴的速度VM(i)和齿轮比GR相乘,从而计算从动轴的速度指令值。此外,控制部66对从动轴的速度指令值进行积分,并将积分的值设为从动轴的位置指令值(步骤S111)。
控制部66对从动轴用的伺服电动机驱动器70输出速度指令值和位置指令值(步骤S112)。
调度部63在直到下一个动作控制循环到来为止指示待机(步骤S113)。
调度部63在齿轮动作结束的结束动作成立之前(在步骤S114中“是”),继续步骤S110~S113的齿轮动作。
通过以上的动作,在主轴的速度没有从追赶动作开始时的速度VM(Ts)变化时,在时刻Te中主轴的移动量成为SSPM,从动轴的移动量成为SSPD,从时刻Te之后开始同步。
另一方面,在主轴的速度从追赶动作开始时的速度VM(Ts)往变快的方向变化时,在时刻Te之前的时刻Ta中主轴的移动量成为SSPM,从动轴的移动量成为SSPD,从时刻Ta之后开始同步。
此外,在主轴的速度从追赶动作开始时的速度VM(Ts)往变慢的方向变化时,在时刻Te之后的时刻Tb中主轴的移动量成为SSPM,从动轴的移动量成为SSPD,从时刻Tb之后开始同步。
本发明并不限定于上述的实施方式,例如还包括如下的变形例。
【变形例1】
另外,在本实施方式中,如图所示,凸轮曲线以直线加速、之后成为恒速、之后减速,但并不限定于此。作为凸轮曲线,例如也可以使用一般已知的摆线(cycloid)曲线或Trapecloid曲线等。作为凸轮曲线的文献例,有“CamDesign and Manufacturing Handbook Second Edition(Robert L.Norton著INDUSTRIAL PRESS INC2009)”、“機械技術者のための実用カム機構学”(西岡雅夫著  日刊工業新聞社  2003)等。此外,也可以用多项式来表现凸轮曲线。
【变形例2】
在同步开始从动轴位置存在于主轴的旋转方向的反向的情况下,追赶动作按照上述的凸轮曲线而向主轴的反向动作,在同步开始之后向主轴的旋转方向动作。
【变形例3】
即使在追赶动作中在主轴中产生异常而停止的情况下,或者对主轴输出了停止指令的情况下,从动轴也保持按照上述的凸轮曲线而持续了同步关系的状态。
【变形例4】
在同步开始主轴位置或同步开始从动轴位置超越了位置计数器的一周的情况下,用户也可以指定是否对用户程序发报异常或者多旋转。
例如,在位置计数器为0~360deg的情况下,从用户程序指定了720deg作为同步开始主轴位置的情况下,也可以指定是否对用户程序通知异常还是从2个旋转之后的0deg起开始同步。
【变形例5】
在追赶动作中,在图5中,主轴的速度大幅变化、超过了预先指定的阈值的情况下,也可以在将此时的主轴的速度设为VM(Ts1)时,将同步开始位置中的从动轴的目标速度从VM(Ts)×GR变化为VM(Ts1)×GR,并重新计算凸轮曲线。
应认为本次公开的实施方式在所有方面都是例示,并不是限制性的。本发明的范围并非由上述的说明所表示,而是由权利要求书所表示,意图包括与权利要求书的范围等同的含义和范围内的全部变更。

Claims (2)

1.一种同步控制装置,在每个控制周期执行主轴和从动轴的同步控制,其中,所述同步控制装置包括:
指定部,指定主轴和从动轴开始同步的同步开始位置;
凸轮曲线生成部,生成凸轮曲线;
检测部,检测每个控制周期的所述主轴的位置信息;以及
控制部,在所述同步开始位置之前,基于所述凸轮曲线和所述主轴的位置信息,在每个控制周期计算对于从动轴的速度指令值,在所述同步开始位置之后,基于主轴和从动轴的齿轮比,在每个控制周期计算对于从动轴的速度指令值,
所述控制部以计算出的所述速度指令值来控制所述从动轴,
所述检测部进一步在每个控制周期取得从动轴的位置信息,
所述控制部进一步在每个控制周期,基于所述主轴的位置信息和所述从动轴的位置信息,维持所述目标速度的同时将所述目标加速度和目标减速度修改为维持在主轴和从动轴开始同步的同步开始位置,
所述凸轮曲线生成部进一步在每个控制周期,基于通过控制部而修改的所述目标加速度和目标减速度,生成所述凸轮曲线。
2.一种同步控制方法,在每个控制周期执行主轴和从动轴的同步控制,其中,所述同步控制方法包括:
指定步骤,指定主轴和从动轴开始同步的同步开始位置;
凸轮曲线生成步骤,生成凸轮曲线;
检测步骤,检测每个控制周期的所述主轴的位置信息;
控制步骤,在所述同步开始位置之前,基于所述凸轮曲线和所述主轴的位置信息,在每个控制周期计算对于从动轴的速度指令值,在所述同步开始位置之后,基于主轴和从动轴的齿轮比,在每个控制周期计算对于从动轴的速度指令值;以及
以计算出的所述速度指令值来控制所述从动轴的步骤,
在所述检测步骤中,进一步在每个控制周期取得从动轴的位置信息,
在所述控制步骤中,进一步在每个控制周期,基于所述主轴的位置信息和所述从动轴的位置信息,维持所述目标速度的同时将所述目标加速度和目标减速度修改为维持在主轴和从动轴开始同步的同步开始位置,
在所述凸轮曲线生成步骤中,进一步在每个控制周期,基于通过控制步骤而修改的所述目标加速度和目标减速度,生成所述凸轮曲线。
CN201210148360.7A 2011-06-28 2012-05-14 同步控制装置、同步控制方法 Active CN102854901B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2011142764A JP5803337B2 (ja) 2011-06-28 2011-06-28 同期制御装置、同期制御方法、同期制御プログラム、および同期制御プログラムを記録したコンピュータ読み取り可能な記録媒体
JP2011-142764 2011-06-28

Publications (2)

Publication Number Publication Date
CN102854901A CN102854901A (zh) 2013-01-02
CN102854901B true CN102854901B (zh) 2015-02-11

Family

ID=46062163

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210148360.7A Active CN102854901B (zh) 2011-06-28 2012-05-14 同步控制装置、同步控制方法

Country Status (4)

Country Link
US (1) US20130002185A1 (zh)
EP (1) EP2541350A3 (zh)
JP (1) JP5803337B2 (zh)
CN (1) CN102854901B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106706255A (zh) * 2016-11-24 2017-05-24 中国空气动力研究与发展中心高速空气动力研究所 一种多自由度试验机构联动频率相位同步控制方法

Families Citing this family (29)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011132411A1 (ja) * 2010-04-22 2011-10-27 日本電気株式会社 モータ制御装置、モータ制御方法、モータシステム及びコンピュータ可読媒体
US20140148940A1 (en) * 2012-11-29 2014-05-29 Thermwood Corporation System for Remotely Deactivating the Operation of a Machine
JP6038189B2 (ja) * 2013-02-01 2016-12-07 三菱電機株式会社 同期制御装置
EP2887165A1 (en) 2013-12-20 2015-06-24 Omron Corporation Computation unit, output control method, and program
JP2015170310A (ja) * 2014-03-10 2015-09-28 ファナック株式会社 準備動作を含む同期制御装置
JP5873140B2 (ja) 2014-06-25 2016-03-01 ファナック株式会社 同期制御装置
WO2016002076A1 (ja) * 2014-07-04 2016-01-07 三菱電機株式会社 位置決め制御装置の同期制御設定方法
CN105938324B (zh) * 2015-03-04 2019-07-16 欧姆龙株式会社 控制装置及同步控制方法
US10268183B2 (en) * 2015-03-04 2019-04-23 Omron Corporation Control device and method of synchronizing control
JP6333782B2 (ja) 2015-08-03 2018-05-30 ファナック株式会社 同期開始ブロックのショックを解消する機能を有する同期制御装置
CN105182942B (zh) * 2015-09-25 2017-12-08 汕头市东方科技有限公司 一种基于伺服的主从位置同步控制系统及方法
JP6400553B2 (ja) 2015-09-28 2018-10-03 ファナック株式会社 ユニット間での同期制御機能を有する数値制御システム
KR102079499B1 (ko) 2015-10-20 2020-02-21 엘에스산전 주식회사 Plc 위치 결정 시스템의 축별 제어주기 독립 할당 방법
JP6594813B2 (ja) * 2016-03-24 2019-10-23 株式会社神戸製鋼所 通信制御システム及び通信制御方法
JP6930150B2 (ja) * 2017-03-14 2021-09-01 オムロン株式会社 制御装置、制御プログラムおよび制御システム
JP6954192B2 (ja) * 2018-03-12 2021-10-27 オムロン株式会社 制御装置、制御方法、およびプログラム
CN108490886A (zh) * 2018-03-22 2018-09-04 南京工业大学 一种针对主轴部分区域与工作台位置跟随的实现方法
JP6806737B2 (ja) * 2018-06-15 2021-01-06 ファナック株式会社 同期装置、同期方法及び同期プログラム
JP7040328B2 (ja) * 2018-07-11 2022-03-23 オムロン株式会社 制御装置、および制御方法
JP7124696B2 (ja) * 2018-12-27 2022-08-24 オムロン株式会社 同期制御装置、同期制御システム、同期制御方法及びシミュレーション装置
JP7127594B2 (ja) * 2019-03-29 2022-08-30 オムロン株式会社 制御装置
JP6943268B2 (ja) 2019-03-29 2021-09-29 オムロン株式会社 制御装置
JP6729746B2 (ja) * 2019-04-08 2020-07-22 オムロン株式会社 制御装置
CN113468680B (zh) * 2020-03-30 2023-01-03 沈机(上海)智能系统研发设计有限公司 从轴耦合到凸轮曲线的平滑切入方法、系统、介质及终端
CN111897291A (zh) * 2020-07-08 2020-11-06 浙江大华技术股份有限公司 多轴联动控制方法和装置、存储介质及电子装置
CN111830909A (zh) * 2020-07-15 2020-10-27 珠海格力智能装备有限公司 同步控制方法及装置
CN113655754A (zh) * 2021-06-30 2021-11-16 薛智夫 AI自然语言描述到Python代码翻译系统及方法
CN113625657B (zh) * 2021-08-18 2022-12-16 深圳市英威腾电气股份有限公司 一种基于电子凸轮曲线的运动控制方法及装置
CN117850329A (zh) * 2022-05-17 2024-04-09 南京昇榕智能科技有限公司 一种plc系统、plc数据传输方法及装置

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5267142A (en) * 1989-04-26 1993-11-30 Fanuc Ltd. Method for phase-synchronized spindle rotation control
US5463296A (en) * 1993-06-30 1995-10-31 Allen-Bradley Company, Inc. Motion controller with remote linking
US6084372A (en) * 1998-12-29 2000-07-04 Schneider Automation Inc. Electronic gearing from/to non-zero follower motion with phase adjust
EP1221640A2 (en) * 2000-12-28 2002-07-10 Fanuc Ltd Method of and apparatus for synchronous control

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3453554B2 (ja) * 2000-10-13 2003-10-06 ファナック株式会社 加減速方法
JP4003792B2 (ja) * 2004-11-17 2007-11-07 オムロン株式会社 サーボモータ制御システム
JP4576260B2 (ja) * 2005-02-21 2010-11-04 株式会社日立産機システム モータ制御装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5267142A (en) * 1989-04-26 1993-11-30 Fanuc Ltd. Method for phase-synchronized spindle rotation control
US5463296A (en) * 1993-06-30 1995-10-31 Allen-Bradley Company, Inc. Motion controller with remote linking
US6084372A (en) * 1998-12-29 2000-07-04 Schneider Automation Inc. Electronic gearing from/to non-zero follower motion with phase adjust
EP1221640A2 (en) * 2000-12-28 2002-07-10 Fanuc Ltd Method of and apparatus for synchronous control

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
SIMOTION CamTool Configuration Manual;西门子公司;《西门子操作手册》;20070801;第34页 *
simotion同步运行功能介绍;西门子公司;《西门子操作手册》;20091230;第4页,第7页,第11页,第23页,第36页,第39-44页 *
simotion在数字化对接系统中的多轴同步控制应用;张杨等;《机电控制》;20101230(第23期);全文 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106706255A (zh) * 2016-11-24 2017-05-24 中国空气动力研究与发展中心高速空气动力研究所 一种多自由度试验机构联动频率相位同步控制方法
CN106706255B (zh) * 2016-11-24 2019-07-12 中国空气动力研究与发展中心高速空气动力研究所 一种多自由度试验机构联动频率相位同步控制方法

Also Published As

Publication number Publication date
EP2541350A2 (en) 2013-01-02
US20130002185A1 (en) 2013-01-03
EP2541350A3 (en) 2014-01-22
JP5803337B2 (ja) 2015-11-04
JP2013011937A (ja) 2013-01-17
CN102854901A (zh) 2013-01-02

Similar Documents

Publication Publication Date Title
CN102854901B (zh) 同步控制装置、同步控制方法
EP2687927B1 (en) Cpu of plc, system program for plc, and recording medium storing system program for plc
EP2680095B1 (en) Computation unit, assistance device, output control method, display control method, and program
JP4877423B1 (ja) Plcのcpuユニット、plc用システムプログラムおよびplc用システムプログラムを格納した記録媒体
CN103403630B (zh) 运算单元、输出控制方法和程序
CN102914992B (zh) 同步控制装置
EP2515189B1 (en) Plc cpu unit, system program for plc, and storage medium having system program for plc stored therein
JP2010198600A (ja) 産業用コントローラ
CN103076780A (zh) 基于工业以太网总线的绝对式光栅控制系统及控制方法
JP5402401B2 (ja) モーションコントロールシステム
US7541767B2 (en) Decentralized error response in cam disk axes
JP6881174B2 (ja) 制御装置および制御方法
WO2012124145A1 (ja) 演算ユニット、支援装置、支援プログラム、支援プログラムを格納した記憶媒体、および、支援装置における動作方法
JP7040328B2 (ja) 制御装置、および制御方法
CN203287747U (zh) 基于工业以太网总线的绝对式光栅控制系统
Gu et al. Control system design of 6-DOFs serial manipulator based on real-time ethernet
CN113661464A (zh) 多轴控制系统、多轴控制方法及多轴控制程序
JP4385404B2 (ja) モータ駆動装置、およびモータ駆動装置の非常停止方法
Schoeberlein et al. Data Management System for Drive-based Smart Data Services
JP2008005587A (ja) 電動機駆動装置及び電動機駆動システム
JP6506155B2 (ja) 制御装置
CN113485229A (zh) 一种基于Siemens控制模块的控制系统
CN101995851A (zh) 控制马达的装置及其方法
CN107971746A (zh) 发动机装配线

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant