CN110076773B - 机器人设备、制造物品的方法及电机驱动设备 - Google Patents
机器人设备、制造物品的方法及电机驱动设备 Download PDFInfo
- Publication number
- CN110076773B CN110076773B CN201910308221.8A CN201910308221A CN110076773B CN 110076773 B CN110076773 B CN 110076773B CN 201910308221 A CN201910308221 A CN 201910308221A CN 110076773 B CN110076773 B CN 110076773B
- Authority
- CN
- China
- Prior art keywords
- motor
- control
- thrust
- command value
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
-
- 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/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/12—Programme-controlled manipulators characterised by positioning means for manipulator elements electric
- B25J9/126—Rotary actuators
-
- 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/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- 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
-
- 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/37—Measurements
- G05B2219/37344—Torque, thrust, twist, machining force measurement
-
- 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/39186—Flexible joint
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41372—Force estimator using disturbance estimator observer
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41428—Feedforward of position and speed
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
- Y10S—TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10S901/00—Robots
- Y10S901/02—Arm motion controller
- Y10S901/09—Closed loop, sensor feedback controls arm movement
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Automation & Control Theory (AREA)
- Control Of Electric Motors In General (AREA)
- Manipulator (AREA)
- Control Of Multiple Motors (AREA)
Abstract
本发明提供一种机器人设备、制造物品的方法及电机驱动设备。经由连接到电机的减速器进行机器人臂的移动控制。其控制器包括基于输入推力命令值生成电机位置命令值的推力控制单元,以及基于所述位置命令值生成电流值的电机控制单元。所述电机控制单元反馈由电机编码器检测到的电机位置,并且所述推力控制单元反馈由推力计检测到的推力。来自所述电机控制单元的反馈抑制在减速器上的振动现象,并且来自推力控制单元的反馈抑制传递误差,由此使得能够迅速精准地进行臂的动作控制。
Description
本申请是申请日为2015年11月18日、申请号为201510796074.5、发明名称为“电机驱动设备的控制设备及方法、多轴电机的控制设备”的发明专利申请的分案申请。
技术领域
本发明涉及用于经由连接到电机的传递机构进行移动构件的移动控制的电机驱动设备的控制设备,多个电机驱动设备被串联连接的多轴电机驱动设备的控制设备,以及用于电机驱动设备的控制方法。
背景技术
近来,正在开发机器人来替代人类进行各种作业。为了实现能够如同人手一样进行精准迅速的工作的机器人,机器人动作必须同时实现高精度及高速度。这种机器人利用电机作为动力源来驱动关节。多数利用诸如减速器、滚珠螺杆等的传递机构来增加电机推力并将旋转运动转换成线性运动。
然而,传递机构具有阻碍使精度增加的内在因素。实例包括扭转、由于减速器的齿轮啮合导致的角度误差、齿隙、摩擦、小部件的细微振动、由于滚珠螺杆的变形导致的角度误差、螺杆的共振、空动等。因此,即使精准地驱动电机,机器人动作的精度由于以上列出的因素而劣化。
另外,传递机构与诸如机器人框架的结构相比较更为柔性,因此会产生扭转,并像弹性体那样活动。因此,连接到传递机构的、其移动要被控制的移动构件展现出相对于电机的简谐运动,这也引起精度的劣化。另外,简谐运动的反作用力作用于电机,导致电机位置的偏差,这引起精度的更进一步劣化。
存在两种一般方法对用于机器人关节等的电机进行控制,即半封闭式控制(例如,参见日本特开昭61-201304号公报)和全封闭式控制(例如,参见日本特开平7-225615号公报和日本特开2011-176913号公报)。半封闭式控制是检测电机的输出轴(输出构件)的位置,并且将检测结果反馈给电机的位置命令的方法。全封闭式控制是对经由诸如减速器等的传递机构经历通过电机的移动驱动的移动构件的位置进行检测,并且将检测结果反馈给电机的位置命令的方法。一般地,半封闭式控制动作速度快但位置精度低,而另一方面全封闭式控制位置精度高但动作速度低。这样,可以说精度和速度处于折衷关系。
在半封闭式控制下,似乎可以通过输出对抗反作用力的推力来避免电机的位置偏差。然而,在电机持续输出对抗反作用力的推力并且不存在位置偏差的情况下,无法进行反馈,从而结果是,简谐运动持续而不停歇。一旦简谐运动变为持续,则每次在正在操作的传递机构中发生扭转时产生的简谐运动都被放大,并且可能变成机械共振。
因此,即使在半封闭式控制下,如果运转速度(增益)增加,则由于来自传递机构的弹性力的反作用力导致的电机的位置偏差也无法被避免。如果由于要避免来自在传递机构的弹性力的反作用力导致的动力源的位置偏差,则即使在半封闭式控制中,运转速度(增益)也必须被降低并且需要进行对电机的驱动控制,使得不发生简谐运动。
因此,日本特开昭61-201304号公报提出了预先准备考虑到传递机构的机械刚性的运动方程式并且其计算结果被添加到半封闭式控制的命令值的半封闭式控制。这旨在同时实现精度和速度。
另一方面,日本特开平7-225615号公报提出了移动构件的位置由传感器检测并且从目标值中减去,根据位置的差来校正电机的位置,以及使移动构件的位置来参仿(copy)目标值的全封闭式控制。日本特开2011-176913号公报提出了获得示出振动的、移动构件的位置与电机的位置之间的差,并考虑到扭转刚度来计算转矩值,以及进行控制使得该转矩值与转矩目标值匹配的全封闭式控制。
日本特开昭61-201304号公报中的半封闭式控制能够进行利用了半封闭式控制的特性高速操作。然而,难以预测根据温度变化以及随时间推移而改变的传递误差,因此存在难以满足所需精度的问题。
另一方面,日本特开平7-225615号公报中的全封闭式控制存在由于无法测量振动现象、因此如提升运转速度(电机校正的增益)则会导致振荡的问题。由此,日本特开平7-225615号公报中的全封闭式控制具有动作速度(位置校正)迟滞的问题。
出于提高全封闭式控制的速度的目的,提出了日本特开2011-176913号公报。日本特开2011-176913号公报中的全封闭式控制采用如下结构:已消除造成位置校正的迟滞的首要因素,从而认为在机器人动作中能够同时实现精度和速度。然而,全封闭式控制在如下几点与半封闭式控制不同:在传感器与电机之间存在传递机构,并且传递机构的特征在于具有齿隙、摩擦、及以比上述简谐运动频率更高的固有振动。即使在日本专利特开2011-176913号公报中的全封闭式控制中,由于齿隙、摩擦、以及比上述简谐运动频率更高的固有振动,因此也存在如提升运转速度(电机校正的增益)则会导致振荡的问题。因此,即使在日本特开2011-176913号公报中的全封闭式控制中,也存在由于将发生高阶振动因此无法充分提高增益、因而无法进行高速驱动的问题。
发明内容
本发明提供一种针对能够快速精准地控制移动构件的移动的电机驱动设备的控制设备、多轴电机驱动设备的控制设备、以及针对该电机驱动设备的控制方法。
本发明提供一种针对被构造为经由连接到电机的传递机构进行移动构件的移动控制的电机驱动设备的控制设备。所述控制设备包括:推力控制单元,其被构造为基于输入的推力命令值生成用于所述电机的位置命令值;以及电机控制单元,其被构造为基于用于所述电机的所述位置命令值生成控制所述电机的电流值。所述电机控制单元根据电机位置检测单元的检测结果执行第一反馈控制,所述电机位置检测单元被构造为检测输出所述电机的旋转的输出构件的位置。所述推力控制单元根据推力检测单元的检测结果执行第二反馈控制,所述推力检测单元被构造为检测在所述移动构件上发生的推力。
本发明提供一种用于多轴电机驱动设备的控制设备,所述多轴电机驱动设备具有经由连接到电机的传递机构进行移动构件的移动控制的多个电机驱动设备,其中,以一个电机驱动设备的移动构件支撑另一电机驱动设备的电机的方式串联地连接。对应于各电机驱动设备,所述控制设备包括:驱动设备控制单元,其被构造为基于从外部输入的用于移动构件的位置命令值,来生成推力命令值;推力控制单元,其被构造为基于生成的所述推力命令值,来生成所述电机的位置命令值;以及电机控制单元,其被构造为基于用于所述电机的所述位置命令值,来生成控制所述电机的电流值。各电机控制单元根据电机位置检测单元的检测结果执行第一反馈控制,所述电机位置检测单元被构造为检测输出所述电机的旋转的输出构件的位置。各推力控制单元根据推力检测单元的检测结果执行第二反馈控制,所述推力检测单元被构造为检测在移动构件上发生的推力。各驱动设备控制单元根据来自被构造为检测所述移动构件的位置的移动构件位置检测单元的检测结果,来执行第三反馈控制。
本发明提供一种电机驱动设备的控制方法,所述电机驱动设备被构造为经由连接到电机的传递机构进行移动构件的移动控制。所述控制方法包括:推力控制过程,基于输入的推力命令值生成用于所述电机的位置命令值;电机控制过程,基于用于所述电机的所述位置命令值生成控制所述电机的电流值;以及反馈过程,其中根据被构造为检测输出所述电机的旋转的输出构件的位置的电机位置检测单元的检测结果,在所述电机控制过程中进行第一反馈控制,以及根据被构造为检测在所述移动构件上发生的推力的推力检测单元的检测结果,在所述推力控制过程中进行第二反馈控制。
根据本发明,推力控制单元根据检测在移动构件上发生的推力的推力检测单元的检测结果来执行第二反馈控制。相应地,经由传递机构传递至移动构件的推力可以参仿输入的推力命令值,从而可以使移动构件的操作精准。另外,在移动构件上生成的推力还包括根据温度变化以及随时间推移而改变的传递误差分量,从而可以执行有效抑制传递误差的反馈控制。
电机控制单元根据检测输出电机旋转的输出构件的位置的电机位置检测单元的检测结果来对由推力控制单元生成的电机的位置命令值执行第一反馈控制。在电机中发生的传递机构的弹性反作用包括由于在传递机构的齿隙、摩擦、固有振动等的效果导致的振动现象的分量,并且这些振动现象可以被快速地抑制。
以这种方式,在抑制由于传递机构引起的振动现象和传递误差的同时能够使得动作速度增加,这使得能够快速精准地进行移动构件的移动控制。另外,振动现象和传递误差的有效抑制意味着电机增益的校正能够被提高,而且动作速度能够被提高。因此,能够实现具有全封闭式控制的精度以及相当于半封闭式控制的运动速度的布置。
根据以下参照附图对示例性实施例的描述,本发明的其他特征将变得清楚。
附图说明
图1是例示单轴机器人系统的整体示意图。
图2是例示单轴机器人系统的示意图。
图3是例示根据第一实施例的控制器的控制系统的框图。
图4是例示根据第一实施例的控制的流程图。
图5A和图5B是例示单轴机器人的转矩控制的实验结果的图,图5A示出根据第一实施例的控制的实验结果,图5B示出根据比较示例的控制的实验结果。
图6是例示根据第二实施例的控制器的控制系统的框图。
图7是例示根据第三实施例的控制器的控制系统的框图。
图8是例示根据第三实施例的控制的流程图。
图9是例示根据第四实施例的控制器的控制系统的框图。
图10是例示根据第四实施例的控制的流程图。
图11是例示根据第五实施例的控制器的控制系统的框图。
图12是例示根据第五实施例的控制的流程图。
图13A和图13B是例示单轴机器人的位置控制的实验结果的图,图13A示出根据第五实施例的控制的实验结果,图13B示出根据比较示例的控制的实验结果。
图14是例示双轴机器人系统的整体示意图。
图15是例示双轴机器人系统中的根据第六实施例的控制器的控制系统的框图。
图16是根据第七实施例的关节的分解图。
图17是根据第七实施例的关节的示意图。
图18是根据第七实施例的关节的示意图。
图19是根据第七实施例的关节的示意图。
图20是根据第八实施例的关节的分解图。
图21是根据第八实施例的关节的示意图。
具体实施方式
第一实施例
以下将参照图1至图5B来描述本发明的第一实施例。图1是例示单轴机器人系统的整体示意图。图2是例示单轴机器人系统的示意图。图3是例示根据第一实施例的控制器的控制系统的框图。图4是例示根据第一实施例的控制的流程图。图5A和图5B是例示单轴机器人的转矩控制的实验结果的图,其中图5A示出根据第一实施例的控制的实验结果,图5B示出根据比较示例的控制的实验结果。图1及图2所示的单轴机器人系统11一般具有与后述的第二至第五实施例中的相同结构,从而共同使用附图。然而,第一实施例可以被配设为不具有后述的设备编码器108。
单轴机器人系统11被构造为包括具有单个关节的单轴机器人臂(电机驱动设备)100,控制器(用于电机驱动设备的控制设备)101,以及示范终端设备(示教盒)102。示范终端设备102是用于用户向控制器101提供操作机器人臂100的指令的设备,并且包括如图1所示的由操作者操作的各种类型的开关、控制杆、显示屏等。示范点信息可以作为用于机器人臂100的位置命令值从示范终端设备102而输出,并且驱动转矩信息可以作为机器人臂100的推力命令值而输出。
另一方面,机器人臂100被构造为包括电机103、电机编码器(电机位置检测单元)104、减速器(传递机构)105、以及臂(移动构件)106。单轴机器人臂100还包括推力计(推力检测单元)107和设备编码器(移动构件位置检测单元)108。一般地,电机103和减速器105的组合被定义为进行臂106的动作驱动的关节。
电机103电连接到控制器101,从而被省略说明的输出轴(输出构件)的旋转状态由从控制器101输出的电流值控制。电机编码器104检测电机103的输出轴的旋转位置。减速器105机械连接到电机103的输出轴,并且减缓用于传递到臂106的电机103的输出旋转。推力计107被构造为利用例如变形计量仪等,根据使用弹性构件构造的框(减速器105的输出轴)的变形(扭转)检测输出到臂106的臂106的推力。设备编码器108检测臂106的旋转位置。
控制器101是所谓的服务器控制设备(计算机),并且包括中央处理单元(CPU)201、ROM 202、RAM 203、硬盘驱动器(HDD)204、外部接口205等等。如图1中所示,来自示范终端设备102的命令值(位置命令值PLref和推力命令值FLref)可以从外部接口205输入。另外,作为来自电机编码器104的电机103的角度的电机位置PM可以从外部接口205输入(能够反馈输入)。另外,来自推力计107的臂106的推力FL可以从外部接口205输入(能够反馈输入)。另外,作为来自设备编码器108的臂106的角度的设备位置PL可以从外部接口205输入(能够反馈输入)。而且,电流值IM可以从外部接口205输出到电机103。也就是说,控制器101基于来自示范终端设备102的命令值的输入来进行各种类型的反馈控制,并且将命令以电流值的形式输出到电机103。
这些电机103的电机位置PM、臂106的推力FL、以及臂106的设备位置PL用于通过利用控制器101的CPU 201进行算术处理的各种单元的反馈控制,稍后将参照图3来详细描述。注意,图3中所示的单元是将通过执行记录并存储在诸如ROM 202或HDD 204等的记录介质中的计算机可读程序的功能的处理,作为功能块的形式表现。当然,作为功能块例示的单元不限于通过软件功能实现,可以通过硬件结构(电子算术运算电路)实现。以下将参照图3来描述其从输入到输出的算术处理。
控制器101具有电机控制器3101。图3所示的根据第一实施例的电机控制器3101包括推力控制单元302、电机控制单元303、以及微分器(电机前馈(FF)控制单元)308。推力控制单元302基于从示范终端设备102输入的推力命令值FLref来生成用于电机103的位置命令值(下文中称为“电机位置命令值”)PMref。此时,推力控制单元302执行与作为检测在臂106所发生推力的推力计107的检测结果的推力FL对应的反馈控制(第二反馈控制)。
微分器308根据推力控制单元302生成的电机位置命令值PMref来生成用于电机控制单元303的前馈控制的前馈值。
电机控制单元303包括电机位置控制单元304、电机速度控制单元305、及电流控制单元306,并且基于电机位置命令值PMref来生成控制电机103的电流值IM。此时,电机控制单元303根据作为检测电机103的旋转位置的电机编码器104的检测结果的电机位置PM和电机速度VM来执行反馈控制(第一反馈控制)。
现在,将参照图3,遵照图4中的流程图来描述由控制器101进行的控制。首先,操作者操作示范终端设备102以输出来自示范终端设备102的推力命令值FLref,其被输入到推力控制单元302(S1)。接着,推力控制单元302通过将由推力计107检测到的推力FL反馈给推力命令值FLref来生成电机位置命令值PMref(推力控制过程)(S2)。微分器308通过电机位置命令值PMref的一阶微分生成电机速度FF命令值VMFFref,并且通过对电机位置命令值PMref二阶微分并乘以系数来生成电机推力FF命令值FMFFref(S3)。
在电机控制单元303内,电机位置控制单元304进行由电机编码器104检测的电机位置PM向电机位置命令值PMref的反馈(反馈处理)以生成电机速度命令值VMref(S4)。然后,电机速度控制单元305向电机速度命令值VMref前馈电机速度FF命令值VMFFref的同时,反馈根据电机编码器104通过对电机位置PM的微分获得的电机速度VM(反馈处理)。这样,电机速度控制单元305生成电机推力命令值FMref(S5)。电流控制单元306然后将电机推力FF命令值FMFFref前馈给电机推力命令值FMref,并且生成要被输出到电机103的电流值IM(电机控制处理,S6)。
每个控制周期执行上述控制。控制周期越短,计算精度越好,并且振动可以被抑制,但是需要更多的计算资源。
图5A例示了如上所述控制的单轴机器人系统11的实验结果。横轴代表以秒(s)为单位的时间,纵轴代表以牛顿米(Nm)为单位的转矩。驱动条件是-30Nm到30Nm的转矩,以及0.5s的转矩增加/减少时间。从实验结果可以看出响应于用作推力命令值的转矩命令,臂106的转矩从-30Nm驱动到30Nm。从实验结果还可以看出臂106的转矩在精度和速度上遵循转矩命令。
图5B例示了以一般半封闭式控制进行驱动的实验结果,作为比较示例。虽然全封闭式控制的比较示例是想得到的,但是由于控制范围不充足,性能低于半封闭式控制,所以在这里使用半封闭式控制来比较。驱动条件与以上相同。通过与根据本实施例的实验结果比较,可以看出本实施例呈现较少振动,误差小于5Nm。这样确认根据本实施例的控制较好。
这样,在通过根据本实施例的控制器101的控制中,推力控制单元302进行在臂106生成的推力FL对输入推力命令值FLref的反馈控制。因此,能够使经由减速器105传递给臂106的推力FL参仿已经输入的推力命令值FLref进行,从而能够精准地操作臂106。在臂106生成的推力FL还包括根据温度变化和随时间推移而改变的传递误差分量,从而可以执行传递误差也被有效抑制的反馈控制。
电机控制单元303将电机位置PM和电机速度VM在电机位置控制单元304和电机速度控制单元305反馈给推力控制单元302已生成的电机位置命令值PMref。因此,电机位置PM的反馈控制与如一般半封闭式控制中进行电机位置PM对电机位置命令值PMref的反馈相比不太容易受干扰影响。在电机103中发生的减速器105的弹性反作用包括由于减速器105的齿隙、摩擦、固有振动的效果等导致的振动现象的分量,但是这些振动现象可以被快速抑制。
以这种方式在抑制由于减速器105导致的振动现象和传递误差的同时能够增加操作速度,这使得臂106的动作控制能够被快速且精准地进行。另外,振动现象和传递误差的有效抑制意味着电机校正的增益可以被提高,而且操作速度可以被提高。因此,可以实现具有全封闭式控制的精度以及相当于半封闭式控制的运动速度的布置。
利用经微分器308的前馈控制还使得振动现象难以扩散,并且可以进一步地改善响应能力。注意,该前馈控制可以被省略,尽管性能会下降。在这种情况下,电机速度FF命令值VMFFref和电机推力命令值FMref被设为0。
虽然以单轴机器人臂100被控制的示例描述了本实施例,但是应用并不限于该结构。虽然本实施例进行了关于旋转关节的描述,但是传递机构可以是被构造为齿条齿轮机构等的伸缩关节。另外,传递机构并不限于为减速器,可以是放大机构。
另外,虽然本实施例描述了关于电机编码器104的检测结果被反馈给电机位置控制单元304和电机速度控制单元305二者的布置,但是这不是限制性的,可以通过仅利用一者或另外一者来使振动现象的抑制效果产生到一定程度。另外,可以进行对电机编码器104的检测结果微分以计算然后被反馈给电流控制单元306的电机加速度AM的布置。该布置也可以使振动现象的抑制效果实现到一定程度。
第二实施例
接着,将参照图6来描述作为上述第一实施例的部分变型的第二实施例。图6是例示根据第二实施例的控制器的控制系统的框图。
第一实施例被描述为利用推力计107检测传递至臂106的推力FL,第二实施例是关于检测技术的变型。也就是说,根据本实施例的控制器101中的电机控制器3102具有推力估计单元(推力检测单元)318。关系式FL=(PM-PL)×K成立,其中K代表包括减速器105的刚性的关节刚性系数。推力估计单元318计算通过向该表达式提供在电机编码器104检测的电机位置PM和在设备编码器108检测的设备位置PL来估计的推力FL。
如第二实施例中向电机控制器3102提供推力估计单元318使得能够免掉推力计107。注意可以通过将由在设备编码器108检测的设备位置PL的二阶微分获得的加速度与臂106的重量相乘来计算推力FL。然而,在例如向臂106的前缘侧配设更多关节以构造多关节型机器人的情况下,变得难以区分这是由于驱动此关节的加速度还是由于驱动另一关节的加速度,从而该技术不可使用。
第三实施例
接着,将参照图7和图8来描述作为上述第一实施例的部分变型的第三实施例。图7是例示根据第三实施例的控制器的控制系统的框图,图8是例示根据第三实施例的控制的流程图。
第三实施例具有配备有电机控制器理想模型计算单元(电机FF控制单元)309的电机控制器3103。电机控制器理想模型计算单元309具有对电机控制器建模而成的理想模型,而不是第一实施例中的微分器308。电机控制器的理想模型由对电机103的惯性建模而成的电机惯性虚拟模型、以及对控制给送给电机103的电力的供电电路建模而成的电路虚拟模型组成。电机控制器理想模型计算单元309假设已为电路虚拟模型设置预定控制增益,并且在输入电机位置命令值PMref的情况下,执行关于电机103的模型计算。因此,电机控制器理想模型计算单元309具有计算电机位置FF命令值PMFFref、电机速度FF命令值VMFFref、以及电机推力FF命令值FMFFref的功能。电机位置FF命令值PMFFref、电机速度FF命令值VMFFref、以及电机推力FF命令值FMFFref按照如下计算。
VMMref=PID(PMref-PMFFref)VMMref:模型电机速度命令
FMFFref=PID(VMMref-VMFFref)
ACCMFFref=FMFFref/MM MM:电机惯量或质量
VMFFref=∫ACCMFFrefdt
PMFFref=∫VMFFrefdt
在以这种方式构造的控制器101的控制中,如图8中所示,按照步骤S3-2和S4-2的形式对第一实施例中图4所示的控制进行改变。具体地,步骤S1和S2首先以与第一实施例中相同的方式被执行。在步骤S3-2中,电机控制器理想模型计算单元309根据电机控制器理想模型生成电机位置FF命令值PMFFref、电机速度FF命令值VMFFref、以及电机推力FF命令值FMFFref。在步骤S4-2中,电机位置控制单元304将由电机编码器104检测的电机位置PM反馈给电机位置FF命令值PMFFref,并生成电机速度命令值VMref。在下文中,以与第一实施例中相同的方式来执行步骤S5和S6,由此生成用于输出到电机103的电流值IM。
每控制周期执行上述控制。控制周期越短,计算精度越好,并且振动可以被抑制,但是需要更多的计算资源。
虽然从图7中省略了对干扰校正功能的例示,但是该功能优选以设备观察器单元的形式被添加。设备观察器单元估计作用在电机103的输出轴上的干扰Dist,乘以系数以生成干扰推力Fd,并加到电机推力命令值FMref。这样,作用于臂106上的干扰可以被反映在电机103的推力中,由于电机103的输出轴与臂106之间的干扰转矩导致的差的位置精度、及其计算误差、以及摩擦的变化可以被避免,由此改善设备位置PL的精度。如下地计算干扰Dist。
Dist=ACCM×MM-IM×KF KF:推力常量
这样,电机控制器理想模型计算单元309可以根据电机控制理想模型来计算电机位置FF命令值PMFFref、电机速度FF命令值VMFFref、以及电机推力FF命令值FMFFref,由此振动现象可以被抑制。
第四实施例
接着,将参照图9和图10来描述作为上述第三实施例的部分变型的第四实施例。图9是例示根据第四实施例的控制器的控制系统的框图。图10是例示根据第四实施例的控制的流程图。
第四实施例是给第三实施例中的控制器101配设动力学模型计算单元(动力学模型控制单元)320以及推力传递单元物理属性单元316的结构。控制器101还配设有具有设备位置控制单元(移动构件位置控制单元)313和设备速度控制单元(移动构件速度控制单元)314的设备控制器(驱动设备控制单元)301。动力学模型计算单元320具有根据动力学对机器人臂100建模而成的动力学模型。该动力学模型是包括臂长度、臂重量、以及惯性积(机器人臂100的链路参数)的模型。动力学模型计算单元320计算从示范终端设备102输入的位置命令值PLref、以及通过对其微分获得的速度命令值和加速度命令值。动力学模型计算单元320还用以根据动力学模型基于这些值来计算进行臂106的动作控制必须的期望的推力(动力学推力预测值)FLEref。考虑到重量、粘度、摩擦等等计算期望的推力FLEref。另外,推力传递单元物理属性单元(扭转量控制单元)316预先计算实现期望的推力FLEref的扭转量的预测量PTref(下文中称为“扭转量”)。可以根据以下给出作为一个示例的表达式来计算扭转量PTref。
PTref=FTref/K K:关节刚性系数
设备控制器301具有设备位置控制单元313和设备速度控制单元314,并且基于从示范终端设备102输入的位置命令值PLref来计算要输入到推力控制单元302的推力命令值FLref。此时,设备控制器301根据作为检测臂106的旋转位置的设备编码器108的检测结果的设备位置(臂位置)PL和设备速度(臂速度)VL来执行反馈控制(第三反馈控制)。
在以这种方式构造的控制器101的控制中,如图10中所示,按照添加的步骤S11到S16、改变的步骤S3-3的形式对第三实施例在图8所示的控制作出改变。首先,操作者操作示范终端设备102以从示范终端设备102输出位置命令值PLref,其被输入到动力学模型计算单元320和设备位置控制单元313(S11)。动力学模型计算单元320基于位置命令值PLref根据动力学模型来生成期望的推力FLEref(S12)。推力传递单元物理属性单元316生成实现期望的推力FLEref的扭转量PTref(S13)。
另一方面,设备位置控制单元313将由设备编码器108检测的设备位置PL反馈给位置命令值PLref,并且生成设备速度命令值VLref(S14)。设备速度控制单元314将通过由设备编码器108检测的设备位置PL的微分获得的设备速度VL反馈给设备速度命令值VLref,并且生成推力命令值FLref(S15)。推力控制单元302在向推力命令值FLref反馈由推力计107检测的推力FL的同时前馈期望的推力FLEref,这样生成电机位置命令值PMref(S16)。
电机控制器理想模型计算单元309首先将电机位置命令值PMref与扭转量PTref相加。接着,基于其相加值,电机控制器理想模型计算单元309根据电机控制理想模型生成电机位置FF命令值PMFFref、电机速度FF命令值VMFFref、以及电机推力FF命令值FMFFref(S3-3)。之后,以与第三实施例中相同的方式来执行步骤S4-2、S5及S6,由此生成要被输出到电机103的电流值IM。
每控制周期执行上述控制。控制周期越短,计算精度越好,并且振动可以被抑制,但是需要更多的计算资源。
动力学模型计算单元320已被添加到第四实施例中,从而当位置命令值PLref被输入时,可以计算期望的推力FLEref。基于期望的推力FLEref生成推力命令值FLref,并且基于其生成电流值IM,从而臂106的位置被控制使得匹配机器人臂100的动力学模型,这意味着精确且迅速地进行控制。
另外,添加了推力传递单元物理属性单元316,从而可以预先计算实现期望的推力FLEref的扭转量PTref。该扭转量PTref被输入到电机控制单元303并且反映在电流值IM中,从而对应于期望的推力FLEref的臂106的推力FL的响应能力也改善。因此,关于位置命令值PLref的设备位置PL的响应能力也改善。
另外,添加了设备控制器301,从而可以反馈设备位置PL和设备速度VL。因此,即使在设备位置PL由于期望的推力FLEref中的建模误差、计算误差等导致与位置命令值PLref偏差的情况下,也可以进行反馈控制使得设备位置PL参仿位置命令值PLref,从而失准量可以被减少。
已经描述了关于动力学模型计算单元320、推力传递单元物理属性单元316、及设备控制器301全部三者都被提供的本实施例。然而,动力学模型计算单元320、推力传递单元物理属性单元316、及设备控制器301功能各自独立,从而可以做出仅具有这些的一者或二者的布置,在该情况下可以获得相应的效果。
第五实施例
接着,将参照图11至图13B来描述作为上述第四实施例的部分变型的第五实施例。图11是例示根据第五实施例的控制器的控制系统的框图。图12是例示根据第五实施例的控制的流程图。图13A和图13B是例示单轴机器人的位置控制的实验结果的图。图13A示出根据第五实施例的控制的实验结果,图13B示出根据比较示例的控制的实验结果。
第五实施例是控制器101配设了设备控制器理想模型计算机单元(驱动设备FF控制单元)307、及设备观察器单元(监视控制单元)317的第四实施例的结构。设备控制器理想模型计算机单元307具有使得能够进行臂106的理想行为的设备控制器理想模型。设备控制器理想模型由整个机器人臂100的虚拟模型、以及控制臂106的位置和速度的控制电路的虚拟模型组成。设备控制器理想模型计算机单元307假设预定控制增益已被设置给设备控制器理想模型内的控制电路的虚拟模型,并且在位置命令值PLref已从示范终端设备102被输入的情况下,执行关于臂106的模型计算。这样,设备控制器理想模型计算机单元307具有计算设备位置FF命令值PLFFref、设备速度FF命令值VLFFref、以及设备推力FF命令值FLFFref的功能。设备位置FF命令值PLFFref、设备速度FF命令值VLFFref、以及设备推力FF命令值FLFFref按照如下计算。
VLFFref=PID(PLref-PLFFref)
FLFFref=PID(VLFFref-VLFFref)
ACCLFFref=FLFFref/ML ML:电机惯量或质量
VLFFref=∫ACCLFFrefdt
PLFFref=∫VLFFrefdt
VMLref=PID(PLref-PLFFref)VMLref:模型设备速度命令
设备观察器单元317估计作用于电机103的输出轴的干扰Dist,乘以系数以生成干扰推力Fd,并且反馈给电机推力命令值FMref(第四反馈控制)。通过将对设备速度VL进行微分获得的设备加速度AL与通过将推力FL和质量或二次惯性矩相乘获得的期望的设备加速度的差,除以质量或二次惯性矩来计算干扰Dist。
在以这种方式构造的控制器101的控制中,如图12中所示,按照添加了步骤S21和S22、改变了的步骤S14-2、S15-2、S16-2及S3-4的形式对第四实施例中图8所示的控制作出改变。首先,操作者操作示范终端设备102以从示范终端设备102输出位置命令值PLref,其被输入到动力学模型计算单元320和设备位置控制单元313(S11)。动力学模型计算单元320基于位置命令值PLref根据动力学模型来生成期望的推力FLEref(S12)。推力传递单元物理属性单元316生成实现期望的推力FLEref的扭转量PTref(S13)。
另一方面,设备控制器理想模型计算机单元307基于位置命令值PLref根据设备控制器理想模型来生成设备位置FF命令值PLEFref、设备速度FF命令值VLFFref以及设备推力FF命令值FLFFref(S21)。设备位置控制单元313将由设备编码器108检测的设备位置PL反馈给设备位置FF命令值PLFFref,并且生成设备速度命令值VLref(S14-2)。设备速度控制单元314向设备速度命令值VLref反馈通过对来自设备编码器108的设备位置PL的微分获得的设备速度VL的同时,还前馈设备速度FF命令值VLFFref,并且生成推力命令值FLref(S15-2)。设备观察器单元317根据由设备编码器108输出的设备位置PL获得的设备速度VL以及由推力计107检测的推力FL获得的设备速度VL,来生成干扰推力Fd(S22)。推力控制单元302向推力命令值FLref反馈推力FL并进一步反馈干扰推力Fd的同时前馈设备推力FF命令值FLFFref,这样生成电机位置命令值PMref(S16-2)。
电机控制器理想模型计算单元309首先将电机位置命令值PMref、扭转量PTref、及设备位置FF命令值PLFFref相加。电机控制器理想模型计算单元309然后基于该相加值、根据电机控制理想模型,生成电机速度FF命令值VMFFref、电机推力FF命令值FMFFref及电机位置FF命令值PMFFref(S3-4)。之后,以与第四实施例中相同的方式来执行步骤S4-2、S5及S6,由此生成要被输出到电机103的电流值IM。
每控制周期执行上述控制。控制周期越短,计算精度越好,并且振动可以被抑制,但是需要更多的计算资源。
设备控制器理想模型计算机单元307已被添加到如上所述的第五实施例中。因此,实现设备位置FF命令值PLFFref的设备速度FF命令值VLFFref和设备推力FF命令值FLFFref被前馈,改善了设备位置FF命令值PLFFref的响应能力。也就是说,通过添加设备控制器理想模型计算机单元307改善了响应能力。然而,存在进行位置命令值PLref被添加到电机位置命令值PMref的前馈引起设备控制器301的目标值与前馈给电机位置命令值PMref的值之间的失匹配、并且精度劣化的问题。为了处理该问题,将设备位置FF命令值PLFFref加到电机位置命令值PMref使得设备控制器301的目标值与前馈给电机位置命令值PMref的值匹配,这样可以避免精度的劣化。
另外,添加了设备观察器单元317。结果是,由于电机103与臂106之间的干扰转矩及其计算误差、及摩擦的变化引起的位置精度的劣化可以被避免,由此提高了设备位置PL的精度。
图13A例示了如上所述控制的单轴机器人系统11的实验结果。利用作为旋转关节的机器人臂100进行了该实验,使得其位置以度为单位来表现。在图13A中,纵轴代表设备角度,横轴以秒(s)代表时间。驱动条件是-50度的移动量以及0.5s的移动时间。可以看出当如上方的图中通过位置命令值PLref从0被驱动到-50度时,最大位置偏差是如下方的图中的细微的0.05度。在加速期间也几乎不出现任何偏差。
图13B例示了作为比较示例根据一般的半封闭式控制而控制的实验结果。虽然驱动条件与如上的那些相同,但是在加速时的位置偏差被发现为0.3度,与本实施例的实验结果相比要大,尽管条件不严格。也就是说,通过本实施例,加速时的位置偏差削减为1/6。
根据本实施例的单轴机器人系统11被控制使得经由预先提供的多个示教点串定义的路径来操作臂106。该路径可以遵循从具有速度和精度的一个动作的开始点到结束点,而不会由于电机103的输出轴与臂106之间(即,在减速器105)的推力干扰而在机器人中产生任何振动。
第六实施例
接着,将参照图14和图15来描述作为上述第五实施例的部分变型的第六实施例。图14是例示双轴机器人系统的整体示意图,图15是例示双轴机器人系统中的根据第六实施例的控制器的控制系统的框图。
图14中所示的双轴机器人系统12具有第二关节以及臂116,臂116由串联地连接到图1所示的单轴机器人系统11的臂106的关节来驱动。也就是说,根据第六实施例的双轴机器人臂(多轴电机驱动设备)100包括电机103、电机编码器104、减速器105、臂106、推力计107以及设备编码器108。机器人臂100还包括被臂106支撑的电机113、电机编码器114、减速器115、臂116、推力计117、以及设备编码器118。控制器101连接到这两个电机103和113。
图15所示的控制器101一般包括分别对应于这两个电机103和113的设备控制器301A和电机控制器310A,以及设备控制器301B和电机控制器310B。动力学模型计算单元(多轴动力学模型控制单元)320具有被整合成一体的、根据动力学对整个机器人臂100建模而成的动力学模型。也就是说,动力学模型计算单元320具有利用单个动力学模型来计算控制这两个臂106和116的移动所必须的期望的推力FLEref1和FLEref2的功能。
具有该双轴机器人臂100的双轴机器人系统12也被控制使得经由预先提供的多个示教点串定义的路径来操作。与被控制的轴向的数量无关地,移动期间的路径可以遵循从具有速度和精度的一个动作的开始点到结束点,而不会由于轴向间的推力干扰而在机器人中产生任何振动。
虽然第六实施例被描述作为双轴机器人臂100,但是其可以是具有三个或更多个轴向的N轴向关节型机器人臂。动力学模型计算单元320能够计算在存在多轴向的一般情况下电机的输出轴与减速器之间的干扰推力。因此,可以通过改变以下三点来控制多个轴向。第一点是输入到动力学模型计算单元320的位置命令值PLref被改变为分别对应于多个轴向(N个轴向)的位置命令值PLref1至PLrefN。第二点是从动力学模型计算单元320输出的期望的推力FLEref被改变为分别对应于多个轴向(N个轴向)的期望的推力FLEref1至FLErefN。第三点是根据N个关节提供N个设备控制器301和电机控制器310的各个,并且输入其第n个关节处理控制的位置命令值PLrefN和期望的推力FLErefN。使用的设备控制器301和电机控制器310与第四和第五实施例中的相同。在这种情况下,控制多关节型机器人臂的控制器被包括在机器人设备的控制设备中。也就是说,机器人设备的控制设备可构想为被构造为包括控制关节的多个控制器,以及向这些控制器输出位置命令值的更高级别的计算机。
具有该多关节型机器人臂的双轴机器人系统也被控制使得经由预先提供的多个示教点串定义的路径操作。与被控制的轴的数量无关地,移动期间的路径可以遵循从具有速度和精度的一个动作的开始点到结束点,而不会由于轴向间的推力干扰而在机器人中产生任何振动。
在考虑到轴向间的推力干扰而利用动力学模型计算单元320控制多个轴向的情况下,在具有多关节型机器人臂的机器人系统中通过从干扰的计算值中减去干扰推力的计算值,精度也得到提高。将计算的干扰推力与推力命令值FLref相加(前馈)进一步提高了设备位置FF命令值PLFFref的响应能力。
虽然在第一至第六实施例中描述了示范终端设备102被用于对控制器101应用推力命令值和位置命令值的布置,但是这不是限制性的。例如,推力命令值和位置命令值可以从管理控制器101的单独计算机等被应用给控制器101。在这种情况下,控制器101具有的单元的功能可以被另一计算机保持。也就是说,哪些软件功能被安装在伺服控制设备与跟其连接的另一计算机之间的哪些硬件结构中是设计自由度的问题。
本发明还可以通过利用读出并执行实现上述实施例的一个以上功能的程序的系统或设备的计算机中的一个或多个处理器经由网络或存储介质向系统或设备提供所述程序来实现本发明。本发明还可以通过实现一个或多个功能的电路(例如,应用专用集成电路(ASIC))来被实现。第七实施例
将参照图16到图19来描述关节的结构的特定示例作为第七实施例。图16是根据第七实施例的关节的分解图。图17是根据第七实施例的关节的示意图。
高速旋转轴穿过减速器105的主体,并且通过结合件109结合到作为电机103的输出轴的轴。减速器105的主体结合到电机103的主体,并且通过电机轴的旋转而旋转。
减速器105的驱动凸缘穿过中空结构的推力计107而结合到臂106。减速器105被构造为使得驱动凸缘以通过电机103旋转的减速器105的主单元的旋转而降低的转数旋转。设备编码器108的轴经由结合件119结合到减速器105的高速旋转轴。设备编码器108的主体而结合到臂106或减速器105的驱动凸缘。根据该结构,关于减速器105的高速旋转轴的旋转(即,电机旋转)的臂106或减速器105的驱动凸缘的位置可以被检测。
图17是在设备编码器108的主体结合到臂106的情况下的关节的示意图。设备编码器108从臂106突出,如图17中所示。
图18是例示设备编码器108被设在具有中空结构的推力计107的中心部分从而集为一体的情况的示意图。该结构使得能够在相同位置测量设备的推力和位置,因此周期偏差可以被抑制。推力计107、设备编码器108以及减速器105单独形成,从而可以在不受减速器105中产生的振动和热量的影响的情况下进行测量。
设备编码器108以减速器105的高速旋转轴的旋转(即,电机旋转)作为参照,来测量臂106或减速器105的驱动凸缘的位置。因此,必须根据高速旋转轴(电机编码器104)的位置进行校正以利用电机的旋转作为参照来做出测量。在通过这两个编码器的检测的方向相同的情况下(诸如针对这二者来说,顺时针方向为正),通过从设备编码器108的检测值中减去电机编码器104的检测值来校正臂106的位置。
虽然进行了设备编码器108的主单元结合至臂106或减速器105的驱动凸缘的描述,但是可以做出设备编码器108结合至推力计107的布置。图19是设备编码器108与推力计107已结合的关节的示意图。臂106和设备编码器108可以一体化,如图19中所示。
第八实施例
将参照图20和图21来描述关节的结构示例作为第八实施例。图20是关节的分解图。图21是关节的示意图。
减速器105的高速旋转轴通过结合件109结合至电机103的轴。减速器105的主单元结合至电机103的主单元。减速器105的驱动凸缘穿过推力计107结合到臂106。设备编码器108的轴经由结合件109,结合到减速器105的驱动凸缘或推力计107或臂106。设备编码器108的主体结合到减速器105的主单元或者被结合到电机的编码器附加结构120。该结构使得能够在相同位置测量推力和位置,而无需使用前述校正。
其他实施例
还可以通过读出并执行记录在存储介质(还可以被更完整地为“非临时性计算机可读存储介质”)上的用于执行一个或多个上述实施例的功能的计算机可执行指令(例如,一个或多个程序)以及/或包括用于进行上述实施例的一个或多个的功能的一个或多个电路(例如,专用集成电路(ASIC))的系统或装置的计算机来实现本发明的各实施例,以及通过系统或装置的计算机通过例如从存储介质读出并执行用于执行一个或多个上述实施例的功能的计算机可执行指令以及/或控制一个或多个电路来进行一个或多个上述实施例的功能的方法来实现本发明的各实施例。计算机可以包括一个或多个处理器(例如,中央处理单元(CPU)、微处理单元(MPU)),并且可以包括独立的计算机或独立的处理器的网络,以读出并执行计算机可执行指令。计算机可执行指令可以例如从网络或存储介质被提供给计算机。存储介质可以包括例如硬盘、随机存取存储器(RAM)、只读存储器(ROM)、分布式计算系统的存储器、光盘(诸如压缩光盘(CD)、数字通用光盘(DVD)或蓝光光盘(BD)TM)、闪存设备、存储卡等中的一个或多个。
虽然参照示例性实施例对本发明进行了描述,但是应当理解,本发明并不限于所公开的示例性实施例。应当对所附权利要求的范围给予最宽的解释,以使其涵盖所有这些变型例以及等同的结构和功能。
Claims (9)
1.一种机器人设备,所述机器人设备具有经由连接到电机的减速器驱动的移动构件,所述机器人设备包括:
所述减速器,其连接到所述电机的输出轴;
第一位置检测单元,其被构造为检测输出所述电机的旋转的输出构件的位置;
第二位置检测单元,其被构造为检测经由所述减速器移动的所述移动构件的位置;
被构造为支撑所述第二位置检测单元的结构;以及
控制单元,其被构造为控制所述电机,
其中,所述电机、所述减速器、所述第一位置检测单元和所述第二位置检测单元一体地配设,并且所述控制单元根据所述第一位置检测单元的检测结果和所述第二位置检测单元的检测结果来获得在移动构件处发生的推力。
2.根据权利要求1所述的机器人设备,
其中,所述结构包括:
第一构件,其连接到电机或减速器中的至少一者并且从与电机或减速器中的至少一者的连接位置沿垂直于输出轴的旋转轴的方向延伸,
第二构件,其连接到第一构件并从与第一构件的连接位置沿平行于旋转轴的方向延伸,以及
第三构件,其连接到第二构件并且被构造为支撑所述第二位置检测单元,使得所述第二位置检测单元布置在从旋转轴延伸的线上。
3.根据权利要求1所述的机器人设备,
其中,所述电机包括电机主单元,
其中,所述输出构件从电机主单元突出,
其中,所述减速器包括减速器主单元和由输出构件旋转的减速器输入轴,
其中,所述减速器输入轴从减速器主单元突出,
其中,所述减速器的减速器输入轴和所述电机的输出轴经由第一结合部连接,并且所述电机和所述减速器通过连接电机主单元和减速器主单元而一体地固定,
其中,所述结构在所述结构支撑所述第二位置检测单元的状态下连接到所述电机主单元或所述减速器主单元。
4.根据权利要求3所述的机器人设备,
其中,所述第二位置检测单元包括用于检测输出构件或移动构件的位置的轴,并且
其中,相对于所述结构与所述电机主单元或所述减速器主单元连接的连接位置,所述第二位置检测单元被支撑在与设置电机的一侧相反的相反侧上,并且被支撑在设置输出构件和移动构件的一侧,并且轴经由第二结合部连接到输出构件或移动构件。
5.一种制造物品的方法,所述方法使用根据权利要求1至4中任意一项所述的机器人设备。
6.一种电机驱动设备,其被构造为经由连接到电机的减速器进行对移动构件的移动控制,所述电机驱动设备包括:
第一位置检测单元,其被构造为检测输出所述电机的旋转的输出构件的位置;
第二位置检测单元,其被构造为检测经由所述减速器移动的所述移动构件的位置;
被构造为支撑第二位置检测单元的结构;以及
控制单元,其被构造为控制所述电机,
其中,所述电机、所述减速器、所述第一位置检测单元和所述第二位置检测单元一体地配设,并且所述控制单元根据所述第一位置检测单元的检测结果和所述第二位置检测单元的检测结果来获得在移动构件处发生的推力。
7.一种控制方法,其用于控制根据权利要求1所述的机器人设备,其中,基于所述推力,所述控制单元控制所述电机并且控制所述移动构件。
8.一种控制方法,其用于控制根据权利要求6所述的电机驱动设备,其中,基于所述推力,所述控制单元控制所述电机并控制所述移动构件。
9.一种非暂态计算机可读存储介质,其存储能够执行根据权利要求7或8所述的控制方法的控制程序。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2014-236150 | 2014-11-21 | ||
JP2014236150 | 2014-11-21 | ||
CN201510796074.5A CN105619424B (zh) | 2014-11-21 | 2015-11-18 | 电机驱动设备的控制设备及方法、多轴电机的控制设备 |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510796074.5A Division CN105619424B (zh) | 2014-11-21 | 2015-11-18 | 电机驱动设备的控制设备及方法、多轴电机的控制设备 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110076773A CN110076773A (zh) | 2019-08-02 |
CN110076773B true CN110076773B (zh) | 2023-04-07 |
Family
ID=54695561
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510796074.5A Active CN105619424B (zh) | 2014-11-21 | 2015-11-18 | 电机驱动设备的控制设备及方法、多轴电机的控制设备 |
CN201910308221.8A Active CN110076773B (zh) | 2014-11-21 | 2015-11-18 | 机器人设备、制造物品的方法及电机驱动设备 |
Family Applications Before (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510796074.5A Active CN105619424B (zh) | 2014-11-21 | 2015-11-18 | 电机驱动设备的控制设备及方法、多轴电机的控制设备 |
Country Status (4)
Country | Link |
---|---|
US (2) | US10029366B2 (zh) |
EP (1) | EP3023208B1 (zh) |
JP (2) | JP6664138B2 (zh) |
CN (2) | CN105619424B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10029366B2 (en) * | 2014-11-21 | 2018-07-24 | Canon Kabushiki Kaisha | Control device for motor drive device, control device for multi-axial motor, and control method for motor drive device |
CN108025431A (zh) | 2015-09-14 | 2018-05-11 | 拓诺麦公司 | 致动器诊断和预测 |
FR3054158B1 (fr) * | 2016-07-21 | 2019-06-28 | Comau France | Machine-outil d’usinage |
JP6460138B2 (ja) * | 2017-03-13 | 2019-01-30 | オムロン株式会社 | 処理装置、制御パラメータ決定方法、及び制御パラメータ決定プログラム |
JP6838837B2 (ja) * | 2017-03-30 | 2021-03-03 | 株式会社ミツバ | ブラシレスモータの制御装置 |
US10773352B2 (en) * | 2017-06-05 | 2020-09-15 | Joy Global Underground Mining Llc | System and method for determining efficiency of an industrial machine |
CN108173475B (zh) | 2018-02-11 | 2020-06-02 | 矽力杰半导体技术(杭州)有限公司 | 电机驱动装置和电机 |
CN109108967B (zh) * | 2018-08-16 | 2021-03-30 | 深圳市歌尔泰克科技有限公司 | 电机补偿方法、驱动器、机械臂关节模组及机械臂 |
CN109159120B (zh) * | 2018-09-10 | 2022-07-12 | 南京邮电大学 | 基于康复机械臂关节电机电流反馈的主动控制方法及系统 |
CN110135119B (zh) * | 2019-06-11 | 2020-04-17 | 武汉理工大学 | 一种考虑桥壳结构的主减速器主动齿轮支撑刚度计算方法 |
EP3753682B1 (de) | 2019-06-17 | 2021-12-29 | Schneider Electric Industries SAS | Verfahren zur steuerung eines antriebsmotors |
CN114434450B (zh) * | 2022-04-08 | 2022-07-26 | 智昌科技集团股份有限公司 | 基于轨迹优化控制的柔性关节抖动抑制方法及系统 |
CN116988693B (zh) * | 2023-09-27 | 2023-12-01 | 深圳市顺力电机有限公司 | 一种电机的驱动控制方法与装置 |
Family Cites Families (87)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3279624A (en) * | 1962-09-26 | 1966-10-18 | George C Devol | Programmed article handling |
JPS57138583A (en) * | 1981-02-16 | 1982-08-26 | Toyama Machine Works | Controller for pressure for balance |
JPS57138582A (en) * | 1981-02-16 | 1982-08-26 | Toyama Machine Works | Balancer |
US4657104A (en) * | 1983-07-23 | 1987-04-14 | Cybermation, Inc. | Concentric shaft mobile base for robots and the like |
US4573548A (en) * | 1983-07-23 | 1986-03-04 | Cybermation, Inc. | Mobile base for robots and the like |
US4611377A (en) * | 1984-06-04 | 1986-09-16 | Eoa Systems, Inc. | Interchangeable robot end-of-arm tooling system |
JPS61201304A (ja) | 1985-03-04 | 1986-09-06 | Matsushita Electric Ind Co Ltd | ロボツトの位置制御法 |
JPS6220904A (ja) * | 1985-07-19 | 1987-01-29 | Matsushita Electric Ind Co Ltd | 流体サ−ボ装置 |
US5155423A (en) * | 1986-02-18 | 1992-10-13 | Robotics Research Corporation | Industrial robot with servo |
US4828453A (en) * | 1987-04-21 | 1989-05-09 | The United States Of America As Represented By The United States Department Of Energy | Modular multimorphic kinematic arm structure and pitch and yaw joint for same |
US4925312A (en) * | 1988-03-21 | 1990-05-15 | Staubli International Ag | Robot control system having adaptive feedforward torque control for improved accuracy |
JPH0224078A (ja) * | 1988-07-12 | 1990-01-26 | Mitsubishi Heavy Ind Ltd | マニピュレータ制御装置 |
US5144549A (en) * | 1990-06-29 | 1992-09-01 | Massachusetts Institute Of Technology | Time delay controlled processes |
US5397212A (en) * | 1992-02-21 | 1995-03-14 | Ebara Corporation | Robot with dust-free and maintenance-free actuators |
JP3217522B2 (ja) | 1992-03-02 | 2001-10-09 | キヤノン株式会社 | 精密位置決め装置 |
US5349337A (en) * | 1992-12-15 | 1994-09-20 | Eoa Systems, Inc. | Apparatus and method for controlling peck drilling |
US6535794B1 (en) * | 1993-02-23 | 2003-03-18 | Faro Technologoies Inc. | Method of generating an error map for calibration of a robot or multi-axis machining center |
US5656903A (en) * | 1993-10-01 | 1997-08-12 | The Ohio State University Research Foundation | Master-slave position and motion control system |
US5420489A (en) * | 1993-11-12 | 1995-05-30 | Rockwell International Corporation | Robotic end-effector with active system compliance and micro-positioning capability |
JPH07225615A (ja) | 1994-02-14 | 1995-08-22 | Matsushita Electric Ind Co Ltd | フルクローズドループ位置制御サーボドライバ |
JP3324298B2 (ja) * | 1994-10-19 | 2002-09-17 | 株式会社豊田中央研究所 | マニピュレータの制御装置 |
JPH08323670A (ja) * | 1995-05-26 | 1996-12-10 | Toyota Central Res & Dev Lab Inc | マニピュレータの制御装置 |
US6028593A (en) * | 1995-12-01 | 2000-02-22 | Immersion Corporation | Method and apparatus for providing simulated physical interactions within computer generated environments |
US6633046B1 (en) * | 2000-04-19 | 2003-10-14 | Applied Materials, Inc. | Method and apparatus for detecting that two moveable members are correctly positioned relatively to one another |
CN2460968Y (zh) * | 2000-12-27 | 2001-11-21 | 中国科学院沈阳自动化研究所 | 基于传感器的谐波驱动装置 |
JP2003070284A (ja) | 2001-06-11 | 2003-03-07 | Sony Corp | サーボ・アクチュエータ並びにその位置検出装置 |
JP2003117877A (ja) * | 2001-10-17 | 2003-04-23 | Japan Servo Co Ltd | 多関節型の産業用ロボット |
JP3871030B2 (ja) * | 2001-10-25 | 2007-01-24 | 株式会社安川電機 | サーボ制御方法 |
JP2003216243A (ja) | 2002-01-18 | 2003-07-31 | Yaskawa Electric Corp | ロボットの制御装置 |
JP4247382B2 (ja) * | 2003-06-27 | 2009-04-02 | 独立行政法人 宇宙航空研究開発機構 | 回転機構用制御装置 |
US7672741B2 (en) * | 2003-07-24 | 2010-03-02 | Keio University | Position/force control device |
CN100584547C (zh) | 2003-07-29 | 2010-01-27 | 松下电器产业株式会社 | 控制机械手的方法 |
JP2005052913A (ja) * | 2003-07-31 | 2005-03-03 | Nachi Fujikoshi Corp | ロボット制御装置 |
EP1724653B1 (en) * | 2004-02-25 | 2014-05-07 | The Ritsumeikan Trust | Control system of floating mobile body |
WO2005105390A2 (en) * | 2004-04-27 | 2005-11-10 | Gorelik Vladimir A | Intrinsically stable neuromorphic motion controller |
JP4581543B2 (ja) * | 2004-08-02 | 2010-11-17 | 株式会社安川電機 | 減速機一体型アクチュエータおよびこれを備えたアクチュエータシステム |
JP2006211873A (ja) * | 2005-01-31 | 2006-08-10 | Canon Inc | 移動体制御装置及び移動体制御方法 |
US10080672B2 (en) * | 2005-03-31 | 2018-09-25 | Bionx Medical Technologies, Inc. | Hybrid terrain-adaptive lower-extremity systems |
DE112006002550T5 (de) * | 2005-09-26 | 2008-10-02 | Hitachi, Ltd. | Elektrisch betätigter Verstärker |
JP2007168507A (ja) * | 2005-12-20 | 2007-07-05 | Bridgestone Corp | インホイールモータシステム |
JP2007219830A (ja) * | 2006-02-16 | 2007-08-30 | Fanuc Ltd | 数値制御装置 |
CN100369724C (zh) * | 2006-02-28 | 2008-02-20 | 哈尔滨工业大学 | 空间机械臂模块化关节 |
US7348747B1 (en) * | 2006-03-30 | 2008-03-25 | Vecna | Mobile robot platform |
US8016893B2 (en) * | 2006-06-21 | 2011-09-13 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Gear bearing drive |
JP4801534B2 (ja) * | 2006-08-30 | 2011-10-26 | 本田技研工業株式会社 | ロボット関節機構 |
US7979160B2 (en) * | 2007-07-31 | 2011-07-12 | Spirit Aerosystems, Inc. | System and method for robotic accuracy improvement |
US20110040427A1 (en) * | 2007-10-31 | 2011-02-17 | Pinhas Ben-Tzvi | Hybrid mobile robot |
JP5060969B2 (ja) * | 2008-01-15 | 2012-10-31 | 住友重機械工業株式会社 | ロボットの関節駆動装置 |
JP4715863B2 (ja) * | 2008-05-01 | 2011-07-06 | ソニー株式会社 | アクチュエータ制御装置及びアクチュエータ制御方法、アクチュエータ、ロボット装置、並びにコンピュータ・プログラム |
US8277154B2 (en) * | 2008-05-30 | 2012-10-02 | The Boeing Company | Adaptive thrust sensor drilling |
JP5114804B2 (ja) * | 2008-07-10 | 2013-01-09 | 川崎重工業株式会社 | ロボット及びその教示方法 |
JP4540727B2 (ja) | 2008-07-31 | 2010-09-08 | 山洋電気株式会社 | モータ制御装置 |
WO2010027968A2 (en) * | 2008-09-04 | 2010-03-11 | Iwalk, Inc. | Hybrid terrain-adaptive lower-extremity systems |
JP5267787B2 (ja) * | 2008-09-24 | 2013-08-21 | 株式会社ジェイテクト | 減速装置へのモータ取付方法、モータ取付構造及び電動パワーステアリング装置 |
US8674586B2 (en) * | 2008-12-26 | 2014-03-18 | Nikon Corporation | Motor device, apparatus and driving method for rotor |
JP2010274396A (ja) * | 2009-06-01 | 2010-12-09 | Kawasaki Heavy Ind Ltd | 自動作業システムにおける位置ズレ補正方法及び位置ズレ補正プログラム |
JP5645423B2 (ja) | 2010-02-23 | 2014-12-24 | キヤノン株式会社 | 回転駆動装置及びロボットアーム |
JP5582293B2 (ja) | 2010-03-31 | 2014-09-03 | 日立オートモティブシステムズ株式会社 | 電動ブレーキ装置 |
CN101895252B (zh) | 2010-07-09 | 2012-06-06 | 上海新时达电气股份有限公司 | 电机伺服驱动器控制器参数自动调整装置及其方法 |
JP5365595B2 (ja) | 2010-09-15 | 2013-12-11 | 株式会社安川電機 | 減速機の異常判定方法、異常判定装置、ロボット及びロボットシステム |
WO2012050130A1 (ja) * | 2010-10-12 | 2012-04-19 | 株式会社ニコン | エンコーダ、駆動装置及びロボット装置 |
EP2453325A1 (en) * | 2010-11-16 | 2012-05-16 | Universal Robots ApS | Method and means for controlling a robot |
US20120215358A1 (en) * | 2011-01-31 | 2012-08-23 | Robotex Inc. | Robotic arm system |
JP5821210B2 (ja) * | 2011-02-22 | 2015-11-24 | セイコーエプソン株式会社 | 水平多関節ロボット及び水平多関節ロボットの制御方法 |
JP5488494B2 (ja) | 2011-02-23 | 2014-05-14 | 株式会社安川電機 | ロボットシステム |
FI20115326A0 (fi) * | 2011-04-05 | 2011-04-05 | Zenrobotics Oy | Menetelmä sensorin mittausten mitätöimiseksi poimintatoiminnon jälkeen robottijärjestelmässä |
JP5149416B2 (ja) * | 2011-04-06 | 2013-02-20 | ファナック株式会社 | ロボットの異常検出機能を有するロボットシステム及びその制御方法 |
ITMI20110903A1 (it) * | 2011-05-20 | 2012-11-21 | Freni Brembo Spa | Impianto e metodo per l'iniezione in stampo di alluminio semisolido |
JP5899660B2 (ja) * | 2011-06-03 | 2016-04-06 | ソニー株式会社 | アクチュエーター装置、多軸駆動装置、並びにロボット装置 |
JP5929224B2 (ja) * | 2012-01-20 | 2016-06-01 | セイコーエプソン株式会社 | ロボット |
JP5943676B2 (ja) * | 2012-03-30 | 2016-07-05 | 株式会社デンソーウェーブ | ロボットの制御システム及びエンコーダシステム |
US9293962B2 (en) | 2012-03-30 | 2016-03-22 | Korea Institute Of Machinery & Materials | Hollow driving module |
CN203092570U (zh) * | 2012-04-06 | 2013-07-31 | 东南大学 | 一种七自由度力反馈机器人遥操作手控器测控电路 |
JP5989447B2 (ja) * | 2012-07-31 | 2016-09-07 | 日東精工株式会社 | トルクセンサ |
JP5973883B2 (ja) * | 2012-11-15 | 2016-08-23 | 株式会社荏原製作所 | 基板保持装置および研磨装置 |
GB2501565B (en) | 2012-11-15 | 2014-10-01 | Control Tech Ltd | Reduction of periodic disturbances |
JP6008121B2 (ja) * | 2013-01-28 | 2016-10-19 | セイコーエプソン株式会社 | ロボットおよびロボット制御装置 |
KR102018706B1 (ko) * | 2013-03-15 | 2019-09-05 | 에스알아이 인터내셔널 | 엑소수트 시스템 |
JP5741617B2 (ja) * | 2013-03-19 | 2015-07-01 | 株式会社安川電機 | ロボット装置 |
JP6255724B2 (ja) * | 2013-06-10 | 2018-01-10 | セイコーエプソン株式会社 | ロボットおよびロボットの操作方法 |
JP6438189B2 (ja) * | 2013-10-01 | 2018-12-12 | 川崎重工業株式会社 | ロボット及びロボットの制御方法 |
JP5928435B2 (ja) * | 2013-11-01 | 2016-06-01 | 株式会社安川電機 | ロボットシステム、検査方法および被検査物の生産方法 |
CN104608113B (zh) * | 2013-11-01 | 2018-07-17 | 精工爱普生株式会社 | 机器人、机器人系统以及机器人控制装置 |
JP5905443B2 (ja) * | 2013-12-25 | 2016-04-20 | ファナック株式会社 | 人協調型産業用ロボットの外力判定方法および外力判定装置 |
US20150224639A1 (en) * | 2014-02-07 | 2015-08-13 | Control Interfaces LLC | Remotely operated manipulator and rov control systems and methods |
US9314922B2 (en) * | 2014-02-07 | 2016-04-19 | Control Interfaces LLC | Remotely operated manipulator and ROV control systems and methods |
US10029366B2 (en) | 2014-11-21 | 2018-07-24 | Canon Kabushiki Kaisha | Control device for motor drive device, control device for multi-axial motor, and control method for motor drive device |
-
2015
- 2015-11-16 US US14/942,711 patent/US10029366B2/en active Active
- 2015-11-18 CN CN201510796074.5A patent/CN105619424B/zh active Active
- 2015-11-18 CN CN201910308221.8A patent/CN110076773B/zh active Active
- 2015-11-20 EP EP15195602.6A patent/EP3023208B1/en active Active
- 2015-11-20 JP JP2015227386A patent/JP6664138B2/ja active Active
-
2018
- 2018-06-18 US US16/011,459 patent/US11148282B2/en active Active
-
2020
- 2020-02-12 JP JP2020021761A patent/JP2020078247A/ja active Pending
Also Published As
Publication number | Publication date |
---|---|
JP2020078247A (ja) | 2020-05-21 |
JP2016105686A (ja) | 2016-06-09 |
CN105619424A (zh) | 2016-06-01 |
US20160144508A1 (en) | 2016-05-26 |
CN105619424B (zh) | 2019-04-26 |
US20180297196A1 (en) | 2018-10-18 |
EP3023208B1 (en) | 2021-08-18 |
US10029366B2 (en) | 2018-07-24 |
CN110076773A (zh) | 2019-08-02 |
EP3023208A1 (en) | 2016-05-25 |
US11148282B2 (en) | 2021-10-19 |
JP6664138B2 (ja) | 2020-03-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110076773B (zh) | 机器人设备、制造物品的方法及电机驱动设备 | |
De Luca et al. | Robots with flexible elements | |
JP6097174B2 (ja) | ロボット制御装置 | |
CN104283484B (zh) | 具备前馈控制的电动机控制装置 | |
JP5897644B2 (ja) | ロボットの制御装置 | |
JP2019123051A (ja) | ロボット装置、ロボットの制御方法、ロボットの制御装置 | |
JP5916583B2 (ja) | 多関節ロボットのウィービング制御装置 | |
JP7118249B2 (ja) | モータ制御装置 | |
WO2018029910A1 (ja) | パラレルリンク機構の制御装置 | |
JP2017056549A (ja) | ロボット装置、ロボット制御方法、プログラム、記録媒体及び組立部品の製造方法 | |
JP7068133B2 (ja) | 制御システム、制御方法、及び制御プログラム | |
JP6021478B2 (ja) | ロボット制御装置、及びロボット制御方法 | |
Muscolo et al. | A Comparison between Two Force‐Position Controllers with Gravity Compensation Simulated on a Humanoid Arm | |
JP2020015124A (ja) | ロボット制御方法、物品の製造方法、ロボット制御装置、ロボット、プログラム及び記録媒体 | |
JP2016032326A (ja) | モータ制御装置、ロボット装置、モータ制御方法、プログラム及び記録媒体 | |
JP6237039B2 (ja) | ロボット制御装置およびロボット制御方法 | |
JP6700679B2 (ja) | 制御方法、物品の製造方法、ロボット装置、制御プログラム及び記録媒体 | |
Oueslati et al. | Improving the dynamic accuracy of elastic industrial robot joint by algebraic identification approach | |
JP2019181664A (ja) | ロボットの制御装置およびロボットの制御方法 | |
JP5780783B2 (ja) | 干渉力補償制御装置 | |
Jiang et al. | Controller synthesis for assistive robotic device using twisted-string actuation | |
JP2016051289A (ja) | 制御装置 | |
CN113771039B (zh) | 用于估计机器人操作参数的方法和计算系统 | |
Skosarev et al. | Case Study on Energy-Aware Position Control for Flexible Link Mechatronic Systems | |
Wang et al. | Output torque regulation through series elastic actuation with torsion spring hysteresis |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |