专利名称：机器人的控制方法和控制装置的制作方法
技术领域：
本发明涉及一种机器人控制装置，供控制象工业机器人之类的多轴式机器人，更具体地说，涉及一种能抑制各轴之间机械干扰产生的振动的机器人控制方法和控制装置。
背景技术：
通常，各轴由电动机控制的工业机器人在负载状态下是通过谐波齿轮传动装置等之类驱动其各臂的。这类传动装置的减速比大，能补偿电动机动力的不足，且能最大限度地减小负荷的作用力产生的干扰影响。由于中间齿轮的减速比大，因而各控制轴之间的机械干扰迄今未造成重大问题。然而，近来越来越多对机器人提出的高速和高精确度操作要求日益集中在以下两个因素引起的问题，一个因素是不能用PI(比例加积分)控制过程补偿的机械作用，另一个因素是即使臂是在大减速比下驱动也不能忽略不计的干扰。
本申请人提一项关于一种抑制多轴式机器人各轴间干扰引起的振动的方法的发明，公开在日本公开专利申请平9-222910(JP，A，09222910)中。所述多轴式机器人有一个机构具有象减速器之类的弹簧元件设在各轴的电动机与机器人的臂之间。按照该专利的方法，与多轴式机器人的各轴有关的状态观测器预测电动机与负荷之间的扭角，用预测出的扭角计算干扰力，根据干扰力确定校正转矩加到电动机的转矩上输出出去。
然而，在上述专利的方法中，校正转矩是这对状态观测器预测出的扭角值进行微分计算出来的，因而噪声势必引入校正转矩中，使电动机运转时高频振动，声音很大。
发明内容
本发明的目的是提供一种能提高工具端部的走道精确度而不致因各轴间的机械干扰而引起振动，也不致使电动机高频振动的机器人控制方法。
本发明的另一目的是提供一种能提高工具端部的走道精确度而不致因各轴间的机械干扰而引起振动也不致使电动机高频振动的机器人控制装置。
本发明上述的第一个目的可以通过这样一种控制多轴式机器人的方法达到。在这种机器人控制方法中，多轴式机器人是控制对象，具有一个机构，机构的多个弹簧元件设在各轴的电动机与机器人臂之间。所述方法包括下列步骤提供控制对象的伪模型和控制对象的反馈控制系统；收到各电动机的位置指令时用伪模型计算各轴的模拟电动机位置指令、模拟电动机转速指令和模拟前馈指令；用伪模型确定因其它轴作用在各轴之间的干扰引起的干扰转矩，并计算模拟校正转矩以消除干扰转矩；往模拟前馈指令中加入模拟校正转矩，得出最终模拟电动机加速指令；和根据模拟电动机位置指令、模拟电动机转速指令和最终模拟电动机加速指令进行对各轴的反馈控制程序。
本发明的另一个目的可用这样一种控制多轴式机器人的装置来达到，多轴式机器人具有一个机械，机构的多个弹簧元件设在各轴的电动机与机器人臂之间，所述机器人控制装置包括一个模拟控制器，供接收各电动机的位置指令并计算各轴的模拟电动机位置指令、模拟电动机转速指令和模拟前馈指令；和多个反馈控制器，供根据模拟控制器输出的指令驱动和控制各电动机和机器人各臂；模拟控制器有多个校正量计算器供确定因其它轴作用在各轴间的干扰引起的干扰转矩和计算模拟校正转矩以消除干扰转矩，从而模拟控制器输出加有模拟校正转矩的模拟前馈指令。
本发明计算校正量时，干扰转矩可以从作为模拟电动机与模拟机器人臂之间位置差的模拟扭角计算出来。
按照本发明，取机器人的某轴接收另一轴的干扰力为干扰转矩，再由模拟控制器加以校正。根据校正量(校正转矩)得出的标准状态量提供给反馈控制器。由于消除干扰力的校正量是用模拟量(例如模拟扭角)计算出来的，因而即使进行微分计算时也不会有噪声成分加入校正量中，这样就可以避免电动机在运转过程中的高频振荡和由此产生的声音加剧，而且提高机器人工具的走道精确度。
附图简介图1是本发明一个实施例的机器人控制装置的控制方框图。
图2是模拟控制器的控制方框图。
发明的最佳实施例下面参看
本发明的一个实施例。虽然为便于说明起见这里介绍的是双轴式机器人，但本发明也适用于多轴式机器人，例如三轴或三轴以上的机器人，只要将以下的说明中轴的数目加以扩大即可，这是本技术领域的一般技术人员所不难理解的。这里假设，两轴用L轴和U轴表示，L轴有关的指令和量用表示这些指令和量、带后缀“-L”的变量表示，U轴有关的指令和量同样用表示这些指令和量、带后缀“-U”的变量表示。
图1示出了各轴近似于双惯性系统的机器人控制系统的基本结构。双质量系统包括电动机11L，11U，象减速器之类的弹簧元件12L，12U和机器人臂13L，13U。假设电动机11L，11U的各转矩常数用Kt_L，Kt_U表示，各轴电动机11L，11U的各实际位置用θm_L，θm_U表示，电动机的各实际转速用
表示，电动的各实际加速度用
表示，减速器12L，12U的各减速比用N_L，N_U表示，减速器的各弹簧常数用Kc_L，Kc_U表示，各臂13L，13U的各惯性矩用JL_L，JL_U表示，各臂的各实际位置用θL_L，θL_U表示，各臂的各加速度(即负荷的各加速度)用 ，θL_U表示。
此外，还假设，为表示U轴与L轴之间的干扰，将L轴的负载转矩乘以MLU/MO2值并使其作用到U轴的负载加速度上，其中MLU/MO2值由各机器人臂的质量和两轴的夹角确定。同样，U轴的负载转矩乘以MUL/MO2值，且作用到L轴的负载加速度上。
电动机11L，11U与相应的传感器(图中未示出)有关，电动机11L，11U的实际位置即由这些传感器输出。
机器人控制装置分别根据各轴的电动机位置指令Xref_L，Xref_U控制L轴和U轴。机器人控制装置具有相应的反馈控制器10L，10U、模拟控制器1和控制对象。反馈控制器10L，10U供在L轴和U轴上履行反馈控制程序。模拟控制器1作为反馈控制器10L，10U的伪模型。模拟控制器1接收电动机位置指令Xref_L，Xref_U，根据机器人的动力学计算各轴的前馈指令UFF_L，UFF_U，完成各轴在电动机11L，11U加速上的前馈补偿，并按标准模型计算并输出电动机位置θMm_L，θMm_U、电动机转速 、扭角θMs_L，θMs_U和各轴的扭转角速度 ，θMs_U。从模拟控制器1输出的各元件以下都加有前缀“模拟”。
在反馈控制器10L，10U中，各轴的位置增益用Kp_L，Kp_U表示，各轴的转速增益用Kv_L，Kv_U表示。反馈控制器10L，10U输出各最终加速指令Uref_L，Uref_U提供给各电动机11L，11U，加速指令Uref_L，Uref_U由各驱动电路14L，14U转换成各电流指令Iref_L，Iref_U。电动机11L，11U由各电流指令Iref_L，Iref_U起动。
机器人控制装置还具有供L轴和U轴使用的相应的状态观测器2L，2U，电动机的最终加速指令、电动机的实际位置θm_L，θm_U和预计的实际扭角θs_L，θs_U及其扭转角速度 即提供给相应的状态观测器2L，2U。状态观测器2L，2U最好是例如日本公开专利申请平9-222910中公开的那一种。状态观测器2L，2U预测出的预计值分别输出给反馈控制器10L，10U。
反馈控制器10L，10U将从模拟控制器1输出的模拟电动机位置θMm_L，θMm_U与实际电动机位置θm_L，θm_U之间的差值乘以位置增益Kp_L，Kp_U，得出各轴的转速指令。如此得出的转速指令加上模拟电动机转速
与实际电动机转速
之间的转速差，得出的和再乘以转速增益Kv_L，Kv_U，从而得出加速指令。加速指令加上(a)模拟控制器1来的前馈指令UFF_L，UFF_U、(b)模拟扭角θMs_L，θMs_U与状态观测器2L，2U输出的扭角θs_L，θs_U之间的差值与反馈增益K1_L，K1_U的乘积和(c)模拟扭转角速度θMs_L，θMs_U与状态观测器2L，2U输出的扭转角速度
之间的差值与反馈增益K2_L，K2_U的乘积，从而得出各轴的最终电动机加速指令Uref_L，Uref_U。
在上述机器人控制系统中，根据如此得出的电动机加速指令Uref_L，Uref_U起动各轴电动机11L，11U，从而经减速比分别为N_L，N_U的减速器12L，12U驱动各轴的器臂13L，13U。这时，如上所述，各轴之间的干扰力影响各轴的负载加速度。
下面谈谈模拟控制器1的一种结构。图2详细示出了模拟控制器1的结构，它由一个表示反馈控制器、电动机、减速器和机器人臂的伪模型组成。伪模型中各轴的位置增益和转速增益分别为模拟位置增益KpM-L，KpM_U和模拟转速增益KvM_L，KvM_U。同样，模拟电动机惯性矩JmM_L，JmM_U、模拟臂惯性矩JLM_L，JLM_U、模拟减速比NM_L，NM_U和模拟减速器弹簧常数KcM_L，KcM-U定为模拟参数。
模拟控制器1接收供来的各轴电动机位置指令Xref_L，Xref_U，将电动机位置指令Xref_L，Xref_U与模拟电动机位置θMm_L，θMm_U之间的差值乘以模拟位置增益KpM_L，KpM_U，从而得出各轴的模拟速指令。模拟控制器1将这些模拟转速指令减去各轴模拟电动机转速
得出的各值乘以模拟转速增益KvM_L，KvM_U，从而得出各轴的模拟加速指令。接着，模拟控制器1从模拟加速指令减去从模拟减速器得出的模拟扭角θMs_L，θMs_U乘以模拟反馈增益K1M_L，K1M_U得出的乘积和对模拟扭角θMs_L，θMs_U进行微分时得出的模拟扭转角速度
乘以模拟反馈增益K2M_L，K2M_U得出的乘积，从而得出模拟加速指令UMref_L，UMref_U。模拟加速指令UMref_L，UMref_U加到模拟电动机上。这样，模拟加速指令UMef_L，UMref_U可用下式表示UMref_L=KpM_L·KvM_L(Xref_L-θMm_L)-KvM_L·θ.Mm_L]]>-K1M_L·θMs_L-K2M_L·θ.Ms_L-----(1)]]>UMref_U=KpM_U·KvM_U(Xref_U-θMm_U)-KvM_U·θ.Mm_U]]>-K1M_U·θMs_U-K2M_U·θ.Ms_U-----(2)]]>在实施例假设的两轴式机器人的情况下，如上所述，由于干扰的原因，因而L轴的负载转矩乘以根据机器人臂的质量和各轴间的夹角确定的MLUM/MoM2值，且影响U轴的负载加速度。同样，U轴的负载转矩乘以MULM/MoM2值，且影响L轴的负载加速度。若认为上述干扰是影响各臂的干扰，则就L轴而言，器臂因干扰而引起的振动可以通过给模拟电动机加速指令UMref_L加上用下式表示的模拟校正转矩Tcomp_L加以削弱Tcomp_L=-KpM_L·KvM_L·NM_L·Dis_ULKcM_L-KvM_L·NM_L·D.is_ULKcM_L-K1M_L·Dis_ULKcM_L]]>-K2M_L·D.is_ULKcM_L-Dis_ULJmM_L·NM_L-NM_L·D··is_ULKcM_L---(3)]]>其中Dis_UL为U轴影响L轴的干扰转矩，可用(4)式表示Dis_UL=JLM_L·KcM_U·MULMMoM2·θMs_U-----(4)]]>因此，最终模拟电动机加速指令UFF_L可用(5)式表示
UFF_L＝UMref_L+Tcomp_L(5)且对电动机的加速度超前馈补偿的作用。模拟控制器1有个校正量计算器3L接收供来的模拟扭角θMs_U，供根据(3)式和(4)式计算模拟校正转矩Tcomp_L。校正量计算器3L来的模拟校正转矩Tcomp_L加到模拟电动机加速指令UMref_L中。
同样，就U轴而言，模拟校正转矩Tcomp_L可用(6)式表示Tcomp_U=-KpM_U·KvM_U·NM_U·Dis_LUKcM_U-KvM_U·NM_U·D.is_LUKcM_U-K1M_U·Dis_LUKcM_U]]>-K2M_U·D.is_LUKcM_U-Dis_LUJmM_U·NM_U-NM_U·D..is_LUKcM_U-----(6)]]>其中Dis_LU为L轴作用到U轴上的干扰转矩，可用(7)式表示Dis_LU=JLM_U·KcM_L·MLUMMoM2·θMs_L-----(7)]]>模拟控制器1有个较正量计算器3U接收供来的模拟扭角θMs_L，供根据(6)式和(7)式计算模拟校正转矩Tcomp_U。于是，最终模拟电动机加速指令UFF_U可用(8)式表示UFF_U＝UMref_U+Tcomp_U(8)如此确定模拟校正转矩Tcomp_L是根据反馈控制器10L，10U的转速环路为比例(P)控制环路这一事实进行的。然而，确定校正转矩也可以根据比例加积分(PI)控制进行补偿。
在本实施例中，模拟控制器1校正干扰转矩之后，标准状态量就作为指令加到反馈控制器10L，10U上。因此，机器人臂都不受其它轴干扰的影响。
工业用途综上所述，在本发明控制多轴式机器人的机器人控制装置中，机构的弹簧元件设在各轴电动机与机器人臂之间，收自其它轴的干扰力由模拟控制器进行校正，且标准状态量根据校正后的干扰力加到反馈控制器上，因而噪声成分不会加入校正转矩中，机器人臂不会因受干扰而振动，从而提高了工具端部走道的精确度。
权利要求
1.一种控制多轴式机器人的方法，机器人作为控制对象，其一个机构的弹簧元件设在各轴电动机与机器人臂之间，所述方法包括下列步骤提供控制对象的伪模型和控制对象的反馈控制系统；收到各电动机的位置指令时用所述伪模型计算各轴的模拟电动机位置指令、模拟电动机转速指令和模拟前馈指令；用所述伪模型确定因其它轴作用在各轴之间的干扰引起的干扰转矩，并计算模拟校正转矩，以清除干扰转矩；往所述模拟前馈指令中加入所述模拟校正转矩，得出最终模拟电动机加速指令；和根据所述模拟电动机位置指令、所述模拟电动机转速指令和所述最终模拟电动机加速指令进行对所述各轴的反馈控制程序。
2.如权利要求1所述的方法，所述干扰转矩根据作为模拟电动机与模拟机器人臂之间位置差的模拟扭角计算出来。
3.一种控制多轴式机器人的装置，所述机器人的一个机构的弹簧元件设在各轴的电动机与机器人臂之间，所述控制装置包括一个模拟控制器，被提供各电动机的位置指令，和计算各轴的模拟电动机位置指令、模拟电动机转速指令和模拟前馈指令；和一个反馈控制器，供根据所述模拟控制器输出的指令起动和控制电动机和机器人臂；所述模拟控制器有多个校正量计算器供确定因其它轴作用在各轴之间的干扰引起的干扰转矩并计算模拟校正转矩，以清除所述干扰转矩，从而所述模拟控制器输出加有所述模拟转矩的所述模拟前馈指令。
4.如权利要求3所述的装置，所述校正量计算器根据作为各电动机与各模拟机器人臂之间位置差的模拟扭角计算所述干扰转矩。
5.如权利要求3所述的装置，还包括多个与各轴有关的状态观测器，供根据所述反馈控制器输出的实际电动机位置和电动机加速指令预测扭角和扭转角速度；其中所述模拟控制器计算模拟扭角和模拟扭转角速度；且所述反馈控制器根据预测出的扭角与所述模拟扭角的差值和预测出的扭转角速度与所述模拟扭转角速度的差值输出所述电动机加速指令。
全文摘要
一种控制多轴式机器人的方法,机器人的一个机构的弹簧元件设在各轴电动机与机器人臂之间。该方法能提高工具端部走道的精确度而不致因各轴之间的机械干扰而引起振动,也不会使电动机高频振动。模拟控制器接收与电动机有关的位置指令并给起动和控制电动机和机器人臂的反馈控制器输出模拟电动机位置指令模拟电动机转速指令和模拟前馈指令。模拟控制器中装有校正量,以消除干扰力。模拟控制器输出加有校正量的模拟前馈指令。
文档编号B25J9/18GK1265057SQ9880746
公开日2000年8月30日 申请日期1998年5月26日 优先权日1997年5月28日
发明者尾岛正夫, 仮屋崎洋和, 富崎秀德 申请人:株式会社安川电机