CN1258125C - 控制用于驱动机器人的电机的速度的方法 - Google Patents

控制用于驱动机器人的电机的速度的方法 Download PDF

Info

Publication number
CN1258125C
CN1258125C CNB99111695XA CN99111695A CN1258125C CN 1258125 C CN1258125 C CN 1258125C CN B99111695X A CNB99111695X A CN B99111695XA CN 99111695 A CN99111695 A CN 99111695A CN 1258125 C CN1258125 C CN 1258125C
Authority
CN
China
Prior art keywords
max
acc
value
speed
curve
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.)
Expired - Fee Related
Application number
CNB99111695XA
Other languages
English (en)
Other versions
CN1284784A (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.)
Samsung Electronics Co Ltd
Original Assignee
Samsung Electronics Co 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 Samsung Electronics Co Ltd filed Critical Samsung Electronics Co Ltd
Publication of CN1284784A publication Critical patent/CN1284784A/zh
Application granted granted Critical
Publication of CN1258125C publication Critical patent/CN1258125C/zh
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Classifications

    • 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
    • B25J9/12Programme-controlled manipulators characterised by positioning means for manipulator elements electric
    • 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/43Speed, acceleration, deceleration control ADC
    • G05B2219/43015Calculate square root x
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/43Speed, acceleration, deceleration control ADC
    • G05B2219/43114Detect position, speed or time of object between begin and end, adapt motion

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

一种电机速度控制装置中的电机速度控制方法。电机速度控制装置包括:一电机,一位置控制器,和一主控制器,主控制器产生速度指令曲线,根据机器人操作指令控制电机,并将速度指令曲线传送至位置控制器。电机速度控制方法包括一产生速度指令曲线的步骤,速度指令曲线在预定的机器人控制时间范围内有平滑曲线组成的加速度曲线,使机器人能在实时基础上被控制。因此,电机的振动和噪音减少了,增强了控制的可靠性。

Description

控制用于驱动机器人的电机的速度的方法
技术领域
本发明涉及一种电机速度控制方法,更准确地说,是一种控制用于驱动工业机器人的电机的速度的方法。
背景技术
通常,工业机器人包括用于在三维空间上移动目标物体或完成所要求的工作的机械部分。机器人包括:一个机体,它是支撑机器人的中心部分;一个带有手臂的机械手,用于将装有完成要求的工作所必需的工具的末端执行器移动至工作区域中的特定位置;一个用于控制机械手的控制器;一个用于向机体、机械手和控制器提供电力的动力源。伺服电机安装在机械手的手臂中,控制器控制伺服电机以完成定位工作。
通常,控制器包括一个主控制器、一个位置控制器和一个用于驱动伺服电机的伺服驱动器。主控制器根据当前位置和用户操作指令,比如由用户输入的目标位置,产生速度指令曲线,并将产生的速度指令曲线传送至位置控制器。位置控制器根据接收到的速度指令曲线控制伺服驱动器,并驱动伺服电机将手臂从某一点移动至另一点。同时,位置控制器从安装在伺服电机中的编码器接收当前位置,并反馈控制手臂的位置。
图1a和1a′显示了根据常规技术的用户指令曲线。图1b和1b′分别显示了根据常规技术对应于图1a和1a′的速度指令曲线。图1c和1c′分别显示了根据常规技术对应于图1a和1a′的加速度曲线。
在常规机器人中,主控制器产生一个轨迹计划,如速度曲线,其中最终的目标值已根据如图1a和1a′所示的来自用户的运动指令被设定。然后,主控制器产生一个抛物线计划曲线,如速度指令曲线,其中实际的加速和减速已根据如图1b和1b′所示的轨迹计划被执行。
换言之,对于常规的机器人,主控制器产生一个轨迹计划,来控制驱动机械手的伺服电机,然后根据轨迹计划产生抛物线计划曲线。因此,对用户指令的反应并不快。而且,即使抛物线计划曲线被以平滑曲线中的连续值的形式给出,其中也有一些不可求导的点存在于图1c和1c′所示的加速度曲线的突变之中。由于加速度改变率在不可求导的点附近很急剧,在电机中会产生振动和噪音。振动和噪音降低了就机器人的性能而言的可靠性,并对包括电机在内的机械元件产生冲击,从而缩短了机器人的寿命。振动和噪音在大型设备中尤其严重,比如深受惯性和重力影响的工业机器人。
发明内容
为了解决上述问题,本发明的一个目的就是提供一种能够进行实时控制的电机速度控制方法,其中速度指令曲线和加速度曲线分别具有平滑曲线中的连续值,而被改变的速度达到电机的实际工作速度所需的时间也减少了。
为了达到本发明的上述目的,本发明提供了一种在电机速度控制装置中使用的电机速度控制方法。电机速度控制装置包括:一个用于驱动机器人的电机,一个用于控制电机的位置控制器,和一个主控制器,主控制器产生具有平滑曲线的速度指令曲线,用于根据用户输入的机器人操作指令来控制电机,并将产生的速度指令曲线传送至位置控制器。电机速度控制方法包括一个产生速度指令曲线的步骤,速度指令曲线在预定的机器人控制时间范围内有由平滑曲线组成的加速度曲线,从而使机器人能在实时的基础上被控制。
速度指令曲线产生步骤最好包括一个操作控制准备步骤,以根据下列表达式,获得位置改变量ΔP、时间间隔最大值TPmax和加速度时间间隔值TAmax
公式1
    ΔP=Pg-Pc
TP max = ΔP V m ;
    TAmax=Ap
其中,Pg是目标位置,Pc是当前位置,Vm是每单位时间的最大速度,Ap是加速度时间间隔,它是由用户机器人操作指令设定的值。
操作控制准备步骤最好包括根据下列表达式获得时间间隔最大值TPmax和加速度时间间隔值TAmax的步骤:
公式2
x=TPmax×TAmax
TA max = x ;
TP max = x TA max
其中时间间隔最大值TPmax小于加速度时间间隔值TAmax
操作控制准备步骤最好还包括这样一个步骤:使用获得的位置改变量ΔP、获得的时间间隔最大值TPmax和获得的加速度时间间隔值TAmax,并将初始速度Si、最大速度Sm和最终速度Sf的初始值分别设置为0、1和0,根据下列表达式获得一个时间间隔内的位置改变量ΔP1
公式3
Δ P 1 = ΔP TP max
同时,速度指令曲线产生步骤包括下列步骤:将时间间隔计数器的初始值TPc设定为0,每当速度指令曲线产生一次,时间间隔计数器就递增1;获得用于计算加速过程中当前速度的值(Aa0、Aa1、Aa2)、用于计算减速过程中当前速度的值(Da0、Da1)、加速时间值Tacc、减速时间值Tdec、加速和恒定速度时间值TPi,以根据下列表达式,获得产生速度指令曲线所必需的变量的值:
公式4
Tacc=TAmax×|Sm-Si|;
Tdec=TAmax×|Sm-Sf|;
T P i = TP max - ( T acc × S i + ( S m - S f ) × T acc 2 + ( S m - S f ) × T dec 2 ) ;
公式5
Aa0=Si
Aa 1 = 3 T acc × T acc × ( S m - S i ) ;
Aa 2 = - 2 T acc × T acc × T acc × ( S m - S i ) ;
Da 0 = 3 T dec × T dec × ( S m - S f ) ;
Da 1 = - 2 T dec × T dec × T dec × ( S m - S f ) .
当表达式
| { T acc × S i + ( S m - S i ) × T acc 2 + ( S m - S f ) × T dec } |
的值大于一个预定的常数时,恒定速度时间值TPi和和最大速度Sm最好由下列表达式获得:
公式6
TP i = TP i + T acc × S i ( S m - S i ) × T acc 2 + ( S m - S f ) × T dec 2 - S m VELCOPENSATION ;
S m = ( TP max - S i × T acc ) T acc + T dec + TP i × 2
而且,在上述情况下,当前速度值Vc被计算以产生一个速度指令曲线,而获得的当前速度Vc和当前位置Pc则被增加以修正当前位置Pc
①当TPc<Tacc
公式7
Vc=ΔP1×(Aa0+Aa1×TPc×TPc+Aa2×TPc×TPc×TPc);
②当TPc<TPi
公式8
Vc=ΔP1×(Da0×TPc×TPc+Da1×TPc×TPc×TPc);和
③在其余情况下
公式9
Vc=ΔP1×Sm
附图说明
通过参阅附图对本发明的结构和操作进行更详细的说明,本发明的目的和其它优点将变得更加显而易见。附图中:
图1a和1a′显示了根据常规技术的用户指令曲线;
图1b和1b′分别显示了对应于图1a和1a′的速度指令曲线;
图1c和1c′分别显示了对应于图1a和1a′的加速度曲线;
图2是根据本发明的最佳实施例的机器人的示意方框图;
图3是根据本发明的最佳实施例的主控制器的示意方框图;
图4是产生速度指令曲线和加速度曲线的软件方框图;
图5是在操作控制器中产生速度指令曲线和加速度曲线的流程图;
图6a和6b分别是显示了根据本发明的恒定速度时段内的速度指令曲线和加速度曲线的曲线图;
图7a和7b分别是显示了在恒定速度时段内速度被改变为60%的速度的情况下的速度指令曲线和加速度曲线的曲线图;
图8a和8b分别是显示了不包含恒定速度时段的时间范围内的速度指令曲线和加速度曲线的曲线图;
图9a和9b分别是显示了在不包含恒定速度时段的时间范围内速度被改变为60%的速度的情况下的速度指令曲线和加速度曲线的曲线图;
具体实施方式
下面将参阅附图,对本发明的一个最佳实施例进行详细的说明。
参阅图2,根据本发明的机器人包括:一个主控制器1,一个位置控制器3,用于根据由主控制器1提供的速度指令曲线控制伺服驱动器5并同时反馈控制机器人的位置。伺服驱动器5接收来自位置控制器3的指令以驱动伺服电机7,而安装在机器人中的伺服电机7则有效地驱动机器人。
参阅图3,主控制器1包括:一个用于与用户接口装置2通讯的通讯模块11,通过它,机器人的操作指令可由用户编程;一个用于产生速度指令曲线的中央处理器(CPU)13;一个以执行代码的形式存储机器人系统控制程序的只读存储器(ROM)15;一个随机存取存储器(RAM)16,用于存储速度和加速度曲线在CPU 13中操作所必需的用户指令程序和变量信息;一个双通道随机存取存储器(DPRAM)17,用于与位置控制器3进行有关速度指令和位置信息的通讯。
根据上述结构,如果电力被提供给机器人,存储在ROM 15中的控制执行代码开始运行,而控制执行代码的运行所必需的数据则被记录在RAM 16中。如果用户通过使用用户接口装置12输入一个指令程序,CPU 13据此产生一个速度指令曲线和一个加速度曲线。
图4是产生在主控制器1中使用的速度指令曲线和加速度曲线的软件方框图。图5是在图4中的操作控制器120中产生速度指令曲线和加速度曲线的流程图。
在下文中,将参阅附图,对由根据本发明的主控制器1产生速度指令曲线的过程进行详细的说明。
当由预定的机器人语言构成的用户指令程序通过用户接口装置2被输入主控制器1时,机器人语言解释器110解释其含义。在被解释指令是操作指令的情况下,机器人语言解释器110将被解释指令发送至操作控制器120。接收一个操作指令和一个目标位置P。的操作控制器120,执行下述操作:通过使用目标位置P。和其它由用户设定的变量值,由此准备一个操作控制准备步骤(S1)。即,在操作控制准备步骤(S1),对应于当前位置Pc和目标位置Pg之间的差值的位置改变量ΔP、时间间隔最大值TPmax和加速度时间间隔值TAmax,可根据下述表达式得出:
公式1
ΔP=Pg-Pc
TP max = ΔP V m ;
TAmax=Ap
其中,Pg是目标位置,Pc是当前位置,Vm是每单位时间的最大速度,Ap是加速度时间间隔,并且所述加速度时间间隔是由用户机器人操作指令设定的值。
此处,由于时间间隔最大值TPmax小于加速度时间间隔值TAmax不合乎逻辑,时间间隔最大值TPmax和加速度时间间隔值TAmax又可由下述表达式获得:
公式2
x=TPmax×TAmax
TA max = x ;
TP max = x TA max
使用获得的位置改变量ΔP1、获得的时间间隔最大值TPmax和获得的加速度时间间隔值TAmax,一个时间间隔内的位置改变量ΔP1可根据下列表达式获得:
公式3
Δ P 1 = ΔP TP max
初始速度Si、最大速度Sm和最终速度Sf的初始值分别被设置为0、1和0。
如上所述,如果位置改变量ΔP、时间间隔最大值TPmax、加速度时间间隔值TAmax和一个时间间隔内的位置改变量ΔP1可被获得,而且随后初始速度Si、最大速度Sm和最终速度Sf已被设定,操作控制准备步骤S1就完成了。
然而,在操作控制准备步骤S1中获得的位置改变量ΔP小于由存储在ROM 15中的机器人控制程序设定的恒定值——最小位移量MINPOSITION的情况下,可以认为机器人已经被定位于目标位置,操作控制就完成了。
如果操作控制准备已经完成,操作控制器120获得一个产生速度指令曲线所必需的变量,此过程在步骤S2中完成。在此步骤S2中,可获得用于计算加速过程中当前速度的值(Aa0、Aa1、Aa2)、用于计算减速过程中当前速度的值(Da0、Da1)、加速时间值Tacc、减速时间值Tdec、加速和恒定速度时间值TPi
根据下述表达式,加速时间值Tacc和减速时间值Tdec首先被获得,然后,恒定速度时间值TPi被获得:
公式4
Tacc=TAmax×|Sm-Si|;
Tdec=TAmax×|Sm-Sf|;
T P i = TP max - ( T acc × S i + ( S m - S f ) × T acc 2 + ( S m - S f ) × T dec 2 ) ;
此处,当由表达式
| { T acc × S i + ( S m - S i ) × T acc 2 + ( S m - S f ) × T dec } |
得出的值大于由存储在ROM 15中的机器人系统控制程序设定的预定的恒定值——速度修正参考值VELCOMPENSATION时,就超出了由机器人用户设定的可靠控制范围。因此,恒定速度时间值TPi和最大速度Sm可根据下列表达式再次获得:
公式6
TP i = TP i + T acc × S i ( S m - S i ) × T acc 2 + ( S m - S f ) × T dec 2 - S m VELCOPENSATION ;
S m = ( TP max - S i × T acc ) T acc + T dec + TP i × 2
然后,Aa0、Aa1、Aa2、Da0和Da1可由下述表达式得出:
公式5
Aa0=Si
Aa 1 = 3 T acc × T acc × ( S m - S i ) ;
Aa 2 = - 2 T acc × T acc × T acc × ( S m - S i ) ;
Da 0 = 3 T dec × T dec × ( S m - S f ) ;
Da 1 = - 2 T dec × T dec × T dec × ( S m - S f ) .
同时,TPc是一个时间间隔计数器,其初始值被设定为0,每当速度指令曲线产生一次,时间间隔计数器就递增1。
下一步骤S3,是一个由计算结果产生速度指令曲线的步骤。而且,当前速度值Vc被计算以产生一个速度指令曲线,在这种情况下,当前速度值Vc可由下列表达式分别计算:
①当TPc<Tacc
公式7
Vc=ΔP1×(Aa0+Aa1×TPc×TPc+Aa2×TPc×TPc×TPc);
②当TPc<TPi
公式8
Vc=ΔP1×(Da0×TPc×TPc+Da1×TPc×TPc×TPc);和
③在其余情况下
公式9
Vc=ΔP1×Sm
由于获得的当前速度Vc表示每单位时间的当前移动距离,当前速度Vc被加入当前位置Pc中,以对当前位置Pc进行修正。
然后,一个速度指令传送器130将Pc值存储于DPROM 17中,并通知位置控制器3当前位置已被修正(S4)。
而且,操作控制器120将第一次输入的目标位置Pg和被修正的当前位置Pc之间的位置改变量ΔP,与最小位移量MINPOSITION相比较。如果位置改变量小于最小位移量,控制器120就认为当前位置已是目标位置(S5),然后就完成操作控制。然而,如果位置改变量等于或大于最小位移量,控制器120就认为当前位置不是目标位置(S5),并且检查用户指令速度S是否被修改(S6)。
如果判定用户指令速度S在步骤S6中没有被修改,程序返回至速度指令曲线产生步骤S3以到达目标位置。如果判定用户指令速度S在步骤S6中已经被修改,产生速度指令曲线所必需的变量在步骤S2中再次被获得。然后,根据最新得到的速度指令曲线,速度指令曲线再次被产生(S3)。
如果通过上述过程,认为已到达目标位置,操作控制器120就结束操作控制。
图6a至图9b显示了通过上述过程获得的速度指令曲线和加速度曲线。更详细地说,图6a和6b分别是显示了根据本发明的恒定速度时段内的速度指令曲线和加速度曲线的曲线图;图7a和7b分别是显示了在恒定速度时段内速度被改变为60%的速度的情况下的速度指令曲线和加速度曲线的曲线图;图8a和8b分别是显示了不包含恒定速度时段的时间范围内的速度指令曲线和加速度曲线的曲线图;图9a和9b分别是显示了在不包含恒定速度时段的时间范围内速度被改变为60%的速度的情况下的速度指令曲线和加速度曲线的曲线图。
如图6a至图9b所示,在恒定速度时段内,即使速度变化已经发生,速度指令曲线和加速度曲线也分别具有平滑曲线中的连续改变量。因此,从附图中可以看出,在加速度曲线中,和在速度指令曲线中一样,不存在急剧变化的点。
如上所述,本发明提供了一种电机速度控制方法,在速度指令曲线和加速度曲线中都有连续的改变量,相应地减少了振动和噪音,并改善了控制的可靠性。
此外,常规的电机速度控制方法,采取了两个步骤,即,根据用户操作指令产生目标值的轨迹计划,然后才产生一个速度指令曲线。而本电机速度控制方法,可根据目标值立即产生一个速度指令曲线。这样,即使在速度指令曲线的产生过程中用户速度指令被改变,速度指令曲线也能立即产生。相应地,对速度改变的反应足够快,从而确保机器人在实时基础上被控制。
尽管已对本发明连同其最佳实施例进行了说明,但本领域技术熟练的人可以理解的是,在不超出附加的权利要求所限定的本发明的精神和范围的情况下,可对本发明进行本文未特别说明的增添、改进、替代和删改。

Claims (5)

1.一种在电机速度控制装置中使用的电机速度控制方法,该电机速度控制装置包括:一个用于驱动机器人的电机,一个用于控制电机的位置控制器,和一个主控制器,主控制器产生具有平滑曲线的速度指令曲线,用于根据用户输入的机器人操作指令来控制电机,并将产生的速度指令曲线传送至位置控制器,其特征在于,该电机速度控制方法包括一个产生速度指令曲线的步骤,该速度指令曲线在预定的机器人控制时间范围内有由平滑曲线组成的加速度曲线,从而使机器人能在实时的基础上被控制;
所述速度指令曲线产生步骤包括一个操作控制准备步骤,以根据下列表达式,获得位置改变量ΔP、时间间隔最大值TPmax和加速度时间间隔值TAmax
公式1
      ΔP=Pg-Pc
TP max = ΔP V m ;
      TAmax=Ap
其中,Pg是目标位置,Pc是当前位置,Vm是每单位时间的最大速度,Ap是加速度时间间隔,所述加速度时间间隔是由用户机器人操作指令设定的值;
所述的操作控制准备步骤还包括如下步骤:使用获得的位置改变量ΔP、获得的时间间隔最大值TPmax和获得的加速度时间间隔值TAmax,并将初始速度Si、最大速度Sm和最终速度Sf的初始值分别设置为0、1和0,根据下列表达式获得一个时间间隔内的位置改变量ΔP1:
公式3
Δ P 1 = ΔP TP max .
2.根据权利要求1所述的电机速度控制方法,其特征在于,所述的操作控制准备步骤包括:根据下列表达式获得时间间隔最大值TPmax和加速度时间间隔值TAmax的步骤:
公式2
x=TPmax×TAmax
TA max = x ;
TP max = x TA max
其中时间间隔最大值TPmax小于加速度时间间隔值TAmax
3.根据权利要求1所述的电机速度控制方法,其特征在于,所述的速度指令曲线产生步骤包括:将时间间隔计数器的初始值TPC设定为0,每当速度指令曲线产生一次,时间间隔计数器就递增1;获得用于计算加速过程中当前速度的值Aa0、Aa1、Aa2、用于计算减速过程中当前速度的值Da0、Da1、加速时间值Tacc、减速时间值Tdec、恒定速度时间值TPi,以根据下列表达式,获得产生速度指令曲线所必需的变量的值:
公式4
    Tacc=TAmax×|Sm-Si|;
    Tdec=TAmax×|Sm-Sf|;
TP i = TP max - ( T acc × S i + ( S m - S f ) × T acc 2 + ( S m - S f ) × T dec 2 ) ;
公式5
    Aa0=Si
Aa 1 = 3 T acc × T acc × ( S m - S i ) ;
Aa 2 = - 2 T acc × T acc × T acc × ( S m - S i ) ;
Da 0 = 3 T dec × T dec × ( S m - S f ) ;
Da 1 = - 2 T dec × T dec × T dec × ( S m - S f ) .
4.根据权利要求3所述的电机速度控制方法,其特征在于,当由表达式
| { T acc × S i + ( S m - S i ) × T acc 2 + ( S m - S f ) × T dec } |
得出的值大于一个预定的常数时,恒定速度时间值TPi和和最大速度Sm由下列表达式获得:
公式6
Figure C991116950004C1
S m = ( TP max - S i × T acc ) T acc + T dec + TP i × 2 .
5.根据权利要求4所述的电机速度控制方法,其特征在于,在下述情况下,当前速度值Vc被计算以产生一个速度指令曲线,而获得的当前速度Vc和当前位置Pc则被增加以修正当前位置Pc:
①当TPc<Tacc
公式7
Vc=ΔP1×(Aa0+Aa1×TPc×TPc+Aa2×TPc×TPc×TPc);
②当TPc<TPi
公式8
Vc=ΔP1×(Da0×TPc×TPc+Da1×TPc×TPc×TPc);和
③在其余情况下
公式9
Vc=ΔP1×Sm
CNB99111695XA 1999-06-25 1999-08-24 控制用于驱动机器人的电机的速度的方法 Expired - Fee Related CN1258125C (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
KR1019990024365A KR100342255B1 (ko) 1999-06-25 1999-06-25 로봇 구동용 모터의 속도제어방법
KR9924365 1999-06-25

Publications (2)

Publication Number Publication Date
CN1284784A CN1284784A (zh) 2001-02-21
CN1258125C true CN1258125C (zh) 2006-05-31

Family

ID=19595494

Family Applications (1)

Application Number Title Priority Date Filing Date
CNB99111695XA Expired - Fee Related CN1258125C (zh) 1999-06-25 1999-08-24 控制用于驱动机器人的电机的速度的方法

Country Status (4)

Country Link
US (1) US6278253B1 (zh)
JP (1) JP2001022424A (zh)
KR (1) KR100342255B1 (zh)
CN (1) CN1258125C (zh)

Families Citing this family (24)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100342255B1 (ko) * 1999-06-25 2002-06-27 윤종용 로봇 구동용 모터의 속도제어방법
JP3681972B2 (ja) * 2000-10-18 2005-08-10 ファナック株式会社 加減速制御方法
KR100362611B1 (ko) * 2000-12-13 2002-11-29 삼성전자 주식회사 로봇 및 로봇의 모터속도제어방법
KR100494385B1 (ko) * 2002-10-14 2005-06-13 삼성전자주식회사 로봇의 속도제어시스템 및 그 속도제어방법
US7112939B2 (en) * 2004-12-07 2006-09-26 Electronics And Telecommunications Research Institute Mobile system and driving method thereof
KR100897354B1 (ko) * 2007-09-27 2009-05-15 세메스 주식회사 로봇의 진동 감쇄 방법
KR101343892B1 (ko) * 2008-06-10 2013-12-20 무라다기카이가부시끼가이샤 패러렐 메카니즘
JP4807600B2 (ja) * 2009-08-18 2011-11-02 村田機械株式会社 移動体システム
DE102009049172B4 (de) * 2009-10-13 2019-07-25 Kuka Roboter Gmbh Verfahren und Vorrichtung zur Steuerung eines Manipulators
DE102010008240B4 (de) * 2010-02-17 2015-10-15 Siemens Aktiengesellschaft Verfahren zum Betrieb eines mehrachsigen, vorzugsweise sechsachsigen, Roboters
CN102328315B (zh) * 2010-07-12 2014-01-01 深圳华强文化科技集团股份有限公司 一种机器人动作仿真的控制方法及装置
JP2012108608A (ja) * 2010-11-15 2012-06-07 Smc Corp アクチュエータ用駆動制御装置及びアクチュエータの駆動制御方法
KR101259819B1 (ko) * 2010-12-24 2013-04-30 삼성중공업 주식회사 로봇의 연속 경로 제어 방법 및 이를 수행하는 로봇 시스템
CN102298343B (zh) * 2011-04-29 2013-07-03 浙江工业大学 自动袜机的伺服电机近似匀加速度控制方法
US8972055B1 (en) * 2011-08-19 2015-03-03 Google Inc. Methods and systems for selecting a velocity profile for controlling a robotic device
CN103001570B (zh) * 2011-09-14 2015-05-20 北汽福田汽车股份有限公司 控制电机位置超调的方法及控制装置
JP5943676B2 (ja) * 2012-03-30 2016-07-05 株式会社デンソーウェーブ ロボットの制御システム及びエンコーダシステム
JP5633555B2 (ja) * 2012-11-13 2014-12-03 株式会社安川電機 ロボットシステム
CN105269583B (zh) * 2015-10-29 2022-05-10 青岛海尔智能家电科技有限公司 一种机器人运动控制方法、装置及机器人
JP6639997B2 (ja) * 2016-03-31 2020-02-05 住友重機械工業株式会社 射出成形機
CN109960290A (zh) * 2017-12-14 2019-07-02 深圳市优必选科技有限公司 舵机输出控制方法、系统及装置
WO2020093401A1 (zh) * 2018-11-09 2020-05-14 深圳配天智能技术研究院有限公司 设备运动控制方法、设备和存储装置
CN112002498B (zh) * 2020-08-13 2022-04-12 绍兴大明电力建设有限公司 基于速度曲线的高压旧电缆回收装置的调速方法
CN113556070B (zh) * 2021-07-12 2022-04-01 北京科技大学 一种机器人关节伺服电机柔顺控制方法

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS59106007A (ja) 1982-12-10 1984-06-19 Toyota Central Res & Dev Lab Inc 多関節型ロボツトの軌跡制御装置
US4912753A (en) 1988-04-04 1990-03-27 Hughes Aircraft Company Robot axis controller employing feedback and open loop (feedforward) control
KR0160998B1 (ko) 1992-09-18 1998-12-15 윤종용 로보트의 구동경로 계획방법
US5508596A (en) * 1993-10-07 1996-04-16 Omax Corporation Motion control with precomputation
US5684374A (en) * 1995-07-27 1997-11-04 Allen-Bradley Company, Inc. Method and apparatus for tuning a motion control system having an external velocity loop
GB9601753D0 (en) * 1996-01-29 1996-03-27 Switched Reluctance Drives Ltd Dual mode position control systems with speed profiling
KR100342255B1 (ko) * 1999-06-25 2002-06-27 윤종용 로봇 구동용 모터의 속도제어방법

Also Published As

Publication number Publication date
KR20010003878A (ko) 2001-01-15
JP2001022424A (ja) 2001-01-26
US6278253B1 (en) 2001-08-21
CN1284784A (zh) 2001-02-21
KR100342255B1 (ko) 2002-06-27

Similar Documents

Publication Publication Date Title
CN1258125C (zh) 控制用于驱动机器人的电机的速度的方法
CN1064489C (zh) 电动机控制设备、电动机驱动设备与空调器
CN1241765C (zh) 复合动力车及其控制方法
CN1816963A (zh) 电压变换设备以及在其上记录有用于计算机控制电压变换设备的电压变换的程序的计算机可读记录介质
CN1833830A (zh) 加减速控制方法及装置及加减速控制方法的程序
CN1830134A (zh) 能够抑制过电流的负载驱动器
CN1527170A (zh) 同步控制装置
CN1830133A (zh) 电压变换设备和在其上记录有用于计算机控制电压变换的程序的计算机可读记录介质
CN1191063A (zh) 电子零部件装配方法和装置
CN1967995A (zh) 装有电机的电动车辆及其控制方法
CN1756615A (zh) 锯床、切割加工方法及减小噪音的方法
CN1714965A (zh) 锻压机床的伺服电动机控制装置
CN1715094A (zh) 电动驱动控制装置、电动驱动控制方法及其程序
CN1715095A (zh) 电动驱动控制装置、电动驱动控制方法及其程序
CN1496302A (zh) 超声波振动熔敷装置和超声波振动头
CN1022677C (zh) 电梯控制装置
CN1739904A (zh) 激光加工装置
CN1799135A (zh) 基板处理系统及其控制方法、控制程序、存储介质
CN1265932C (zh) 激光加工设备及激光加工方法
CN1846348A (zh) 电动机控制装置
CN1732062A (zh) 电子凸轮式旋转切断机控制的反转防止电子凸轮曲线生成方法及其控制装置
CN1579717A (zh) 关节机器人
CN1894640A (zh) 一种控制多轴线自动装置的运动部分位移的方法和装置
CN101055467A (zh) 一种基于idp的工业过程动态优化系统及方法
CN1573172A (zh) 设备的控制装置

Legal Events

Date Code Title Description
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C06 Publication
PB01 Publication
C14 Grant of patent or utility model
GR01 Patent grant
C19 Lapse of patent right due to non-payment of the annual fee
CF01 Termination of patent right due to non-payment of annual fee