电机控制装置 【技术领域】
本发明涉及一个用于机器人、机械工具或者相似的装置的控制装置，并且尤其涉及一个具有相应的识别惯量和调节增益的功能的电机控制装置，其中该惯量在工作期间进行变化。
现有技术
作为一个识别在电机控制装置中的惯量的装置，一个装置已经公开在由本发明的同一个申请人申请的日本专利申请Hei.8-230713中。
此装置含有一个用于确定扭矩指令和控制电机速度的速度控制部分以使实际的电机速度与输入的速度指令相一致，一个用于模拟速度控制部分的评估部分以使模型的速度与电机的速度相一致，和一识别部分以根据比例识别惯量，该比例是一个在特定的期间通过时间积分该速度控制部分的速度变量所得到的值与一个在特定的期间通过时间积分该评估部分的速度变量所得到的值的比值。当在此特定的期间该评估部分的速度变量是零而电机速度不是零时，该识别部分通过使用比值进行计算以识别惯量，该比值是通过时间积分该速度控制部分的速度变量所得到的值和通过时间积分该评估部分的速度变量所得到的值之间的比值。相对比的，如果速度控制部分的速度指令和电机速度是零，在识别部分中的时间积分不进行。此装置根据任意的速度指令进行实时的识别操作，以致于即使惯量在每一刻都改变时也能够进行惯量的识别。
作为调节电机控制装置中的惯量的另一个方法，在日本专利的未审查的已公开的Hei.4-325886中公开了一个用于电机伺服系统的控制装置。该公开件公开了用于电机伺服系统的控制装置，该系统反馈控制了由一个电机和耦合到该电机的机械系统所构成的可控制的对象。另外该公开件公开了，因为负载惯量的幅值直接反应在流进电机中的电流的时间积分值，在一个实际的伺服系统处的以及在它的模拟部分的电流检测值的时间积分值在加入相同的位置指令值的情况下被得到，那么当根据时间积分值之间的比较结果修改惯量的建议值时，可控制部分的负载惯量的幅值被识别，根据负载惯量的识别值调节在反馈控制回路之中的控制增益，以致于即使负载惯量改变，大部分的适合的操作也能够容易地进行。
然而在此现有技术中，根据用于时间积分该输入速度指令或者速度变量的积分周期，在速度控制部分的速度变量的积分值或者在评估部分中的速度变量的积分值变为零的情况下，该惯量不能够被识别。
另外在存在摩擦和干扰的情况下，因为摩擦补偿分量和干扰补偿分量在扭矩指令或者在除了指令响应分量的电机电流中得到，因为这样的补偿分量需要消除该影响。另外因为惯量比较困难使实际的速度与模型的速度相一致，用于识别惯量的试验和计算需要进行几次，以致于需要很多时间来识别惯量。以此，以较高的精度进行实时的调节是比较困难的。
发明描述
本发明的目的是通过电机控制装置，它使一个实际的速度作为模型的速度指令并且具有适合于只通过简单的计算进行实时地识别惯量和以此来调节控制增益的功能。
根据本发明识别惯量的原理下面进行简要的描述。在从扭矩指令或者电机电流的时间积分值中正确得到一个惯量的情况下，当从扭矩指令或者电机电流到该速度的传输函数只通过该惯量进行表示并且该速度等于零的时，通过该速度与扭矩指令或者电机电流的时间积分值的比值该惯量能够容易地得到。通过应用这个关系，在相同的速度指令被输入到一个实际的速度控制部分以及它的模型中时的情况下，如果实际的速度以及模型的速度不等于零并且彼此相互一致，该惯量能够从速度以及实际的速度控制部分以及它的模型中的扭矩指令或者电机电流的时间积分值中得到。然而，因为实际上存在摩擦和干扰，一个摩擦补偿分量和一个干扰补偿分量除了在一个指令响应分量中还在扭矩指令或者电机电流中得到，以致于需要消除因为这个补偿分量所产生的影响。另外因为惯量，很困难地使实际的速度与模型的速度保持一致，用于识别惯量的试验和计算需要进行几次，以致于需要很多时间来识别该惯量。因此，很难进行高精度的实时的调节。
基于上述的事实，根据本发明建议通过在速度控制部分中的积分器对摩擦和干扰进行一定程度的补偿，因为摩擦和干扰或者类似的所形成的影响通过实时地积分代替扭矩指令或者电机电流的速度变量来尽可能小地形成，并且另外一个实际的速度作为一个模型的速度指令来使用以尽可能满足这个条件，实际的速度以及模型的速度不是零并且相互一致。根据这种结构，本发明只通过进行一个非常简单的计算就可以识别一个惯量，以致于实时的调节操作能够高精度地进行。
为了解决上述的传统问题，本发明基于这个惯量识别原理以下述的方式进行设置，该电机控制装置含有：
一个用于确定扭矩指令和控制电机速度的速度控制部分，以致于实际的电机速度与输入的速度指令相一致，
一个用于模拟速度控制部分的评估部分以使电机速度与模型的速度相一致，
一个根据比值识别惯量的识别部分，该比值是一个通过在特定的期间时间积分速度控制部分的速度变量所得到的值与一个通过在与特定的期间相同的期间内时间积分评估部分的速度变量所得到的值的比值。
惯量的识别只在下面的情况下进行，在速度控制部分中的电机速度和评估部分中的模型速度不是零并且相互一致，和
惯量根据一个比值进行识别，该比值是一个通过在一个特定的期间时间积分速度控制部分的的速度变量的绝对值所得到的值与一个通过在与特定的期间相同的期间中时间积分评估部分中的速度变量的绝对值所得到的值的比值。
另外，含有至少两个用于速度控制部分的积分器，其中的每一个都用于得到速度控制部分的速度变量的绝对值的时间积分值，并且含有至少两个用于评估部分的积分器，其中的每一个都是用于得到评估部分中的速度变量的绝对值的时间积分值，以及其中的至少两个用于速度控制部分的积分器可以交替地改变，并且至少两个用于评估部分的积分器可以下面的方式进行改变，至少完成积分的两个积分器的之一被清零并且开始速度变量的绝对值的时间积分。
本发明的电机控制装置含有：
一个速度控制部分，用于确定扭矩指令和控制电机的速度以使电机的实际的速度与输入的速度指令一致，
一个评估部分，用于模拟速度控制部分以使电机速度与模型的速度一致，
一个识别部分，用于识别惯量，只有在速度控制部分的电机速度和评估部分中的模型的速度不是零并且相互一致时，基于一个比值，该比值是一个在特定的期间时间积分由速度控制部分的速度变量通过一个预定的滤波器所得到的值的绝对值所得到的值与一个在与特定的期间相同的期间内的评估部分的速度变量的绝对值的时间积分值的比值；和
一个调节部分，用于根据将在识别部分识别的惯量与在评估部分中的惯量的比值经过一个预定的滤波器所得到的值进行调节控制增益。
另外，用于经过速度控制部分的速度变量的滤波器是从速度指令到速度控制部分的电机速度的传输函数。
另外，在使用一个比例积分器(PI)控制方法、一个积分比例(IP)控制方法或者一个比例积分和微分(PID)控制方法作为在速度控制部分中的控制方法时，积分器的值通过调节部分的控制增益进行调节。
附图简述
图1是一个方框图，示出了根据本发明的第一个实施例的电机控制系统，
图2是一个方框图，示出了在图1中的速度控制部分、评估部分和识别部分的安排，
图3用于详细解释图2中的识别部分，
图4示出了使用一个AC伺服电机的电机控制系统的操作的实施例，
图5是一个方框图，示出了本发明的第二个实施例的电机控制系统，
图6是一个方框图，示出了第二个实施例的速度控制部分、评估部分、识别部分和调节部分的安排，
图7示出了使用模拟的响应的实施例，其中(A)是第二个实施例的示意图，而(B)不是根据第二个实施例的示意图。
实现本发明的最好方式
图1示出了根据本发明的第一个实施例的电机控制系统。一个速度指令产生部分11输出一个速度指令Vref到一个速度控制部分12。速度控制部分12输出速度控制部分的电机速度Vfb到一个评估部分13，并且另外输出一个速度变量Ve和一个电机速度Vfb到一个识别部分14。该评估部分13模拟速度控制部分12以使电机速度Vfb与一个模型的速度Vfb’相一致，并且输出一个速度变量Ve’和一个速度Vfb’到识别部分14。该识别部分14从速度控制部分12接收速度变量Ve和电机速度Vfb并且从评估部分13接收速度变量Ve’和速度Vfb’以得到惯量J。
图2示出了速度控制部分12、评估部分13和识别部分14的安排。速度控制部分12从速度指令产生部分11接收速度指令Vref，并且被设置以形成一个速度回路以使电机的速度Vfb与速度指令Vref相一致。在速度控制器中，形成PI(比例积分)控制器的PI控制器121输出一个扭矩指令Tref到一个用于驱动电机123的电流控制器122中。该速度控制器也输出电机速度Vfb到评估部分13，并且输出该速度指令、电机速度的速度变量Ve和电机速度Vfb到识别部分14。电机123被耦合一个负载JL并且电机123输出电机速度Vfb。
评估部分13从速度控制部分12接收作为速度指令的电机速度Vfb。评估部分通过PI控制器131、电流控制器模型132和可控的通过模拟可控的物体1/J’S的物体模型133相似于速度控制部分12进行设置，并且输出速度变量Ve’和速度Vfb’到识别部分14。
识别部分14接收从速度控制部分12输出的速度变量Ve和电机速度Vfb并且也接收从评估部分13输出的速度变量Ve’和速度Vfb’，然后得到各个速度变量的绝对值。因此，一个积分器141在特定的周期〔a，b〕期间对绝对值进行时间积分，然后计算部分142根据所得到的时间积分值|SVe|和|SVe’|得到速度控制部分的惯量J和通过如下的表达式所表示的评估部分中的惯量J’(已知的恒量) J＝(|SVe|/|SVe’|)*J’ (1)在此，只有在速度控制部分中的电机速度Vfb和评估部分中的速度Vfb’不等于零并且相互一致的时候才进行表达式(1)的计算。
然后，设置积分时间〔a，b〕的方法和读出积分值的周期下面参考图3进行解释。在此实施例中，分别用于对速度控制部分中的速度变量Ve的绝对值进行积分的两个积分器被提供并且也提供了分别对评估部分中的速度变量Ve’的绝对值进行积分的两个积分器。
对速度控制部分中的速度变量Ve的绝对值进行积分的两个积分器和对评估部分中的速度变量Ve’的绝对值进行积分的两个积分器可以如下的方式进行替换，积分周期通过所示出的MODE0和MODE1之间的半周期进行变化。从积分器的积分值的读出周期是各个积分周期的后半个周期1，2，3…，其与前半个周期相比较少的受到错误的影响。该积分值在这些读周期中的某些时刻读出。
在时刻t0到t1期间(期间1)，通过使用如图3上面所述的方法MODE0和MODE1与积分并行地进行表达式(1)的计算。在时刻t1，该处理变为图3下部分所示的MODE1。在方法MODE0中相似地，该积分器的输出值|SVe|和|SVe’|被清零并且重新开始积分操作。在时刻t1到时刻t2期间(期间2)，表达式(1)的计算通过使用方法MODE1与积分并行地进行。在时刻t2，该处理重新变为MODE0，并且相似的，在处理MODE1中，积分器的输出值|SVe|和|SVe’|被清零并且然后重新开始积分操作。
以此方式，此期间按顺序(期间1→期间2→期间3→期间4→期间5…)进行变化并且重复此系列的处理，因此一个惯量能够很好地相应于速度变量被识别，该速度变量通过负载的改变而没有超过速度变量的绝对值的时间积分值地受到影响。当作为期间3的实施例解释用于进行速度变量的时间积分的期间〔a，b〕时，时刻a相应于时刻1，时刻b相应于在时刻2到时刻3之间的用于读出的某个时刻。
图4示出了使用AC伺服电机的电机控制系统的操作的实施例。在附图中，标志①表示形成具有2.0Hz的1，500rpm的最大速度的速度指令Vref。标志②在速度控制部分12中的电机速度Vfb，标志②’表示在评估部分13中的速度Vfb’，标志③表示一个比值(③＝J/J’)，该比值是在每一个控制期间都出现的在识别部分14中的惯量J和在评估部分13中的惯量J’的比值。该比值的值几乎等于{(电机惯量JM)+(负载惯量JL＝9.0*JM)}/(电机惯量JM)＝10.0。其中，在评估部分中的惯量J’作为J’＝JM进行模拟。另外在表达式Vfb＝Vfb’≠0没有满足的情况下，不进行上述的表达式(1)的计算并且惯量J’作为上面的控制时间的识别值进行确定。
尽管在第一个实施例中对惯量的识别进行了解释，当一个调节部分相似于下面的第二个实施例进行提供的时候，控制增益能够通过识别惯量进行调节。
图5示出了本发明的第二个实施例的电机控制系统的方框图。一个速度指令产生部分11输出一个速度指令Vref到速度控制部分12。该速度控制部分12输出速度控制部分中的电机速度Vfb到一个评估部分13并且另外输出一个速度变量Ve和一个电机速度Vfb到一个识别部分14。评估部分13模拟速度控制部分12以使电机速度与模型的速度Vfb’相一致。该识别部分14从速度控制部分12接收速度变量Ve和电机速度Vfb，并且也从评估部分13接收速度变量Ve’和速度Vfb’，以此得到一个惯量J，并且输出一个惯量比值J/J’到一个调节部分15。调节部分15接收惯量比值J/J’，然后根据由预定的滤波器所得到的值确定在速度控制部分12中的比例增益Kv和积分增益Ki，并且调节在速度控制部分中的积分值。
图6示出了速度控制部分12、评估部分13、识别部分14和调节部分15的设置。速度控制部分12接收从速度指令产生部分11的速度指令Vref并且被设置以形成一个速度回路以使电机的速度Vfb与速度指令Vref相一致。在速度控制器中，被设置以形成一个PI控制器的一个PI控制器121输出一个扭矩指令Tref到一个电流控制器122以驱动一个电机123。该速度控制器也输出电机速度Vfb到评估部分13，并且输出速度变量Ve和电机速度Vfb到识别部分14。该电机耦合了一个负载JL并且电机输出该电机速度Vfb。
评估部分13作为速度指令从速度控制部分12接收电机速度Vfb。该评估部分相似于速度控制部分12通过PI控制器131、电流控制器模型132和一个通过模拟可控的物体1/J’S所形成的可控物体模型133进行设置，并且输出速度变量Ve’和速度Vfb’到识别部分14。
识别部分14接收速度控制部分12输出的速度变量Ve和电机速度Vfb，并且也接收从评估部分13输出的速度变量Ve’和速度Vfb’，然后得到速度变量Ve’的绝对值和值FVe的绝对值，该值FVe是通过将速度变量Ve经过由速度指令Vref到电机速度Vfb的传输函数的模型所形成的滤波器所得到的。因此，一个积分器141影响了在特定的期间〔a，b〕中的对绝对值的时间积分，然后该计算部分142得到基于所得到的积分值|SVe|和|SVe’|的速度控制部分惯量J和通过如下的表达式所表示的评估部分中的惯量J’(已知的恒量)
J＝(|SFVe|/|SVe’|)*J’ (2)在此，表达式(2)中的计算只有在速度控制部分中的电机速度Vfb和评估部分中的速度Vfb’不等于零并且相互一致的情况下才进行。
然后，设置积分周期〔a，b〕的方法和读出积分值的周期参考图3进行解释。在此实施例中，相似于第一个实施例，分别用于对速度控制部分中的速度变量Ve进行滤波所得到的值FVe的绝对值进行积分两个积分器被提供并且提供了分别用于积分在评估部分中的速度变量Ve’的绝对值的两个积分器。
用于速度控制部分中的速度变量的两个积分器和用于评估部分中的速度变量的两个积分器以如下的方式进行替换，该积分周期以MODE0和MODE1之间的半周期进行变化。从积分器的积分值的读出周期是各个积分周期的后半周期1，2，3…，其与前半周期相比受错误的影响较小。该积分值在这些读周期的某个时刻读出。
在时刻t0到t1期间(期间1)，通过使用如图3上面所述的方法MODE0和MODE1与积分并行地进行表达式(2)的计算。在时刻t1，该处理变为图3下部分所示的MODE1。在方法MODE0中相似地，该积分器的输出值|SFVe|和|SVe’|被清零并且重新开始积分操作。在时刻t1到时刻t2期间(期间2)，表达式(2)的计算通过使用方法MODE1与积分并行地进行。在时刻t2，该处理重新变为MODE0，并且相似的，在处理MODE1中，积分器的输出值|SFVe|和|SVe’|被清零并且然后重新开始积分操作。
以此方式，此期间按顺序(期间1→期间2→期间3→期间4→期间5…)进行变化并且重复此系列的处理，因此一个惯量能够很好地相应于速度变量被识别，该速度变量通过负载的改变而没有超过速度变量的绝对值的时间积分值地受到影响。当作为期间3的实施例解释用于进行速度变量的时间积分的期间〔a，b〕时，时刻a相应于时刻1，时刻b相应于在时刻2到时刻3之间的用于读出的某个时刻。
调节部分15基于一个值更新比例增益Kv和在速度控制部分12中的积分增益Ki，该值是将在识别部分14中得到的惯量的比例(＝J/J’)经过预定的滤波器所得到的值，该调节部分并且另外调节在速度控制部分中的积分器的值。
然后，在图7中示出了使用模拟的响应的实施例。在附图中，(A)表示使用本发明的响应的实施例，(B)表示没有使用本发明的响应的实施例。在此附图中，标志①表示构成具有2.0Hz的1，500rpm的最大速度的速度指令Vref。标志②表示通过模拟电机速度所得到的速度Vfb，标志③表示速度变量Ve，标志④表示由模拟所设置的整个负载JN(IN＝JM+JL)的一个惯量JN和在评估部分13中的惯量J’的比值(④＝JN/J’)，标志⑤表示通过将在识别部分14中识别的惯量J和在评估部分13中惯量J’的比值(＝J/J’)经过在出现在每一个控制周期中的调节部分15中的具有时间恒量50ms的初级滤波器所得到的一个值。在此，在评估部分中的惯量J’作为J’＝JM进行模拟。另外，在表达式Vfb＝Vfb’≠0没有被满足的情况下，不进行上述的表达式(2)的计算并且惯量J’作为在开始的控制时间处的识别量进行确定。在调节部分15中，在速度控制部分中的比例增益Kv根据惯量比例⑤基于Kv＝Kv*⑤的计算表达式进行计算，以使比例增益在每一个控制周期都进行更新。积分增益Ki被设置为一个适合于比例增益Kv的值。在附图可以清楚地看到，即使惯量以方式5次→20次→10次→10次→5次进行改变时，通过本发明能够以高精度地快速识别惯量，以使本发明能够得到稳定的响应而没有受到惯量的改变所产生的影响。
从第二个实施例的上述的解释可以看到，通过提供在第一个实施例中的调节部分并且另外通过识别该惯量，对于本领域的技术人员来说很容易地调节控制增益。
工业应用
如上所述，本发明能够提供一个电机控制装置，其能够实时地识别一个惯量，该惯量时刻都在改变而没有受到积分周期的限制，该积分周期是对输入速度指令和速度变量的时间积分起作用。
另外，根据本发明，摩擦、干扰和类似所形成的影响能够尽可能地小，因为实际的速度被作为模型的速度指令进行设置以满足一个条件，即实际的速度和模型的速度不是零并且相互一致，该惯量只通过一个非常简单的计算在一个非常短的时间内被识别。因此提供了具有控制增益调节函数并且能够以高精度进行实时的调节的电机控制装置。