CN102414635A - 指令生成装置 - Google Patents

指令生成装置 Download PDF

Info

Publication number
CN102414635A
CN102414635A CN2010800187022A CN201080018702A CN102414635A CN 102414635 A CN102414635 A CN 102414635A CN 2010800187022 A CN2010800187022 A CN 2010800187022A CN 201080018702 A CN201080018702 A CN 201080018702A CN 102414635 A CN102414635 A CN 102414635A
Authority
CN
China
Prior art keywords
acceleration
deceleration
interval
operational part
stop distance
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
CN2010800187022A
Other languages
English (en)
Other versions
CN102414635B (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.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric 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 Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Publication of CN102414635A publication Critical patent/CN102414635A/zh
Application granted granted Critical
Publication of CN102414635B publication Critical patent/CN102414635B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00—Control of position or direction
    • G05D3/12—Control of position or direction using feedback
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B66—HOISTING; LIFTING; HAULING
    • B66B—ELEVATORS; ESCALATORS OR MOVING WALKWAYS
    • B66B1/00—Control systems of elevators in general
    • B66B1/24—Control systems with regulation, i.e. with retroactive action, for influencing travelling speed, acceleration, or deceleration
    • B66B1/28—Control systems with regulation, i.e. with retroactive action, for influencing travelling speed, acceleration, or deceleration electrical
    • B66B1/30—Control systems with regulation, i.e. with retroactive action, for influencing travelling speed, acceleration, or deceleration electrical effective on driving gear, e.g. acting on power electronics, on inverter or rectifier controlled motor
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B66—HOISTING; LIFTING; HAULING
    • B66B—ELEVATORS; ESCALATORS OR MOVING WALKWAYS
    • B66B1/00—Control systems of elevators in general
    • B66B1/24—Control systems with regulation, i.e. with retroactive action, for influencing travelling speed, acceleration, or deceleration
    • B66B1/28—Control systems with regulation, i.e. with retroactive action, for influencing travelling speed, acceleration, or deceleration electrical
    • B66B1/285—Control systems with regulation, i.e. with retroactive action, for influencing travelling speed, acceleration, or deceleration electrical with the use of a speed pattern generator
    • 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/416—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 control of velocity, acceleration or deceleration
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D13/00—Control of linear speed; Control of angular speed; Control of acceleration or deceleration, e.g. of a prime mover
    • G05D13/62—Control of linear speed; Control of angular speed; Control of acceleration or deceleration, e.g. of a prime mover characterised by the use of electric means, e.g. use of a tachometric dynamo, use of a transducer converting an electric value into a displacement

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Numerical Control (AREA)
  • Control Of Position Or Direction (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)
  • Elevator Control (AREA)

Abstract

加加减速区间参数设定部(2)将加速度指令曲线的加减速区间分割成加速度增加区间、等加速度区间以及加速度减少区间，相互独立地设定各区间的时间的长度，加加减速区间三角函数指令生成部(1)通过使用根据1/2周期量的三角函数生成的加速度指令曲线来生成位置指令或者速度指令。

Description

指令生成装置
技术领域
本发明涉及指令生成装置，特别涉及生成安装机、半导体制造装置、射出成形机、机器人、工作机械、包装机械、印刷机械等机械***的位置指令或者速度指令的指令生成装置。
背景技术
在以往的指令生成装置中，为了抑制由于阶段性的加速引起的高频振荡激励来实现稳定时间的缩短化，有如下方法：将加减速区间分别分成加速度增加区间、等加速度区间、加速度减少区间这3区间，并将加速度增加区间、加速度减少区间的位置指令分别设成7次函数，以使加加速度(还称为加速度的时间变化率：jerk)连续变化的方式决定7次函数的各系数(专利文献1)。
专利文献1：日本特开2000-40658号公报
发明内容
但是，根据上述以往的技术，为了生成位置指令，使用了7次函数。因此，在从当前位置以及当前速度起减速停止时，对停止距离与剩余距离进行比较，在停止距离成为剩余距离以上的时刻开始进行了减速的情况下，存在用于减速开始判定所需的计算量多的问题。另外，在时时刻刻设定位置指令的情况下，也需要7次函数的计算，存在计算量多这样的问题。
本发明是鉴于上述情况而完成的，其目的在于得到一种指令生成装置，可以抑制指令生成所需的计算量的增大，并且可以独立地设定加加速度区间，并且可以连续地设定加加速度。
为了解决上述课题，并达到目的，本发明的指令生成装置的特征在于，具备加加减速区间三角函数指令生成部，该加加减速区间三角函数指令生成部通过使用根据1/2周期量的三角函数生成的加速度指令曲线来生成位置指令或者速度指令。
根据本发明，起到如下效果：可以抑制指令生成所需的计算量的增大，并且可以独立地设定加加速度区间，并且可以连续地设定加加速度。
附图说明
图1是示出本发明的指令生成装置的实施方式1的概略结构的框图。
图2是示出由图1的加加减速区间三角函数指令生成部1生成的加速度指令曲线的一个例子的图。
图3是示出本发明的指令生成装置的实施方式2的概略结构的框图。
图4是示出本发明的指令生成装置的实施方式3的概略结构的框图。
(符号说明)
1、21：加加减速区间三角函数指令生成部；2：加加减速区间参数设定部；3：基准减速停止距离运算部；4：差距离运算部；5、15：校正系数运算部；6、16、26：减速停止距离运算部；7：减速开始判别部；9：加速区间剩余距离剩余速度运算部。
具体实施方式
以下，根据附图，详细说明本发明的指令生成装置的实施方式。另外，本发明不限于该实施方式。
实施方式1.
图1是示出本发明的指令生成装置的实施方式1的概略结构的框图。在图1中，在指令生成装置中，设置了加加减速区间三角函数指令生成部1、加加减速区间参数设定部2、基准减速停止距离运算部3、差距离运算部4、校正系数运算部5、减速停止距离运算部6以及减速开始判别部7。
此处，加加减速区间三角函数指令生成部1可以参照根据1/2周期量的三角函数生成的加速度指令曲线，根据预先设定的最大加速度以及最高速度、和针对每个动作提供的移动距离或者动作开始点和动作结束点，生成每个控制周期(指令值生成周期)的位置指令ps或者速度指令vs。另外，加加减速区间三角函数指令生成部1在对控制对象的机械***进行位置控制的情况下可以生成位置指令ps或者位置指令ps和速度指令vs这两方，在对控制对象的机械***进行速度控制的情况下可以生成速度指令vs。
加加减速区间参数设定部2可以独立地设定加速区间的加速度增加区间和加速度减少区间以及减速区间的加速度增加区间和加速度减少区间的时间的长度，并输出到加加减速区间三角函数指令生成部1。
基准减速停止距离运算部3按照速度指令为速度梯形图案(加减速区间的加速度为恒定的指令)的位置指令或者速度指令运算从当前的速度起减速停止时的从当前地点到减速停止的地点的距离作为基准减速停止距离L0。
差距离运算部4可以计算和其动作的目标位置或者该动作中的移动距离(由使机械***动作的程序指定的目标位置)Pend与当前的位置指令Pnow的差分对应的差距离Ls＝Pend-Pnow。
校正系数运算部5可以根据与加加减速区间的时间长度相关的参数，针对控制对象的每个动作，计算校正系数Pg。
减速停止距离运算部6可以根据由基准减速停止距离运算部3计算出的基准减速停止距离L0和由校正系数运算部5计算出的校正系数Pg，计算与从当前速度起减速停止为止的移动距离对应的减速停止距离Lg。例如，可以通过减速停止距离Lg＝Pg*L0提供。
减速开始判别部7可以针对每个指令生成周期对由减速停止距离运算部6计算出的减速停止距离Lg与由差距离运算部4计算出的差距离Ls进行比较。然后，可以在满足了Lg≥Ls这样的条件的指令生成周期中，将开始进行减速的减速开始指令Is输出到加加减速区间三角函数指令生成部1。
图2是示出由图1的加加减速区间三角函数指令生成部1生成的加速度指令曲线的一个例子的图。在图2中，在加速度指令曲线中，包括加速区间A、等速区间B、减速区间C。而且，当位置指令、速度指令都以加速度指令观察时，加速区间A、减速区间C分别被分割成加速度增加区间K1、K7、等加速度区间K2、K6、加速度减少区间K3、K5这3个区间，如果把等速区间B加在一起，则在1个动作中分成7个区间K1～K7来生成指令。
另外，以使合计存在4个区间的加速度增加区间K1、K7、加速度减少区间K3、K5的加速度指令成为半周期(1/2周期)的三角函数(也可以对三角函数乘以常数并相加偏置)的方式，生成指令。此处，也可以在4个区间K1、K3、K5、K7中单独地设定三角函数的周期。
另外，加速度增加区间K1、K7、等加速度区间K2、K6、加速度减少区间K3、K5的时间的长度是从加加减速区间参数设定部2提供的。将加速度增加区间K1、K7、等加速度区间K2、K6、加速度减少区间K3、K5的时间长度分别设成at、dt、et、ft、bt、ct(这些都从加加减速区间参数设定部2提供)。另外，将加速区间A以及减速区间C中的加速度最大值分别设成aks、ags。此时，从动作开始起t秒后的位置位置指令ps(t)、速度指令vs(t)如下所述生成。
即，直至等速度区间K4，可以通过下式(1)至式(10)提供。
·t≤at时(加速度增加区间K1时)
x＝π*t/at-π/2…(1)
vs(t)＝aks*t/2-aks*at*cos(x)/2/π…(2)
ps(t)＝aks*t*t/4-at*at*aks*(sin(x)+1)/2/π/π…(3)
·at＜t≤kt2时(等加速度区间K2时：kt2＝at+et)
vs(t)＝v1+aks*(t-at)…(4)
ps(t)＝p1+v1*(t-at)+aks*(t-at)*(t-at)/2…(5)
·kt2＜t≤kt2+bt时(加速度减少区间K3时)
x＝π*(t-kt2)/bt-π/2…(6)
vs(t)＝v2+aks*(t-kt2)/2+aks*bt*cos(x)/2/π…(7)
ps(t)＝p2+v2*(t-kt2)+aks*(t-kt2)*(t-kt2)/4+aks*bt*bt*(sin(x)+1)/2/π/π…(8)
·kt2+bt＜t时(直至减速开始，等速度区间K4)
vs(t)＝vs    …(9)
ps(t)＝p3+vs*(t-kt2-bt)…(10)
其中，p1、v1、p2、v2、p3可以分别通过下式(11)至式(15)来提供。
p1＝aks*at*at/4-at*at*aks/π/π…(11)
v1＝aks*at/2…(12)
p2＝p1+v1*(kt2-at)+aks*(kt2-at)*(kt2-at)/2…(13)
v2＝1+aks*(kt2-at)…(14)
p3＝p2+v2*bt+aks*bt*bt/4+bt*bt*aks/π/π…(15)
如果将从减速开始判别部7输入了减速开始指令Is的时刻设成tgs，则从时刻tgs，从加速度减少区间K5起，生成位置指令ps或者速度指令vs。另外，如果将时刻tgs的速度指令设成vgs、将位置指令设成pgs，则从加速度减少区间K5起，可以通过下式(16)至式(23)来提供每个指令生成周期的指令。
·tgs＜t≤tgs+ct时(加速度减少区间K5时)
如果设成t2＝t-tgs，则
x＝π*t2/ct-π/2…(16)
vs(t)＝vgs-ags*t2/2+ags*ct*cos(x)/2/π…(17)
ps(t)＝pgs+vgs*t2-ags*t2*t2/4
+ct*ct*ags*(sin(x)+1)/2/π/π…(18)
·tgs+ct＜t≤tgs+ct+ft时(等加速度区间K6时)
如果设成t2＝t-tgs-ct，则
vs(t)＝v1g-ags*t2…(19)
ps(t)＝p1g+v1g*t2-ags*t2*t2/2…(20)
·tgs+gt2＜t≤tgs+gt2+dt时(加速度增加区间K7时：gt2＝ct+ft)
如果设成t2＝t-tgs-gt2，则
x＝π*t2/dt-π/2…(21)
vs(t)＝v2g-ags*t2/2-ags*dt*cos(x)/2/π…(22)
ps(t)＝p2g+v2g*t2-ags*t2*t2/4ags*dt*dt*(sin(x)+1)/2/π/π…(23)
t＞tgs+gt2+dt时，将加速度指令以及速度指令都设为0，将位置指令设成目标位置。
其中，可以通过下式(24)至式(27)分别提供p1g、v1g、p2g、v2g。
p1g＝pgs+vgs*ct-ags*ct*ct/4+ct*ct*ags/π/π…(24)
v1g＝vgs-ags*ct/2…(25)
p2g＝p1g+v1g*(gt2-ct)
-ags*(gt2-ct)*(gt2-ct)/2…(26)
v2g＝v1g-ags*(gt2-ct)…(27)
以下，说明指令生成装置的动作。在加加减速区间参数设定部2中，分别设定加速度增加区间K1、K7、等加速度区间K2、K6以及加速度减少区间K3、K5的时间长度at、et、bt、ct、ft、dt，并输出到加加减速区间三角函数指令生成部1。另外，还分别设定加速区间A以及减速区间C的加速度最大值aks、ags，并输出到加加减速区间三角函数指令生成部1。
另外，在直接指定了加速度增加区间K1、K7、等加速度区间K2、K6以及加速度减少区间K3、K5的时间长度at、et、bt、ct、ft、dt的情况下，所指定的值原样地输出到加加减速区间三角函数指令生成部1。
另外，当速度指令是按照加速度恒定的速度指令(或者被称为位置指令、速度梯形图案)生成，并通过将加速区间A以及减速区间C的加速度最大值分别设成aks、ags时的相对加速时间kt和减速时间gt的比例rat、ret、rbt、rct、rft、rdt提供的情况下，通过下式(28)至式(33)，计算加速度增加区间K1、K7、等加速度区间K2、K6以及加速度减少区间K3、K5的时间长度at、et、bt、ct、ft、dt，输出到加加减速区间三角函数指令生成部1。另外，相对加速时间kt和减速时间gt的比例rat、ret、rbt、rct、rft、rdt输出到校正系数运算部5。
at＝rat*kt    …(28)
et＝ret*kt    …(29)
bt＝rbt*kt    …(30)
ct＝rct*gt    …(31)
ft＝rft*gt    …(32)
dt＝rdt*gt    …(33)
此处，在直接指定了时间长度at、et、bt、ct、ft、dt的情况下，可以根据下式(34)至式(39)计算相对加速时间kt和减速时间gt的比例rat、ret、rbt、rct、rft、rdt。
rat＝at/kt    …(34)
ret＝et/kt    …(35)
rbt＝bt/kt    …(36)
rct＝ct/gt    …(37)
rft＝ft/gt    …(38)
rdt＝dt/gt    …(39)
另外，加速区间A以及减速区间C的加速度最大值aks、ags既可以读入针对每个指令生成装置制定的参数，也可以读入使指令生成装置动作的程序中的设定值。另外，在程序中没有设定加速区间A以及减速区间C的加速度最大值aks、ags的情况下，也可以使用针对每个指令生成装置预先设定的值。
此处，如果将在程序中设定的控制对象的动作的最高速度设成vmax，则可以通过下式(40)以及式(41)分别计算加速时间kt和减速时间gt。
kt＝vmax/aks    …(40)
gt＝vmax/ags    …(41)
另外，可以独立地设定时间长度at、bt、ct、dt或者相对加速时间kt和减速时间gt的比例rat、rbt、rct、rdt。
然后，如果加速度增加区间K1、K7、等加速度区间K2、K6以及加速度减少区间K3、K5的时间长度at、et、bt、ct、ft、dt输出到加加减速区间三角函数指令生成部1，则根据1/2周期量的三角函数，由加加减速区间三角函数指令生成部1生成加速度指令曲线。然后，如果控制对象的动作的目标位置或者该动作中的移动距离Pend提供到加加减速区间三角函数指令生成部1，则按照该加速度指令曲线，针对每个指令生成周期，生成位置指令ps以及速度指令vs中的某一方或者两方，输出到基准减速停止距离运算部3以及差距离运算部4。
另外，在从加加减速区间三角函数指令生成部1输出位置指令ps时，针对每个指令生成周期输出ps(t)，在从加加减速区间三角函数指令生成部1输出速度指令vs时，针对每个指令生成周期输出vs(t)，在从加加减速区间三角函数指令生成部1输出位置指令ps和速度指令vs这两方时，输出ps(t)和vs(t)。
此处，通过半周期的三角函数表现了加加减速区间的加速度指令，所以加加减速区间的速度指令vs(t)可以通过三角函数和时间t的1次式来表现，位置指令ps(t)可以通过三角函数和时间t的2次式来表现。
接下来，如果位置指令ps以及速度指令vs中的某一方或者两方输入到基准减速停止距离运算部3，则将当前的速度指令vs(t)的值设成vn，计算从vn起以加速度恒定的加速度最大值ags减速时的从当前地点到停止位置的距离L0，输出到减速停止距离运算部6。另外，由于从当前地点到停止位置的距离L0是以加速度恒定的加速度最大值ags从速度vn起减速停止时的移动距离，所以可以通过下式(42)提供。
L0＝vn*vn/ags/2…(42)
另外，如果位置指令ps以及速度指令vs中的某一方或者两方输入到差距离运算部4，则计算和控制对象的动作的目标位置或者该动作中的移动量Pend与当前的位置指令Pnow的差分对应的差距离Ls＝Pend-Pnow，输出到减速开始判别部7。其中，设成Pnow＝ps(t)。
另外，如果相对加速时间kt和减速时间gt的比例rat、ret、rbt、rct、rft、rdt从加加减速区间参数设定部2输入到校正系数运算部5，则计算对由减速停止距离运算部6计算出的减速停止距离Lg进行校正的校正系数Pg，输出到减速停止距离运算部6。另外，可以根据加速度恒定地减速停止时的移动距离与通过加加减速区间三角函数指令减速停止时的移动距离之比，计算校正系数Pg，可以通过下式(43)提供。
Pg＝(1+rct)+2*(1/8-1/π/π)*(rdt*rdt-rct*rct)…(43)
另外，相对加速时间kt和减速时间gt的比例rct、rdt在控制对象的动作中是恒定，所以式(43)的运算在各动作的动作开始时只进行1次即可，而无需针对每个指令生成周期进行。
接下来，如果由基准减速停止距离运算部3计算出的基准减速停止距离L0输入到减速停止距离运算部6，并且由校正系数运算部5计算出的校正系数Pg输入到减速停止距离运算部6，则针对每个指令生成周期，计算通过加加减速区间三角函数指令减速停止时的减速停止距离Lg＝Pg*L0，输出到减速开始判别部7。
接下来，如果由差距离运算部4计算出的差距离Ls输入到减速开始判别部7，并且由减速停止距离运算部6计算出的减速停止距离Lg输入到减速开始判别部7，则针对每个指令生成周期，比较减速停止距离Lg和差距离Ls。然后，在动作开始后初次满足Lg≥Ls这样的条件时，在其指令生成周期，向加加减速区间三角函数指令生成部1输出减速开始指令Is。然后，如果减速开始指令Is输入到加加减速区间三角函数指令生成部1，则由加加减速区间三角函数指令生成部1生成的位置指令ps或者速度指令vs进入图2的加速度减少区间K5，按照式(16)至式(23)依次生成位置指令ps或者速度指令vs。
如以上的说明，根据实施方式1，可以在4个部位独立地设定加加减速区间长度，并且可以根据1/2周期量的三角函数生成加速度指令曲线，可以抑制计算量的增大，并且可以连续地设定加加速度。另外，通过对加速度恒定地停止时的基准减速停止距离L0乘以校正系数Pg，可以计算从当前的位置以及速度起减速停止时的减速停止距离Lg，可以减少用于判别减速开始所需的计算量。进而，在加加减速区间的始点以及终点处，加加速度成为0，所以可以在动作区间整个域(加速度增加区间K1、K7、等加速度区间K2、K4、K6、加速度减少区间K3、K5)中始终使加加速度连续，可以使机械***的控制对象平滑地动作。
实施方式2.
图3是示出本发明的指令生成装置的实施方式2的概略结构的框图。在图3中，在该指令生成装置中，代替图1的基准减速停止距离运算部3、校正系数运算部5以及减速停止距离运算部6，而设置了校正系数运算部15以及减速停止距离运算部16。
此处，校正系数运算部15可以根据与加加减速区间的时间长度相关的参数以及减速区间的加速度最大值，针对控制对象的每个动作计算校正系数Pg2。
减速停止距离运算部16可以根据由加加减速区间三角函数指令生成部1生成的位置指令ps或者速度指令vs、和由校正系数运算部15计算出的校正系数Pg2，计算与从当前速度起减速停止为止的移动距离对应的减速停止距离Lg2。
然后，如果相对加速时间kt和减速时间gt的比例rat、ret、rbt、rct、rft、rdt从加加减速区间参数设定部2输入到校正系数运算部15，则计算对由减速停止距离运算部16计算出的减速停止距离Lg2进行校正的校正系数Pg2，输出到减速停止距离运算部16。另外，可以根据相对速时间kt和减速时间gt的比例rat、rbt、rct、rdt和减速区间的加速度最大值ags，通过下式(44)提供校正系数Pg2。
Pg2＝((1+rct)/2+(1/8-1/π/π)*(rdt*rdt-rct*rct))/ags    …(44)
接下来，如果由加加减速区间三角函数指令生成部1生成的位置指令ps或者速度指令vs输入到减速停止距离运算部16，并且由校正系数运算部15计算出的校正系数Pg2输入到减速停止距离运算部16，则针对每个指令生成周期，计算通过加加减速区间三角函数指令减速停止时的减速停止距离Lg2，输出到减速开始判别部7。另外，可以根据由校正系数运算部15计算出的校正系数Pg2和当前的速度指令vn＝vs(t)，通过下式(45)提供减速停止距离Lg2。
Lg＝Pg2*vn*vn    …(45)
如以上的说明，根据实施方式2，可以在4个部位独立地设定加加减速区间长度，并且可以根据1/2周期量的三角函数生成加速度指令曲线，可以抑制计算量的增大，并且可以连续地设定加加速度。另外，通过对当前速度的平方乘以常数，可以计算从当前的位置以及速度起减速停止时的减速停止距离Lg2，可以减少用于判别减速开始所需的计算量。进而，在加加减速区间的始点以及终点处，加加速度成为0，所以可以在动作区间整个域(加速度增加区间K1、K7、等加速度区间K2、K4、K6、加速度减少区间K3、K5)中使加加速度始终连续，可以使机械***的控制对象平滑地动作。
实施方式3.
图4是示出本发明的指令生成装置的实施方式3的概略结构的框图。在图4中，在该指令生成装置中，代替图3的加加减速区间三角函数指令生成部1以及减速停止距离运算部16，而设置了加加减速区间三角函数指令生成部21以及减速停止距离运算部26以及加速区间剩余距离剩余速度运算部9。
此处，加速区间剩余距离剩余速度运算部9在处于图2的加速区间A的加速度增加区间K1或者等速区间B的情况下，根据当前的位置指令、速度指令以及加速度指令新生成加速度减少曲线而使加速度成为0的情况下，可以根据与直至加速度成为0为止的速度增加量对应的加速区间剩余速度vz、和与直至加速度成为0为止的移动量对应的加速区间剩余距离Pb，将使加速度的减少开始的加速度减少开始指令输出到加加减速区间三角函数指令生成部21。
减速停止距离运算部26可以根据由加速区间剩余距离剩余速度运算部9生成的加速区间剩余速度vz以及加速区间剩余距离Pb、和由校正系数运算部15计算出的校正系数Pg2，计算与从当前速度起减速停止为止的移动距离对应的减速停止距离Lg4。
加加减速区间三角函数指令生成部21可以参照根据1/2周期量的三角函数生成的加速度指令曲线，根据预先设定的最大加速度以及最高速度、和针对每个动作提供的移动距离或者动作开始点以及动作结束点，生成每个控制周期(指令值生成周期)的位置指令ps或者速度指令vs。另外，加加减速区间三角函数指令生成部21可以根据从减速开始判别部7输出的减速开始指令Is，开始减速，并且根据从加速区间剩余距离剩余速度运算部9输出的加速度减少开始指令Ia，开始进行加速度的减速。
然后，如果位置指令ps或者速度指令vs输入到加速区间剩余距离剩余速度运算部9，则判断是否处于加速区间A的加速度增加区间K1或者等速区间B。然后，在处于加速区间A的加速度增加区间K1或者等速区间B的情况下，根据当前的位置指令、速度指令、加速度指令新生成加速度减少曲线而使加速度成为0的情况下，计算直至加速度成为0为止的速度增加量(加速区间剩余速度)vz以及直至加速度成为0为止的移动量(加速区间剩余距离)Pb。
具体而言，可以通过使用当前的加速度指令an、加速度减少区间K3的比例rbt、最高速度vmax、加速度最大值aks，根据下式(46)至式(48)计算加速区间剩余速度vz以及加速区间剩余距离Pb。
vz＝an*an*rbt*vs/aks/aks    …(46)
bbt＝an*rbt*kt/aks    …(47)
Pb＝vn*bbt+an*bbt2*(1/4+1/π2)…(48)
另外，当前的加速度指令an既可以通过速度指令vs的差分计算，也可以根据式(2)以及式(4)的时间微分式计算。
然后，在满足了vz≥vmax-vn这样的条件的最初的指令生成周期中，将加速度减少开始指令Ia输出到加加减速区间三角函数指令生成部21。另外，根据加速区间剩余速度vz和当前的速度指令的值vn，进行vend＝vn+vz这样的运算，将通过式(48)计算出的加速区间剩余距离Pb和vend输出到减速停止距离运算部26。
然后，如果加速区间剩余距离Pb和vend输入到减减速停止距离运算部26，则通过使用下式(49)，计算在加速度成为0的地点处开始了减速时的直至停止为止的移动距离Lg3。然后，如果计算出移动距离Lg3，则通过使用下式(50)，根据当前的位置指令、速度指令新生成加速度减少曲线而使加速度减少至0，计算从加速度成为0的地点起减速停止时的直至减速停止为止的减速停止距离Lg4，输出到减速开始判别部7。
Lg3＝Pg2*vend*vend    …(49)
Lg4＝Pb+Lg3…(50)
然后，如果减速停止距离Lg4输入到减速开始判别部7，则在动作开始后初次满足了Lg4≥Ls这样的条件的指令生成周期中，将减速开始指令Is输出到加加减速区间三角函数指令生成部21。
然后，在加加减速区间三角函数指令生成部21中，在从加速区间剩余距离剩余速度运算部9接收到加速度减少开始指令Ia的情况、或者从减速开始判别部7接收到减速开始指令Is的情况下，将当前时刻设成kt2，开始进行加速度减少区间K3以后的指令生成。
此处，在根据来自加速区间剩余距离剩余速度运算部9的加速度减少开始指令Ia开始了加速度减少区间K3以后的指令生成的情况下，直至从减速开始判别部7接收减速开始指令Is为止不开始减速，而由从减速开始判别部7接收到减速开始指令Is的指令生成周期起开始减速，开始进行加速度减少区间K5的指令生成。另一方面，在根据来自减速开始判别部7的减速开始指令Is开始了加速度减少区间K3以后的指令生成的情况下，如果加速度减少区间K3中的指令生成结束，则立即开始进行加速度减少区间K5的指令生成，开始减速。
如以上的说明，根据实施方式3，通过在满足了vz≥vmax-vn这样的条件的最初的指令生成周期中开始进行加速度的减少，即使在从图2的加速区间A起开始减速停止的情况下，也可以防止加速度变得不连续。
产业上的可利用性
如上所述，本发明的指令生成装置可以抑制指令生成所需的计算量的增大，并且可以独立地设定加加速度区间，并且可以连续地设定加加速度，适用于生成安装机、半导体制造装置、射出成形机、机器人、工作机械、包装机械、印刷机械等机械***的位置指令或者速度指令的方法。

Claims (7)

1.一种指令生成装置，其特征在于，
具备加加减速区间三角函数指令生成部，该加加减速区间三角函数指令生成部通过使用根据1/2周期量的三角函数生成的加速度指令曲线来生成位置指令或者速度指令。
2.根据权利要求1所述的指令生成装置，其特征在于，
还具备加加减速区间参数设定部，该加加减速区间参数设定部将所述加速度指令曲线的加减速区间分割成加速度增加区间、等加速度区间以及加速度减少区间，并相互独立地设定各区间的时间的长度。
3.根据权利要求1或者2所述的指令生成装置，其特征在于，还具备：
基准减速停止距离运算部，运算从当前速度起加速度恒定地减速停止时的移动距离作为基准减速停止距离；
减速停止距离运算部，根据由所述基准减速停止距离运算部计算出的基准减速停止距离，运算从当前速度起减速停止时的移动距离作为减速停止距离；
差距离运算部，运算和目标位置与当前位置的差分所对应的差距离；以及
减速开始判别部，根据所述减速停止距离与所述差距离的比较结果，将使减速开始的减速开始指令输出到所述加加减速区间三角函数指令生成部。
4.根据权利要求3所述的指令生成装置，其特征在于，
还具备校正系数运算部，该校正系数运算部根据与加速度增加区间以及加速度减少区间的时间的长度相关的参数，计算出校正所述减速停止距离的校正系数。
5.根据权利要求1或者2所述的指令生成装置，其特征在于，还具备：
减速停止距离运算部，根据当前的速度指令，运算从当前速度起减速停止时的移动距离作为减速停止距离；
差距离运算部，运算和目标位置与当前位置的差分所对应的差距离；以及
减速开始判别部，根据所述减速停止距离与所述差距离的比较结果，将使减速开始的减速开始指令输出到所述加加减速区间三角函数指令生成部。
6.根据权利要求1或者2所述的指令生成装置，其特征在于，还具备：
计算加速区间剩余距离剩余速度运算部，在处于加速区间的加速度增加区间或者等速区间的情况下，根据当前的位置指令、速度指令以及加速度指令新生成加速度减少曲线而使加速度成为0的情况下，根据与直至加速度成为0为止的速度增加量对应的加速区间剩余速度、和与直至加速度成为0为止的移动量对应的加速区间剩余距离，将使加速度的减少开始的加速度减少开始指令输出到所述加加减速区间三角函数指令生成部；
减速停止距离运算部，根据由所述基准减速停止距离运算部计算出的加速区间剩余速度以及加速区间剩余距离，运算从当前速度起减速停止时的移动距离作为减速停止距离；
差距离运算部，运算和目标位置与当前位置的差分所对应的差距离；以及
减速开始判别部，根据所述减速停止距离与所述差距离的比较结果，将使减速开始的减速开始指令输出到所述加加减速区间三角函数指令生成部。
7.根据权利要求5或者6所述的指令生成装置，其特征在于，
还具备校正系数运算部，该校正系数运算部根据与加速度增加区间以及加速度减少区间的时间的长度相关的参数以及减速区间的加速度最大值，计算出校正所述减速停止距离的校正系数。
CN2010800187022A 2009-04-28 2010-04-21 指令生成装置 Active CN102414635B (zh)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2009-109122 2009-04-28
JP2009109122 2009-04-28
PCT/JP2010/057101 WO2010125958A1 (ja) 2009-04-28 2010-04-21 指令生成装置

Publications (2)

Publication Number Publication Date
CN102414635A true CN102414635A (zh) 2012-04-11
CN102414635B CN102414635B (zh) 2013-10-30

Family

ID=43032112

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2010800187022A Active CN102414635B (zh) 2009-04-28 2010-04-21 指令生成装置

Country Status (7)

Country Link
US (1) US8897901B2 (zh)
JP (1) JP5241919B2 (zh)
KR (1) KR101349537B1 (zh)
CN (1) CN102414635B (zh)
DE (1) DE112010001794B4 (zh)
TW (1) TWI468890B (zh)
WO (1) WO2010125958A1 (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103253565A (zh) * 2013-04-08 2013-08-21 深圳市海浦蒙特科技有限公司 电梯及其运行速度设置的方法和装置
CN105883510A (zh) * 2016-04-29 2016-08-24 宁波宏大电梯有限公司 电梯控制方法及***
CN106843245A (zh) * 2016-12-01 2017-06-13 北京京东尚科信息技术有限公司 一种无人机姿态控制方法、装置及无人机
CN113419571A (zh) * 2021-07-08 2021-09-21 广州小鹏自动驾驶科技有限公司 一种速度调节方法、装置及汽车

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5378318B2 (ja) * 2010-07-30 2013-12-25 日立オートモティブシステムズ株式会社 車両運動制御装置
JP5889104B2 (ja) * 2012-05-23 2016-03-22 三菱電機株式会社 位置決め制御用指令生成装置
EP3048074B1 (en) * 2015-01-26 2022-01-05 KONE Corporation Method of eliminating a jerk arising by accelerating an elevator car

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS465732Y1 (zh) * 1968-03-19 1971-03-01
JPS61160113A (ja) * 1985-01-09 1986-07-19 Unie- Syst Kk 移動速度制御装置
JPH065732A (ja) * 1992-06-18 1994-01-14 Oki Electric Ind Co Ltd 半導体装置
CN1237532A (zh) * 1998-03-26 1999-12-08 Lg产电株式会社 电梯的位置控制装置和方法
JP2000040658A (ja) * 1998-07-24 2000-02-08 Nikon Corp ステージ制御方法及び走査型露光装置
CN1450972A (zh) * 2000-03-27 2003-10-22 三菱电机株式会社 调速装置
EP1462200A1 (en) * 2003-03-27 2004-09-29 Oto Mills S.p.A. A machine for continuous-cycle shearing of moving welded tubes
CN1781659A (zh) * 2004-11-30 2006-06-07 发那科株式会社 控制装置
CN1833830A (zh) * 2005-03-14 2006-09-20 精工爱普生株式会社 加减速控制方法及装置及加减速控制方法的程序
CN1898142A (zh) * 2003-12-26 2007-01-17 株式会社安川电机 电梯用逆变器的速度控制方法及装置
CN1963702A (zh) * 2005-11-11 2007-05-16 株式会社日立产机*** 电动机控制装置的自动调整法及装置
CN1971457A (zh) * 2005-11-25 2007-05-30 中国科学院沈阳计算技术研究所有限公司 一种用于数控机床的加减速控制方法

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3395278B2 (ja) 1993-09-16 2003-04-07 ソニー株式会社 数値制御方法と数値制御装置
JP3354494B2 (ja) 1998-07-02 2002-12-09 株式会社不二越 数値制御装置
US6782306B2 (en) * 1999-12-16 2004-08-24 Siemens Energy & Automation Motion control system and method utilizing spline interpolation
EP1255430B1 (en) 2000-01-17 2008-07-02 Matsushita Electric Industrial Co., Ltd. Positioning control method and positioning control device, and electronic part mounting device using this
JP3900789B2 (ja) * 2000-04-14 2007-04-04 セイコーエプソン株式会社 モータの速度・加速度決定方法、加減速生成方法、加減速制御方法、加減速制御装置及びモータ制御装置
DE10200680B4 (de) * 2002-01-10 2004-03-25 Siemens Ag Minimale Schwingungsanregung beim Verfahren mit Ruckbegrenzung durch Adaption von Ruckprofilen
AU2003218101A1 (en) * 2002-03-13 2003-09-29 Georgia Tech Research Corporation Shaping and smooth baseline function command generator
US8348718B2 (en) * 2004-06-22 2013-01-08 Sunnen Products Company Servo stroking method and system for producing special shapes
CA2570690C (en) * 2004-06-22 2012-06-12 Sunnen Products Company Servo stroking apparatus and system
US20060082922A1 (en) 2004-10-15 2006-04-20 Teng-Yuan Shih Trajectories-based seek
JP4541218B2 (ja) 2005-04-08 2010-09-08 三菱電機株式会社 指令生成装置
JP2007086904A (ja) * 2005-09-20 2007-04-05 Brother Ind Ltd 加速度軌跡生成装置
JP2008186405A (ja) 2007-01-31 2008-08-14 Brother Ind Ltd 制御方法及び制御装置
DE102007006421A1 (de) * 2007-02-05 2008-08-07 Robert Bosch Gmbh Verfahren zum Betreiben von gesteuerten Maschinen
JP4889809B2 (ja) 2008-05-29 2012-03-07 三菱電機株式会社 加減速制御装置

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS465732Y1 (zh) * 1968-03-19 1971-03-01
JPS61160113A (ja) * 1985-01-09 1986-07-19 Unie- Syst Kk 移動速度制御装置
JPH065732A (ja) * 1992-06-18 1994-01-14 Oki Electric Ind Co Ltd 半導体装置
CN1237532A (zh) * 1998-03-26 1999-12-08 Lg产电株式会社 电梯的位置控制装置和方法
JP2000040658A (ja) * 1998-07-24 2000-02-08 Nikon Corp ステージ制御方法及び走査型露光装置
CN1450972A (zh) * 2000-03-27 2003-10-22 三菱电机株式会社 调速装置
EP1462200A1 (en) * 2003-03-27 2004-09-29 Oto Mills S.p.A. A machine for continuous-cycle shearing of moving welded tubes
CN1898142A (zh) * 2003-12-26 2007-01-17 株式会社安川电机 电梯用逆变器的速度控制方法及装置
CN1781659A (zh) * 2004-11-30 2006-06-07 发那科株式会社 控制装置
CN1833830A (zh) * 2005-03-14 2006-09-20 精工爱普生株式会社 加减速控制方法及装置及加减速控制方法的程序
CN1963702A (zh) * 2005-11-11 2007-05-16 株式会社日立产机*** 电动机控制装置的自动调整法及装置
CN1971457A (zh) * 2005-11-25 2007-05-30 中国科学院沈阳计算技术研究所有限公司 一种用于数控机床的加减速控制方法

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103253565A (zh) * 2013-04-08 2013-08-21 深圳市海浦蒙特科技有限公司 电梯及其运行速度设置的方法和装置
CN105883510A (zh) * 2016-04-29 2016-08-24 宁波宏大电梯有限公司 电梯控制方法及***
CN105883510B (zh) * 2016-04-29 2018-08-07 宁波宏大电梯有限公司 电梯控制方法及***
CN106843245A (zh) * 2016-12-01 2017-06-13 北京京东尚科信息技术有限公司 一种无人机姿态控制方法、装置及无人机
CN106843245B (zh) * 2016-12-01 2022-02-01 北京京东乾石科技有限公司 一种无人机姿态控制方法、装置及无人机
CN113419571A (zh) * 2021-07-08 2021-09-21 广州小鹏自动驾驶科技有限公司 一种速度调节方法、装置及汽车
CN113419571B (zh) * 2021-07-08 2023-08-29 广州小鹏自动驾驶科技有限公司 一种速度调节方法、装置及汽车

Also Published As

Publication number Publication date
TWI468890B (zh) 2015-01-11
KR101349537B1 (ko) 2014-01-08
TW201109874A (en) 2011-03-16
JPWO2010125958A1 (ja) 2012-10-25
KR20120016213A (ko) 2012-02-23
WO2010125958A1 (ja) 2010-11-04
DE112010001794T5 (de) 2012-07-12
JP5241919B2 (ja) 2013-07-17
CN102414635B (zh) 2013-10-30
US8897901B2 (en) 2014-11-25
US20120035771A1 (en) 2012-02-09
DE112010001794B4 (de) 2019-09-05

Similar Documents

Publication Publication Date Title
CN102414635B (zh) 指令生成装置
CN102502411B (zh) 起重机精确自动定位控制***及方法
CN103970073B (zh) 一种用于数控***的加减速规划方法、装置及数控机床
AU2007327710B2 (en) Brake control device for electric vehicle
WO2013129294A1 (ja) モータ制御装置
TW200602828A (en) Vibration control device
CN108153246B (zh) 一种基于指定速度的参数自适应s形速度规划插补方法
CN103069713A (zh) 电机控制装置
CN107570786A (zh) 一种飞剪控制***和方法
JPH11212650A (ja) 機械動作制御装置及び停止指令発生装置
CN103941646B (zh) 伺服定位控制***及方法
CN102312875A (zh) 一种用于液压***的液压油流量分配方法及装置
CN100585528C (zh) 基于实时控制网络的双电机驱动提高运动精度的控制方法
Mitrovic et al. Multi-motor drives for crane application
CN102201784B (zh) 电动机驱动装置
CN112596529B (zh) 基于方向的机器人行走速度调节方法、芯片及视觉机器人
CN113595449B (zh) 一种设备的驱动控制方法及***
CN112511065B (zh) 机器人启动加速运动中的pid调节方法
KR101439620B1 (ko) 연주 설비의 구동롤 제어 장치 및 방법
KR101575144B1 (ko) 에너지 절감형 수치 제어 장치
CN108265507B (zh) 一种鬃毛床的驱动控制***
CN103499932B (zh) 一种全闭环伺服控制方法、装置及***
CN203926173U (zh) 起重机微动控制***
JP2015159660A (ja) サーボモータ制御装置
JP6350420B2 (ja) 学習型張力制御装置

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