CN103025491B - 控制自动化工作单元的方法 - Google Patents
控制自动化工作单元的方法 Download PDFInfo
- Publication number
- CN103025491B CN103025491B CN201180034711.5A CN201180034711A CN103025491B CN 103025491 B CN103025491 B CN 103025491B CN 201180034711 A CN201180034711 A CN 201180034711A CN 103025491 B CN103025491 B CN 103025491B
- Authority
- CN
- China
- Prior art keywords
- robot arm
- motor
- control centre
- control
- computing unit
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 48
- 238000004891 communication Methods 0.000 claims abstract description 30
- 230000033001 locomotion Effects 0.000 claims description 49
- 230000001360 synchronised effect Effects 0.000 claims description 5
- 238000012937 correction Methods 0.000 claims description 3
- 238000003745 diagnosis Methods 0.000 claims description 2
- 230000007257 malfunction Effects 0.000 claims description 2
- 238000012986 modification Methods 0.000 description 8
- 230000004048 modification Effects 0.000 description 8
- 230000008569 process Effects 0.000 description 6
- 230000005540 biological transmission Effects 0.000 description 5
- 230000005484 gravity Effects 0.000 description 4
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 230000009471 action Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000000284 extract Substances 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000011112 process operation Methods 0.000 description 2
- 241001269238 Data Species 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 210000000245 forearm Anatomy 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
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
-
- 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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- 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/408—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 data handling or data format, e.g. reading, buffering or conversion of data
-
- 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/408—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 data handling or data format, e.g. reading, buffering or conversion of data
- G05B19/4086—Coordinate conversions; Other special calculations
-
- 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/33—Director till display
- G05B2219/33273—DCS distributed, decentralised controlsystem, multiprocessor
-
- 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/39—Robotics, robotics to robotics hand
- G05B2219/39253—Virtual arm, has end effector on any joint of real manipulator
-
- 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/39—Robotics, robotics to robotics hand
- G05B2219/39384—Control unit near robot, control and teaching panel in safe zone
-
- 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/39—Robotics, robotics to robotics hand
- G05B2219/39408—Integrated structure and control design
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Human Computer Interaction (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明涉及一种控制自动化工作单元的方法,包括:由多个控制轴(A1至A6;X,Y,Z,Rx,Ry,Rz)控制的具有至少三个自由度的至少一个机器人手臂(4);控制中心(8);机器人手臂(4)的控制装置(6),包括多个电动机控制器(61至66),控制能够操纵至少部分的机器人手臂(4)的电动机(M1至M6)的运行;用于控制中心(8)和机器人手臂(4)的控制装置之间通信的总线(14),该方法包括以下步骤:a)传送指令(C1i),其是由控制中心(8)发送以控制控制轴,并且被发送至属于机器人手臂(4)的控制装置(6)的仅有的一个计算单元(10);b)在计算单元(10)中由接收到的来自控制中心(8)的多个指令来确定用于由电动机控制器控制的每个电动机的指令(O1i,O2i,O’i);c)向每个电动机控制器传送在步骤b)中确定的用于由这个电动机控制器控制的电动机的命令。
Description
技术领域
本发明涉及一种控制工作单元的方法,所述工作单元包括:机器人,控制中心,机器人的控制装置,以及用于控制中心和机器人的控制装置之间通信的总线。
背景技术
在机器人手臂控制的领域中,众所周知,控制中心通过总线与能够控制使机器人的各部分运动的电动机的轴控制器进行通信。这样的控制中心解释由用户给定的运动指令或由用户创建的程序,以便确定机器人的每个运动轴的运动指令。
通过应用一种取决于所使用的机器人手臂的类型的反几何模型(inversegeometricmodel),在控制中心处计算出机器人的各部分相对于各轴的运动。为了使机器人的各部分进行有效的运动,命令每个机器人进行与轴线运动指令相对应的运动。
由于每个机器人具有特定的运动特性,有必要在控制中心将本质特性与所使用的机器人的类型合并。在控制中心的合并后的程序中,出现了相对严重的难题。
由于控制中心与每个轴控制器通信,而运动命令涉及机器人的各部分,这种通信导致需要传送从控制中心到每个轴控制器的命令,这就产生相当长的通信时间。
发明内容
正是这些缺点,本发明开始通过提出一种新颖的控制自动化工作单元的方法来补救,简化了控制中心的编程,提高了与各轴控制器的通信速度,并提高了控制机器人的精度。
为达到上述目的,本发明涉及一种控制自动化工作单元的方法,包括:由多个控制轴控制的具有至少三个自由度的至少一个机器人手臂,控制中心,机器人手臂的控制装置,所述控制装置包括多个电动机控制器,每个所述电动机控制器控制能够操纵至少部分的所述机器人手臂的电动机的运行,用于所述控制中心和所述机器人手臂的控制装置之间通信的总线,所述方法的特征在于包括以下步骤:
a)传送指令,所述指令由所述控制中心发送以控制所述控制轴,并且被发送至属于所述机器人手臂的控制装置的仅有的一个计算单元;
b)在计算单元中由多个接收到的来自所述控制中心的指令来确定用于由电动机控制器控制的每个电动机的指令;
c)向每个电动机控制器传送在步骤b)中确定的用于由这个电动机控制器控制的电动机的命令。
机器人手臂的控制是基于运动控制轴的识别,换言之,几何特性如长度或角度使得表达机器人手臂的端部的运动成为可能。
借助于本发明,每个机器人手臂的移动命令的计算在属于机器人的控制装置的单元里独立地进行,同时考虑由所述控制中心发出的所有指令。这将优化机器人的运行。在所述机器人控制装置中,所述计算单元的存在简化了所述控制中心的编程,因为后者不需要将数据特定地并入到每个机器人,并且不需要管理与每个轴控制器之间的通信。
因为确定了包括有每个机器人电动机的运动命令的计算的所述指令,在属于所述机器人控制装置的计算单元中,考虑到所有由所述控制中心发送的指令,有可能优化机器人的运行和机器人的工作单元的运行。此外,所述计算单元使用机器人手臂的特征所必须的处理操作。因此,节约了所述控制中心单元的程序控制器对将构成机器人学工程师的技术的一部分的精密停止或启动步骤的需要。根据本发明的有利特征而非必要特征,该控制方法可以包含一个或多个以下特征,多个特征被采取任何技术上可接受的组合。
所述方法包括以下补充步骤:
d)每个电动机控制器向所述计算单元传送所述电动机控制器控制的电动机的位置;
e)在所述计算单元基于所有所述电动机的位置计算所述机器人手臂的每个控制轴的位置;
f)将步骤e)中计算的位置传送至所述控制中心。
在步骤e)的计算中,所述计算单元考虑测量所述电动机位置的时间和将所述机器人手臂的每个控制轴的位置传送到所述控制中心的时间,以便根据所述机器人手臂的预测运动来校正所述控制轴的位置。
所述方法包括以下补充步骤:
g)在所述计算单元基于所有所述电动机的位置计算特征点的笛卡尔速度(cartesianspeed);
h)将计算出的笛卡尔速度与阈值比较;
i)如果所述笛卡尔速度大于所述阀值,所述计算单元向所述控制中心传送警报信号。
在步骤b)中,计算包括有遵守由所述控制中心发送的所述指令的每个电动机将要达到的位置的运动命令。
在步骤b)中,基于所述控制中心发送的所述指令,每个电动机的所述运动命令的计算伴随有将会被提供给每个电动机的转矩预测。
所述控制中心发送的所述指令包含有用于至少一个运动控制轴的所传送的负载的信息。
为遵守由所述控制中心发送的所述指令,每个电动机将要达到的位置包括由至少一些扭矩预测计算出的对所述机器人手臂变形的校正。
所述方法包括以下补充步骤:j)将表示所述机器人手臂的上电状态的信号传送至所述控制中心,其中,仅当所有电动机上电或掉电且被制动时,对应地宣告所述机器人手臂即将运行或掉电。
所述方法包括以下步骤:k)所述计算单元向所述控制中心传送表示所述机器人手臂的所有部分的运行状态的信号,其中,如果这些部分中的至少一个被检测为不能正常工作,则宣告所述机器人手臂的所有部分无法运行。
所述总线支持同步通信模式。
所述总线在串行实时通信协议类型的接口模式(interfacemodel)上运行。
所述控制中心采用“概要驱动”硬件配置文件的命令与所述计算单元通信。
附图说明
基于通过实例并结合附图所给出的根据其工作原理的控制自动化工作单元的方法的下述描述,将更好地理解本发明,并且本发明的其它优点将更加清楚地示出。其中:
图1为使用本发明的控制方法的自动化工作单元的结构图;
图2为本发明的功能性的概括图,示出了本发明的控制方法相关的主要功能和通信流。
具体实施方式
如图1所示,自动化工作单元2包括机器人手臂(robotarm)4,机器人手臂4的控制装置6,控制中心8以及两个部分显示的电动执行器。此处,所述机器人手臂4是由六轴(附图标记为A1至A6)机器人手臂构成。这里,术语“轴”是用于机器人目的上的,换言之,涉及到自由度。在本案中,自由度或轴A1至A6存在有转动(rotations)。
机器人(robot)的控制装置6接近机器人手臂4被放置,并且包括6个电动机控制器61至66。这些电动机控制器61至66中的每一个都能控制得以操纵机器人手臂4的一部分的电动机M1至M6中的一个的运行。
在任何其他的轴未开启的情况下,电动机M1的驱动允许机器人手臂4的位于轴A1和机器人手臂4的可移动端部之间的部分的整体转动。同样地,电动机M2、M3、M4、M6的驱动分别允许轴A2、A3、A4、A6的独立转动。另一方面,电动机M5的驱动导致轴A5、A6的转动。在轴A5和A6之间存在联轴器,则轴A5的独立转动需要电动机M5、M6的驱动。电动机M1至M6中的每一个配备有置于电机轴的编码器12,用于测量电机轴的角位置以及传送包括该位置的信息的电信号S12i,i为1至6之间的整数。每个电动执行器由电动机M21、M22操纵,每个电动机都分别由轴控制器121、122控制并且与编码器12相连,编码器12传送位置信号S1221或S1222。
如图2示意性所示,控制中心8由用户创建的用于执行精确动作的程序30来控制自动化单元2的运行,例如物体的装配需要机器人手臂4的运动,可选择性行动的抓器或传送机,包括由电动机M21、M22操纵的电动执行器、例如,这些程序中可能含有机器人手臂4的端部将要到达的一系列的笛卡尔坐标。
在一变型中,这些动作可以由固定或便携的控制面板32被用户实时选定,控制面板32向用户或者自动化工作单元2的程序控制器开放。
控制中心8通过现场总线14与控制装置6通信,优选运行在串行实时通信协议(SERCOS,SerialRealTimeCommunicationSpecification)III系列实时接口上。控制中心8为“主(master)”,而控制装置6为“从(slave)”。
控制装置6包括用于通过现场总线14而与控制中心8通信的通信卡60。
控制装置6还包括计算单元10,其功能是产生并传送指令(如运动命令或上电命令)至电动机控制器61至66。计算单元10为此特别包括微处理器和存储器。计算单元10能够与每个电动机控制器61至66通信。这样,电动机控制器61至66与控制中心8之间的每个数据传送都由计算单元10来管理,既包括从电动机控制器到中心的,又包括从中心到电动机控制器的。
机器人手臂4的控制轴被选为轴A1至A6,它们与机器人手臂4的自由度一致。
在初始化阶段,特别是SERCOSIII接口连接模式,通信被定义,使得机器人手臂4的轴A1至A6中的每一个都与假想的轴控制器(notionalaxiscontroller)相关联。这些假想的轴控制器被认为是以与通用轴控制器相同的方式接收来自控制中心8的指令,并控制至少一个基于这些指令的电动机。声明了它们与“概要驱动(profiledrive)”硬件配置文件(hardwareprofile)一致,该文件定义了一套结构、控制、询问状态和位置,诊断和监督的命令。由基于与“概要驱动”硬件配置文件相关的命令的控制中心8所产生的并且可由假想的轴控制器使用的指令被计算单元10接收。每个假想的轴控制器以与两个轴控制器121和122相同的方式被分配有地址,轴控制器121和122控制机器人手臂4外部的执行器并且存在于自动化工作元件2中。
在自动化工作单元2的机器人手臂的任何操作之前,本发明的控制方法被应用在机器人手臂4的所有电动机的上电阶段。这个上电是由控制中心8发起的,发送给总线14一条或多条包括指令Cci的主数据报文,i在1至6之间,用于上电给每个轴A1至A6。控制装置6的通信卡60捕获这些报文。然后它发送中断命令给计算单元10。计算单元恢复这些报文,从它们中为机器人手臂4的每个轴A1至A6提取指令Cci,并对其继续处理。SERCOSIII接口连接协议为每个连接到总线14的装置提供了在主数据报文中涉及的它的位置信息。计算单元10记录上电指令并给控制中心8发送响应报文,其中,声明与该指令相关的轴将要上电。电动机实际上并没有通电,直到收到由控制中心8发送的最后的上电指令,制动装置才打开。每个电动机M1至M6的上电指令O2i,i在1至6之间,是由计算单元10发送到每个电动机控制器61至66。当所有的电动机都上电并且计算单元10已经从电动机控制器61至66收到每个电动机M1至M6已经上电的信息时,计算单元10通过通信卡60发送报文T0,向控制中心8说明最后一个轴准备运行。
对于控制中心8的程序控制器,机器人手臂4的轴A1至A6的电动机M1至M6的上电命令类似于在自动化单元2中使用的其他电动机M21至M22的上电命令,是因为机器人手臂4的轴和其他两个轴以与“概要驱动”硬件配置文件一致而为控制中心8所知。为了管理各电动机的上电,计算单元10考虑所有的用于机器人手臂4的轴A1至A6中的每一个的指令,简化了控制中心8的编程。
当自动化单元2执行自动化的过程,控制中心8执行包括机器人必须执行的运动命令的操作程序30。在每个通信周期里,每个与机器人手臂4的假想的轴控制器相关联的轴A1至A6的运动指令C1i(i在1至6之间)是由轨迹发生器(pathgenerator)34计算,当机器人手臂4的运动命令表示它的端部运动的笛卡尔坐标,轨迹发生器34使用相反的几何模型36。按照SERCOSIII的接口协议,对每个定义的通信周期,所有的轴运动指令C1i以主数据报文T1(C1i)的形式通过总线被发送。通信卡60接收所述报文,然后发送中断命令给计算单元10,计算单元10恢复这些报文,从中提取轴运动指令C1i并对其继续处理。
在处理过程中,计算单元10计算每个由电动机控制器61至66控制的电动机M1至M6的运动命令O1i,i在1至6之间。通过应用变速器38的动态模型(kinematicmodel),每个电动机的运动命令O1i是通过所有从控制中心8接收的指令C1i来计算的。这些命令包括电动机将要达到的位置。然后该计算考虑存在于轴A5、A6之间的联轴器,需要使用电动机M5、M6的轴A5的运动。每个电动机的运动命令O1i的计算也考虑到电动机和机器人的转动轴之间的减速比。
每个电动机M1至M6的运动命令O1i被传送到每个电动机的电动机控制器61至66,负责测定和校正电机各相(motorphases)的供电电流。
每个电动机的轴的角位置是通过放置于每个电动机的轴的编码器12来检测的。以S121至S126信号的形式传送到每个电动机控制器的信息使得从动48电机各相的供电电流成为可能。
计算单元10,通过它与电动机控制器61至66的连接,也具有机器人手臂4的每个电动机的轴的角位置,并且通过应用变速器40的逆运动学模型(inversekinematicmodel)来计算机器手臂4的轴A1至A6的可动部件的角位置Pi,i为1至6之间的整数。由于轴A5、A6的联轴器,电动机M5、M6的轴的角位置在轴A6的角位置P6的测定上起作用。计算单元10也能从测量角度计算机器人的轴的可动部件的转动速度,由这些运动提供的转矩,或其他有用数据。
因此,根据SRECOSIII,在每个同步通信周期中,机器人的计算单元10产生了包括机器人手臂4的轴的角位置Pi的数据报文T′1,并且将其通过通信卡60传送至控制中心8。于是这个信息可以被程序30所使用,程序30管理自动化单元2的运行。控制中心8应用直接几何模型(directgeometricmodel)42,以便获得例如机器人手臂4的端部的笛卡尔位置Pc,然后将其显示在控制面板32上。
计算单元10可以从机器人手臂4的轴A1至A6的可动部分的角位置Pi(i为1至6之间的整数)中计算出至少一个特征点B的笛卡尔位置,例如位于机器人手臂4的端部的刀具夹头400上的特征点,并且可以从中导出所述特征点的笛卡尔速度V(B)。在计算单元10进行与预设阀值的比较。如果所述特征点的笛卡尔速度V(B)大于该阀值,计算单元10给所有的电动机控制器61至66发送终止命令,并发送指出所述错误的报文给控制中心8。
在一变型中,计算单元10从与机器人手臂4的假想的轴控制器连接的每个轴A1至A6的移动指令C1i中计算出所述特征点的笛卡尔速度V(B),i在1至6之间。
如果因为重力或惯性力每个电动机的从动装置考虑到适用于关节的转矩Fi预测(i在1至6之间),基本上改进了机器人手臂4的行为。在计算单元10中,这个使用动态模型(dynamicmodel)44的转矩Fi预测是为每个机器人手臂4的电动机建立的。所述动态模型是基于每个轴的运动指令C1i,这使得估计机器人手臂的每个部分所需的加速度成为可能。由于机器人手臂4的结构的原因,在机器人手臂4的每个电动机的轴的转矩Fi预测必须考虑到所有的轴A1至A6的运动指令Cli。转矩预测Fi一旦建立,它就通过应用电动机的数据或“常数(constants)”46而被翻译成电流指令,并且被传送到电动机控制器61至66,以便作为电机相位供电电流的控制回路50的输入而被合并。
根据一变型,将要提供给每个关节的转矩Fi预测的计算也可以使用机器人手臂4的轴的角位置Pi。
应用于关节的转矩Fi预测,i在1至6之间,是更加精确的,因为它考虑了由机器人手臂4传送的负载。每个负载是以质量、它的重心位置和它的惯性矩阵以及所附的自由度来表征的。控制中心8的程序控制器可以宣告关于机器人手臂4的每个运动控制轴的传送的负载。例如,对于刀具夹头400传送的负载,其通过用于控制轴A6的命令来宣告负载。对于前臂402传送的负载,其通过用于控制轴A4的命令来宣告负载。这些传送的负载可以被异步地宣告,换言之,是在控制中心8和计算单元10之间的周期性通信之外。他们也可以被同步地宣告,这使得改变由控制中心8发送的每个命令中传送的负载成为可能,并使得调整机器人手臂4的控制使其适应一系列运动成为可能,在该运动期间,机器人手臂在释放负载并从事其他运动之前会抓住并传送该负载。
本发明的方法能够使计算单元10考虑传送的负载,以便简化控制中心8的结构。
考虑到在负载的影响下的机器人手臂的变形,本发明的方法提供了设置于机器人手臂4的端部的刀具(未示出)的路径精度的改进措施。这些变形可能起因于结构元件(如手臂或如皮带或齿轮的传送元件)的柔度(flexibility)。根据每个轴的运动指令,由于重力和惯性力,动态模型44预测每个应用于关节的转矩Fi,i在1至6之间。由于所述变形,这些转矩Fi使得通过应用针对机器人手臂4的柔度矩阵来获得关节偏差Δi成为可能,i在1至6之间。所述关节偏差Δi使得提供机器人手臂4变形的校正成为可能,并被添加到每个轴的运动指令中因而在计算由电动机控制器61至66控制的每个电动机M1至M6的运动指令O1i时被考虑,i在1至6之间。
所述关节偏差Δi也要从机器人手臂4的轴A1至A6的可动部分的角位置Pi中被减去,i为1至6之间的整数。它起源于机器人手臂4的每个电动机的轴的角位置的逆运动学传输模型40的应用。
在一变型中,关节偏差Δi的计算可以在仅考虑与重力一致的转矩Fi的部分时候下建立,换言之为静载荷。
本发明的方法也考虑了机器人手臂4的各部分在运行中的故障。机器人手臂4的控制装置6的计算单元10监督电动机控制器61至66的运行。它使用软件检测所有的电动机控制器61至66、电动机M1至M6或编码器12在运行中的故障。当电动机发生崩溃,计算单元10停止机器人手臂4的其他所有电动机,并向控制中心8发送数据报文T2,数据报文T2中不仅宣告了有问题的电动机正常允许的轴的转动将要崩溃,还宣告了机器人手臂4的所有轴。换言之,机器人手臂4的一个轴的操作故障导致宣告整个机器人手臂不能运行。这个信息被发送给控制中心8。
因为控制中心8不需要管理机器人的所有轴的停运,简化了编程。这避免每个电动机控制器61至66和控制中心8之间的通信,加速了故障的处理并提高了机器人手臂4的安全。
如上所述,当轴A1至A6中的一个发生错误时,计算单元10提供机器人手臂4的行为的连贯性。同样适用于机器人手臂4的其中一个轴掉电的时候。然后每个电动机M1至M6必须必要地掉电。此外,出于安全原因,电动机的掉电必须先于制动装置停止电动机转动。来自控制中心8的机器人手臂4的掉电指令通过计算单元10被实施到每个电动机控制器。一旦机器人手臂4的轴Ai的掉电指令被计算单元10检测到,i为1至6之间的整数,该指令就会被推广到机器人手臂4的所有的电动机M1至M6。然后,计算单元10将电动机M1至M6的掉电指令O′i发送给每个电动机控制器61至66,i在1至6之间。当电流确实被切断时,所述计算单元10检查机器人手臂4的每个发动机的轴真正被制动,以便防止发生任何意外。当所有检查完成,计算单元10发送说明机器人手臂4的所有的轴Ai已经掉电的报文T3给控制中心8,i为1至6之间的整数。
本发明的方法提高了由控制中心8管理的运动同步。它依靠客户机-服务器通信模式,其中,控制中心8是服务器。总线14提供同步通信模式。控制中心8和机器人手臂4的控制装置6之间的通信是通过总线14在被称为通信频率的频率下发生,以适应将被控制的装置的数量,例如电动机控制器。
计算单元10在被称为控制频率的频率下运行,控制频率高于通信频率。
电动机控制器61至66进行的从动在被称为从动频率的频率下完成,从动频率高于控制频率。因此插补的计算在电动机的计算单元10的运动命令O1i到电动机控制器之间的每个传送是必要的。这些计算是在每个电动机控制器61至66中完成的。
控制中心8使用的自动化工作单元2的操作系统产生指令C1i,并且需要机器人手臂4的轴的角位置Pi的信息。在指令C1i的每个传送中,控制中心8需要机器人手臂4的每个轴的角位置。计算单元10通过编码器12使得每个电动机的轴的位置有效。它们从电动机控制器61至66到达,并通过应用变速器40的逆运动学模型使它能够计算机器人手臂4的轴的角位置Pi。这些处理操作和数据传送产生容易失去计算单元10和控制中心8的共时性的延迟。为了避免该不同步,计算单元10测定来自电动机控制器61至66的角位置信息的时间。因此,由编码器12测量的电动机轴的角位置的测量结果与测量时间相联系。由于通过总线14的通信是同步类型的,计算单元10知道在什么时刻将控制中心8需要的机器人手臂4的轴的角位置值Pi发送。然后,根据测量时间,并根据在此测量时刻机器人手臂4的预测运动以及从测量时间中分离出传送到控制中心8的时间而得的间隔时间来修改它们。
在一变型中,本发明的控制方法可以使用总线支持异步通信模式。
在另一变型中,本发明的方法可以与集成CANopen应用层的控制器局域网络(ControllerAreaNetwork,CAN)总线来实现。它也与Powerlink和EtherCAT通信协议兼容。
根据另一变型,机器人手臂4的运动控制轴可以被选作笛卡尔坐标轴X,Y,Z,并且相应的转动(rotation)Rx,Ry,Rz代替机器人手臂4的轴A1至A6。然后,控制中心8的程序控制器表达在3个方向X,Y,Z上的机器人手臂4的端部的必需的运动,以及根据绕轴X,Y,Z的转动Rx,Ry,Rz的机器人手臂4的端部的方向。在这种情况下,控制中心8传送将要到达的笛卡尔坐标给机器人手臂4的控制装置6。这简化了控制中心的编程,因为它不必包括其中针对被控制的机器人的特性。计算单元10嵌入机器人手臂4的反几何模型并使用它来确定用于电动机控制器61至66的运动指令。同样地,计算单元10嵌入并使用直接几何模型,这使得在传送到控制中心8之前从机器人手臂4的每个电动机的轴的角位置中计算出运动控制轴X,Y,Z的位置和相应的转动Rx,Ry,Rz成为可能。
本发明不限于六自由度机器人的使用,并且能够应用到例如七自由度的机器人。在这种情况下,程序控制器可以方便地选择笛卡尔轴X,Y,Z和机器人手臂的端部的运动的相应的转动Rx,Ry,Rz作为运动控制轴。机器人手臂的控制装置的计算单元为解决冗余将使用复杂的反几何模型。
本发明已描述了机器人的控制装置6,包通信卡60、计算单元10以及电动机控制器61至66。计算单元10能够处理来自控制中心8的信息,并产生用于电动机控制器61至66的运动指令。这些电动机控制器61至66功能上类似正常轴控制器,如轴控制器121和122。它们接收位置指令并提供供应电动执行器各相的电流的从动控制。然而,本发明也适用于使用计算单元直接能产生用于电源卡(未示出)的电流指令的结构。这些电源卡能够控制在一个或多个电动执行器各相的电流流入。本发明不应被机器人手臂4的控制装置6的结构所限制。
根据本发明的一变型,用于由电动机控制器控制的每个电动机M1至M6的命令是由几个而不是所有从控制中心8收到的指令Cli决定的,i为1至6的整数。
Claims (13)
1.一种控制自动化工作单元(2)的方法,包括:
由多个控制轴(A1至A6;X,Y,Z,Rx,Ry,Rz)控制的具有至少三个自由度的至少一个机器人手臂(4),
控制中心(8),其用于确定并且发送指令,以用于由所述控制轴来对所述机器人手臂进行控制,所述指令是由用于对所述机器人手臂进行引导的程序来计算的;
机器人手臂(4)的控制装置(6),所述控制装置(6)包括多个电动机控制器(61至66),每个所述电动机控制器(61至66)控制能够操纵至少部分的所述机器人手臂(4)的电动机(M1至M6)的运行,
用于所述控制中心(8)和所述机器人手臂(4)的控制装置之间通信的总线(14),
其特征在于,所述方法包括以下步骤:
a)传送指令(C1i),所述指令(C1i)由所述控制中心(8)发送以控制所述控制轴,并且被发送至属于所述机器人手臂(4)的控制装置(6)的仅有的一个计算单元(10);
b)在计算单元(10)中由接收到的来自所述控制中心的多个指令(C1i)来确定用于由电动机控制器(61至66)控制的每个电动机(M1至M6)的指令(O1i,O2i,O’i);
c)向每个电动机控制器传送在步骤b)中确定的用于由这个电动机控制器控制的电动机(M1至M6)的命令(O1i,O2i,O’i)。
2.根据权利要求1所述的方法,其特征在于,所述方法包括以下补充步骤:
d)每个电动机控制器(61至66)向所述计算单元(10)传送所述电动机控制器(61至66)控制的电动机(M1至M6)的位置;
e)在所述计算单元(10)基于所有所述电动机的位置计算所述机器人手臂(4)的每个控制轴(A1至A6,X,Y,Z,Rx,Ry,Rz)的位置(Pi,Pc);
f)将步骤e)中计算的位置(Pi,Pc)传送至所述控制中心(8)。
3.根据权利要求2所述的方法,其特征在于,所述方法包括以下补充步骤:
g)在所述计算单元(10)基于所有所述电动机的位置计算特征点(B)的笛卡尔速度(V(B));
h)将计算出的笛卡尔速度(V(B))与阈值比较;
i)如果所述笛卡尔速度(V(B))大于所述阈值,所述计算单元(10)向所述控制中心(8)传送警报信号。
4.根据权利要求3所述的方法,其特征在于,在步骤e)的计算中,所述计算单元(10)考虑测量所述电动机(M1至M6)位置的时间和将所述机器人手臂(4)的每个控制轴(A1至A6,X,Y,Z,Rx,Ry,Rz)的位置(Pi,Pc)传送到所述控制中心(8)的时间,以便根据所述机器人手臂(4)的预测运动来校正所述控制轴的位置(Pi,Pc)。
5.根据权利要求1所述的方法,其特征在于,在步骤b)中,计算包括有遵守由所述控制中心(8)发送的所述指令(C1i)的每个电动机(M1至M6)将要达到的位置的运动命令(O1i)。
6.根据权利要求5所述的方法,其特征在于,在步骤b)中,基于所述控制中心(8)发送的所述指令(C1i),每个电动机(M1至M6)的所述运动命令(O1i)的计算伴随有将被提供给每个电动机的转矩预测(Fi)。
7.根据权利要求6所述的方法,其特征在于,所述控制中心(8)发送的所述指令(C1i)包含有用于至少一个运动控制轴(A1至A6)的所传送的负载的信息。
8.根据权利要求6所述的方法,其特征在于,为遵守由所述控制中心(8)发送的所述指令(C1i),每个电动机(M1至M6)将要达到的位置包括由至少一些扭矩预测(Fi)计算出的对所述机器人手臂(4)变形的校正(△i)。
9.根据权利要求6所述的方法,其特征在于,所述方法包括以下补充步骤:
j)将表示所述机器人手臂(4)的上电状态的信号(T0,T3)传送至所述控制中心(8),其中,仅当所有电动机(M1至M6)上电或掉电且被制动时,对应地宣告所述机器人手臂(4)即将运行或掉电。
10.根据权利要求1所述的方法,其特征在于,所述方法包括以下步骤:
k)所述计算单元(10)向所述控制中心(8)传送表示所述机器人手臂(4)的所有部分的运行状态的信号(T2),其中,如果这些部分中的至少一个被检测为不能正常工作,则宣告所述机器人手臂(4)的所有部分无法运行。
11.根据权利要求1所述的方法,其特征在于,所述总线(14)支持同步通信模式。
12.根据权利要求1所述的方法,其特征在于,所述总线(14)在串行实时通信协议类型的接口模式上运行。
13.根据权利要求12的方法,其特征在于,所述控制中心(8)采用“概要驱动”硬件配置文件的命令与所述计算单元(10)通信,其中,所述概要驱动硬件配置文件定义了一套结构、控制、询问状态和位置,诊断和监督的命令。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR1053771 | 2010-05-14 | ||
FR1053771A FR2960075B1 (fr) | 2010-05-14 | 2010-05-14 | Procede de commande d'une cellule de travail automatisee |
PCT/FR2011/051078 WO2011141684A1 (fr) | 2010-05-14 | 2011-05-13 | Procédé de commande d'une cellule de travail automatisée |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103025491A CN103025491A (zh) | 2013-04-03 |
CN103025491B true CN103025491B (zh) | 2016-02-24 |
Family
ID=42674642
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201180034711.5A Active CN103025491B (zh) | 2010-05-14 | 2011-05-13 | 控制自动化工作单元的方法 |
Country Status (10)
Country | Link |
---|---|
US (1) | US8965574B2 (zh) |
EP (1) | EP2569129B2 (zh) |
JP (1) | JP5916716B2 (zh) |
KR (1) | KR101818570B1 (zh) |
CN (1) | CN103025491B (zh) |
DK (1) | DK2569129T4 (zh) |
ES (1) | ES2458429T5 (zh) |
FR (1) | FR2960075B1 (zh) |
PL (1) | PL2569129T5 (zh) |
WO (1) | WO2011141684A1 (zh) |
Families Citing this family (32)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2960074B1 (fr) * | 2010-05-14 | 2012-06-15 | Staubli Sa Ets | Procede de commande d'une cellule de travail automatisee |
US20150314454A1 (en) * | 2013-03-15 | 2015-11-05 | JIBO, Inc. | Apparatus and methods for providing a persistent companion device |
CN103831821B (zh) * | 2014-03-26 | 2015-08-19 | 哈尔滨工业大学 | 七自由度重载移动操作臂 |
KR101661599B1 (ko) * | 2014-08-20 | 2016-10-04 | 한국과학기술연구원 | 하드웨어 한계를 고려하는 동작 데이터의 압축 및 복원을 이용한 로봇 동작 데이터 처리 시스템 |
KR20160057635A (ko) | 2014-11-14 | 2016-05-24 | 롯데케미칼 주식회사 | 폴리카보네이트계 열가소성 수지 조성물 및 이를 이용한 제품 |
JP6084342B2 (ja) * | 2015-02-03 | 2017-02-22 | オリンパス株式会社 | 医療用マニピュレータシステムとその制御方法 |
TWD183878S (zh) * | 2015-10-08 | 2017-06-21 | 卡斯塔涅巴姆有限責任公司 | 工業機器人之使用者介面裝置 |
JP6096874B1 (ja) * | 2015-12-21 | 2017-03-15 | ファナック株式会社 | セルコントロールシステムにおける製造セルの状態変化管理システム |
JP1582721S (zh) * | 2016-09-29 | 2017-07-31 | ||
FR3063667B1 (fr) | 2017-03-13 | 2019-04-19 | Staubli Faverges | Procede de commande d'une cellule de travail automatisee |
JP6724831B2 (ja) * | 2017-03-16 | 2020-07-15 | 株式会社安川電機 | コントロールシステム、コントローラ及び制御方法 |
USD831087S1 (en) * | 2017-03-23 | 2018-10-16 | Denso Wave Incorporated | Industrial robot |
TWD194653S (zh) * | 2017-04-23 | 2018-12-11 | 德商法蘭卡愛米卡有限責任公司 | 工業機器人 |
US10252420B2 (en) * | 2017-06-09 | 2019-04-09 | Precise Automation, Inc. | Collaborative robot |
US10173323B2 (en) * | 2017-06-09 | 2019-01-08 | Precise Automation, Inc. | Collaborative robot |
JP1611705S (zh) * | 2017-07-13 | 2018-08-20 | ||
JP1599085S (zh) * | 2017-07-24 | 2018-03-05 | ||
JP1598672S (zh) * | 2017-07-24 | 2018-03-05 | ||
JP1612623S (zh) * | 2017-09-26 | 2018-09-03 | ||
USD839941S1 (en) * | 2017-09-28 | 2019-02-05 | Abb Schweiz Ag | Industrial robot |
JP1606239S (zh) * | 2017-11-22 | 2018-06-11 | ||
USD870169S1 (en) * | 2017-11-22 | 2019-12-17 | Mitsubishi Electric Corporation | Industrial robot |
JP1606240S (zh) * | 2017-11-22 | 2018-06-11 | ||
USD865828S1 (en) * | 2018-03-21 | 2019-11-05 | Productive Robotics, Inc. | Manufacturing robot |
FR3097565B1 (fr) * | 2019-06-19 | 2022-08-12 | Staubli Sa Ets | Machine textile, métier à tisser comportant une telle machine textile et procédés associés |
US11554490B2 (en) | 2020-12-09 | 2023-01-17 | Robert Bosch Gmbh | Monitoring real-time data of a robotic manipulator |
DE102021109904A1 (de) * | 2021-04-20 | 2022-10-20 | J. Schmalz Gmbh | Handhabungsvorrichtung mit definierter Ruhekonfiguration |
USD1020828S1 (en) * | 2022-03-31 | 2024-04-02 | Agile Robots AG | Robotic arm for medical and industrial purposes |
USD1034728S1 (en) * | 2022-08-10 | 2024-07-09 | Boston Dynamics, Inc. | Robotic device |
USD1033501S1 (en) * | 2022-08-10 | 2024-07-02 | Boston Dynamics, Inc. | Robotic device |
USD1061654S1 (en) * | 2023-06-16 | 2025-02-11 | Agile Robots AG | Robotic arm |
USD1062821S1 (en) * | 2023-06-26 | 2025-02-18 | Abb Schweiz Ag | Robot for preparing food or drink |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1277684A (zh) * | 1998-08-21 | 2000-12-20 | 松下电器产业株式会社 | 机器人控制装置及其控制方法 |
CN2447131Y (zh) * | 2000-09-30 | 2001-09-12 | 中国科学院自动化研究所 | 开放式工业机器人控制平台 |
CN1586829A (zh) * | 2004-07-29 | 2005-03-02 | 上海交通大学 | 基于分布式控制的即插即用机械臂系统 |
CN1745349A (zh) * | 2003-02-04 | 2006-03-08 | 施托布利法韦日公司 | 配备有控制系统的多轴机器人 |
CN101045297A (zh) * | 2007-04-12 | 2007-10-03 | 武汉科技大学 | 一种分布式多自由度机器人控制系统 |
Family Cites Families (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5927308A (ja) * | 1982-08-02 | 1984-02-13 | Fanuc Ltd | セル制御システム |
EP0262600B1 (en) * | 1986-09-29 | 1992-11-25 | Asea Ab | Method and device for optimum parameter control of controllers for rotational and/or linear movements in one or more degrees of freedom in an industrial robot |
JPH0760335B2 (ja) * | 1988-03-22 | 1995-06-28 | 横河電機株式会社 | ロボットの制御装置 |
JP3401971B2 (ja) * | 1995-01-30 | 2003-04-28 | 松下電器産業株式会社 | デジタルサーボ装置 |
WO1999050721A1 (en) * | 1997-09-19 | 1999-10-07 | Massachusetts Institute Of Technology | Robotic apparatus |
JPH10254524A (ja) * | 1997-03-10 | 1998-09-25 | Fanuc Ltd | 機械の制御装置におけるユニット間通信方法 |
DE19727824C1 (de) * | 1997-06-30 | 1998-11-19 | Siemens Ag | Verfahren und Vorrichtung zum dezentralen Betrieb bzw. Aufbau einer autarken, winkelgenauen Gleichlaufregelung einzelner Antriebe eines vernetzten Mehrmotorenantriebssystems |
JPH1177573A (ja) * | 1997-09-02 | 1999-03-23 | Denso Corp | ロボット制御装置 |
WO2003017019A1 (fr) * | 2001-08-02 | 2003-02-27 | Mitsubishi Denki Kabushiki Kaisha | Systeme de servocommande et procede de commande correspondant |
CA2458979C (en) * | 2001-08-31 | 2010-09-28 | George Danko | Coordinated joint motion control system |
US8060251B2 (en) * | 2004-12-06 | 2011-11-15 | Honda Motor Co., Ltd. | Interface for robot motion control |
WO2006062648A2 (en) | 2004-12-09 | 2006-06-15 | Jorge Perelman | A new material for making outer wrapping material by laminating a web material with a base material |
JP2010058256A (ja) * | 2008-09-08 | 2010-03-18 | Yaskawa Electric Corp | アーム位置調整方法及び装置並びにロボットシステム |
US20110106285A1 (en) * | 2009-11-02 | 2011-05-05 | Mold-Masters (2007) Limited | System for use in performance of injection molding operations |
US8280544B2 (en) * | 2009-11-02 | 2012-10-02 | Mold Masters (2007) Limited | System for use in performance of injection molding operations |
FR2960074B1 (fr) * | 2010-05-14 | 2012-06-15 | Staubli Sa Ets | Procede de commande d'une cellule de travail automatisee |
-
2010
- 2010-05-14 FR FR1053771A patent/FR2960075B1/fr active Active
-
2011
- 2011-05-13 JP JP2013509605A patent/JP5916716B2/ja active Active
- 2011-05-13 WO PCT/FR2011/051078 patent/WO2011141684A1/fr active Application Filing
- 2011-05-13 US US13/696,739 patent/US8965574B2/en active Active
- 2011-05-13 ES ES11725169.4T patent/ES2458429T5/es active Active
- 2011-05-13 DK DK11725169.4T patent/DK2569129T4/en active
- 2011-05-13 CN CN201180034711.5A patent/CN103025491B/zh active Active
- 2011-05-13 EP EP11725169.4A patent/EP2569129B2/fr active Active
- 2011-05-13 KR KR1020127031213A patent/KR101818570B1/ko active IP Right Grant
- 2011-05-13 PL PL11725169T patent/PL2569129T5/pl unknown
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1277684A (zh) * | 1998-08-21 | 2000-12-20 | 松下电器产业株式会社 | 机器人控制装置及其控制方法 |
CN2447131Y (zh) * | 2000-09-30 | 2001-09-12 | 中国科学院自动化研究所 | 开放式工业机器人控制平台 |
CN1745349A (zh) * | 2003-02-04 | 2006-03-08 | 施托布利法韦日公司 | 配备有控制系统的多轴机器人 |
CN1586829A (zh) * | 2004-07-29 | 2005-03-02 | 上海交通大学 | 基于分布式控制的即插即用机械臂系统 |
CN101045297A (zh) * | 2007-04-12 | 2007-10-03 | 武汉科技大学 | 一种分布式多自由度机器人控制系统 |
Also Published As
Publication number | Publication date |
---|---|
JP2013526419A (ja) | 2013-06-24 |
FR2960075A1 (fr) | 2011-11-18 |
DK2569129T3 (da) | 2014-04-22 |
ES2458429T5 (es) | 2017-11-20 |
JP5916716B2 (ja) | 2016-05-11 |
EP2569129B2 (fr) | 2017-07-26 |
PL2569129T5 (pl) | 2018-02-28 |
FR2960075B1 (fr) | 2012-06-15 |
EP2569129A1 (fr) | 2013-03-20 |
WO2011141684A1 (fr) | 2011-11-17 |
CN103025491A (zh) | 2013-04-03 |
US8965574B2 (en) | 2015-02-24 |
KR20130095189A (ko) | 2013-08-27 |
US20130116821A1 (en) | 2013-05-09 |
EP2569129B1 (fr) | 2014-04-02 |
DK2569129T4 (en) | 2017-09-25 |
ES2458429T3 (es) | 2014-05-05 |
PL2569129T3 (pl) | 2014-09-30 |
KR101818570B1 (ko) | 2018-01-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103025491B (zh) | 控制自动化工作单元的方法 | |
CN102985233B (zh) | 控制自动化工作单元的方法 | |
JP5026413B2 (ja) | 拡張可能な動作制御システム | |
CN106406223A (zh) | 机床与机器人的实时干扰确认系统 | |
US12030174B2 (en) | Machine control via wireless communication | |
CN108568816B (zh) | 用于控制自动化工作单元的方法 | |
Yang et al. | Synchronous Control Method and Simulation Research of Multi-degree of Freedom Humanoid Space Manipulator | |
US20020167229A1 (en) | Method of handling faults and preventing damage on machine tools and production machines, and also robots | |
CN116500971A (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 |