APPARATUS FOR DETERMINATION OF CONTROL CONSTANT

Abstract: An apparatus for determination of control constants includes a command generation portion for generating a speed command Vref, a speed control portion for determining a torque command Tref by the speed command Vref and an actual motor speed Vfb and controlling the motor speed, an estimation portion for simulating the speed control portion by a model and outputting an estimated torque command Tref', and a determination portion for determining an inertia J from the ratio of a value STref obtained by integrating the torque command Tref output from the speed control portion with respect to a predetermined interval [a, b] to a value STref' obtained by integrating the torque command Tref' output from the estimation portion with respect to the predetermined interval [a, b]. To accurately determine the inertia J using fewer arithmetic operations, the predetermined interval [a, b] and the speed command Vref are set so that the actual motor speed Vfb and the motor speed Vfb' calculated by the estimation portion may have the same nonzero value.

Description: This invention relates to a control constant identification system of a motor for driving a machine tool for indentifying control constants, such as inertia and viscous friction coefficients. From document WO 9414234 there is already known a method and an apparatus for determining constants of functions expressing the characteristics of a controlled system, such as the inertia, and the coefficient of viscous friction of a mechanical device in which an electric motor is incorporated. Document EP 0 604 666 discloses a motor control method for driving a control object such as a machine tool, and more specifically a robust adaptive Pi control method which executes adaption of parameters such as inertia, coefficient of dynamic friction etc. For example, control constant identification systems include: (1) an identification system which changes a torque command for changing the rotation speed and calculates torque command integration amount and rotation speed change width, then performs an operation of (inertia) = (torque command integration amount)/(rotation speed change width) for finding inertia (see Japanese Patent Unexamined Publication No. Sho 61-88780); (2) an identification system which inputs a speed command having a lamp section, executes a speed loop under P control, and finds load inertia from the ratio between steady speed deviation in a state in which no load inertia exists and that in a state in which load inertia exists (see Japanese Patent Unexamined Publication No. Hei 6-70566); and (3) an identification system which time-integrates actual and simulated current detection values or current command values for finding a current area and corrects an initial inertia assumption value from the current area calculation result, thereby finding inertia (see Japanese Patent Unexamined Publication No. Hei 4-325886). However, conventional examples (1), (2), and (3) have a problem that inertia identification value errors or variations are large if viscous friction or Coulomb's friction exists. The following problems are also involved: Particularly in (1), commands are limited to those for changing the rotation speed at a given rate; in (2), the effect of disturbance is easily received because integration control is not performed; and in (3), inertia is found while fuzzy inference, etc., is used to repeat a correction so that the initial inertia assumption value approaches the actual inertia, thus resulting in large amounts of complicated operations. It is an object of the invention to provide a control constant identification system that can solve the problem. This object is met by the features of claim 1. According to the invention, the control constant control system can be provided which contains small inertia identification value errors and variations and moreover can find inertia by performing a small amount of very easy operations even if viscous friction, constant disturbance, and Coulomb's friction exist. Figure 1 is a principle diagram to explain the basic concept of the invention; Figure 2 is a block diagram to elaborate on the principle of the invention; Figure 3 is a block diagram to elaborate on the principle of the invention; Figure 4 is a block diagram of an embodiment of the invention; Figure 5 is speed command examples; Figure 6 is a block diagram to show the speed control section, the estimation section, and the identification section in Figure 4 in detail; and Figure 7 is an operation example using an AC servo motor. First, the principle of the invention will be discussed, next an embodiment using a motor will be described specifically. Figure 1 is a principle diagram to explain the basic concept of the invention. Numeral 1 is a speed control section and numeral 2 is an estimation section. PI control is programmed in the speed control section 1 and only inertia J is to be controlled. Likewise, PI control is also programmed in the estimation section 2 and only inertia J' is to be controlled. In Figure 1, if speed Vfb in the speed control section 1 matches speed Vfb' in the estimation section and Vfb and Vfb' are not zero, relation J/J' = STref/STref' ...(1) holds for torque command integration value STref and inertia J in the speed control section and torque command integration value STref' and inertia J' in the estimation section, and inertia J is immediately found from J = = (STref/STref')*J' ...(2). This is the basic principle of the invention. However, in a system in which viscous friction D exists, the viscous friction D cannot be ignored and to make the relation hold, a condition that the integration value of speed Vfb at a predetermined interval [a, b] is zero must be added. The reason why the condition must be added is as follows: Figure 2 is a block diagram where the targets to be controlled are represented as inertia J and viscous friction D. Figure 3 is a block diagram provided by rewriting Figure 2. As seen in Figure 3, if the integration value of speed Vfb at the interval [a, b] is zero, the effect of the viscous friction D can be eliminated. Thus, if the condition is added, expression (1) holds and the inertia J can be found immediately from expression (2). Here, the integration value of speed Vfb is zero, but if positions are managed, the effect of the viscous friction D may be eliminated if the positions at time a and time b at the interval [a, b] match. An average value of inertia found at a plurality of such intervals at which the time integration value of motor speed Vfb becomes zero may be adopted as inertia J. Next, when constant disturbance Td is applied, if an average value of inertia J1 found by one speed command Vref1 and inertia J2 found by Vref2 provided by inverting the positive and negative of the speed command Vref1 is adopted as inertia J, the effect of the constant disturbance Td can be eliminated. When Coulomb's friction exists, if the interval [a, b] and the speed command Vref are set so that the forward rotation time and the reverse rotation time of a motor become equal to each other at the interval [a, b], the effect of the Coulomb's friction can also be eliminated. The constant disturbance Td can be found by dividing an average value of torque command integration value STref1 found by the speed command Vref1 and torque command integration value STref2 found by Vref2 provided by inverting the positive and negative of the speed command Vref1 by integration time b-a. The viscous friction D can be found from the inclination (time change) of torque command Tref when the speed command Vref is constant acceleration or constant deceleration. Next, an embodiment using a motor will be described specifically. Figure 4 is a block diagram of an embodiment of the invention. In the figure, numeral 41 is a command generation section for outputting a speed command Vref to a speed control section 42 and an estimation section 43. Numeral 44 is an identification section for inputting a torque command Tref of the speed control section 42 and a torque command Tref' of the estimation section 43 and finding inertia J, constant disturbance D, and viscous friction D. Next, the sections will be discussed with reference to Figures 5 and 6 based on an experimental configuration. Figure 7 shows an operation example using an AC servo motor. The command generation section 41 generates a speed command Vref. The speed command Vref can be any of commands as shown in Figures 5(A)-5(F), for example. Here, speed command Vref shaped like a trapezoid where the absolute values of the maximum speed and the minimum speed are the same and acceleration and deceleration are the same as shown in Figure 5(A) is adopted. Figure 6 shows the configuration of the speed control section 42, the estimation section 43, and the identification section 44. The speed control section 42 programs a speed loop so that speed Vfb matches the speed command Vref; here PI (proportional integration) control is adopted. The speed control section 42 outputs a torque command Tref to a current controller for driving a motor and the identification section 44. Assume that load 4.16 times that of motor inertia JM, JL (=4.16*JM), is attached to the motor and that speed Vfb is output from the motor. Like the speed control section 42, the estimation section 43 adopts PI control, models a control target as 1/J'S, and outputs a torque command Tref' to the control target 1/J'S and the identification section 44. The identification section 44 receives the torque command Tref output from the speed control section 42 and the torque command Tref' output from the identification section 43 and finds inertia J according to J = (STref/STref')*J' from values STref and STref' resulting from time integration of the torque commands between time "a" and time "b" and inertia J' of the estimation section. Figure 7 provides an operation example using an AC servo motor. Vref is a speed command, 1 ○ is motor speed Vfb in the speed control section 42, 1 ○ ' is speed Vfb' in the estimation section, 2 ○ is a torque command Tref in the speed control section 42, and 2 ○ ' is a torque command Tref' in the estimation section. When inertia J1 is found from values STref1 and STref1' resulting from time integration of 2 ○ and 2 ○ ' between time a1 and time b1 and inertia J' of the estimation section, J1 = (STref1/STref1')*J' = 5.49*JM. Likewise, when inertia J2 is found from values STref2 and STref2' resulting from time integration between time a2 and time b2 and inertia J' of the estimation section, J2 = (STref2/STref2')*J' = 4.81*JM. Thus, inertia J can be identified as J = (J1 + J2)/2 = 5.15*JM. This identification value almost matches (motor inertia JM) + (load inertia JL = 4.16*JM) = 5.16*JM. However, inertia J' of the estimation section is simulated as J' = JM. In the experiment, the operations of the estimation section are also performed in real time. However, if the speed command Vref is fixed, the torque command integration value STref' in the estimation section can be previously calculated, thus only the torque command integration value STref in the speed control section 42 needs to be calculated. In fact, if the speed becomes zero, the relation of expression (1) does not hold because of the effect of statical friction. Therefore, when the speed Vfb is X1 ≤ Vfb ≤ X2 (where X1 ≤ 0 and X2 ≥ 0), if time integration of the torque command Tref of the speed control section and the torque command Tref' of the estimation section is not executed, J/J' = STref/STref' holds and inertia J is immediately found from expression J = (STref/STref')*J'. When viscous friction D exists as in Figure 2, as seen in Figure 3 provided by rewriting Figure 2, if the integration value of the speed Vfb at the interval [a, b] is zero, the effect of the viscous friction D can be eliminated. Thus, when the speed Vfb is X1 ≤ Vfb ≤ X2 (where X1 ≤ 0 and X2 ≥ 0), if time integration of the torque command Tref of the speed control section and the torque command Tref' of the estimation section is not executed and the interval [a, b] and the speed command Vref are set so that the time integration value of the speed Vfb becomes zero except during the time t1 (t1 ≥ 0) when the speed Vfb is X1 ≤ Vfb ≤ X2, the effect of the viscous friction D can also be eliminated. Thus, a control constant control system can be provided that can identify inertia without receiving the effect of statical friction, etc., occurring when the speed is zero or is close to zero. If the actual operation and the model operation differ largely, the speed Vfb in the speed control section and the speed Vfb' in the estimation section may be hard to match. In this case, an adjustment section 45 for adjusting speed loop gain Kv' may be provided, as shown in Figure 6. The adjustment section raises the speed loop gain Kv' of the estimation section if the torque command Tref' of the estimation section is greater than 0 and the speed Vfb is greater than the speed Vfb'; lowers the speed loop gain Kv' of the estimation section if the torque command Tref' of the estimation section is less than 0 and the speed Vfb is greater than the speed Vfb'; and raises the speed loop gain Kv' of the estimation section if the torque command Tref' of the estimation section is less than 0 and the speed Vfb is less than the speed Vfb'. This invention can be applied to control systems of motors for driving industrial machines, particularly machine tools, sorting machines, etc., with less load change.

Claims: A control constant identification system of an electrical motor for driving a machine tool for identifying control constants comprising: a command generation section (41) for generating a speed command Vref; a speed control section (42) for determining a torque command Tref by the speed command Vref and actual motor speed Vfb and for controlling motor speed; an estimation section (43) for determining an estimated torque command Tref' by the speed command Vref by simulating said speed control section according to a model; and an identification section (44) for identifying inertia J according to a ratio between a value Stref resulting form time integration of the torque command Tref output by said speed control section (42) at a predetermined interval [a, b] and a value Stref resulting from time integration of the torque command Tref' output by said estimation section (43) at the predetermined interval [a, b], wherein the predetermined interval [a, b] and the speed command Vref are set so that the actual motor speed Vfb and motor speed Vfb' found by said estimation section become the same non-zero values at the time b. Control constant identification system as claimed in claim 1, wherein the speed command Vref generated by said command generation section (41) is previously fixed. Control constant identification system as claimed in claim 1 or 2, wherein said speed control section (42) performs control containing an integration operation. Control constant identification system as claimed in any one of claims 1 to 3, wherein the predetermined interval [a, b] and the speed command Vref are set so that a time integration value of the actual motor speed Vfb at the predetermined interval [a, b] becomes zero. Control constant identification system as claimed in any one of claims 1 to 4, wherein an average value of inertia found at a plurality of such intervals at which the time integration value of the actual motor speed Vfb becomes zero is adopted as inertia J. Control constant identification system as claimed in any one of claims 1 to 3, wherein the interval [a, b] and the speed command Vref are set so that forward rotation time and reverse rotation time of a motor become equal to each other at the interval [a, b]. Control constant identification system as claimed in any one of claims 1 to 6, wherein an average value of inertia J1 found by one speed command Vref1 and inertia J2 found by Vref2 provided by inverting positive and negative of the speed command Vref1 is adopted as inertia J. Control constant identification system as claimed in claim 7, wherein constant disturbance Td is found according to a torque command integration value Stref1 found by one speed command Vref1 and a torque command integration value Stref2 found by Vref2 provided by inverting the positive and negative of the speed command Vref1. Control constant identification system as claimed in any one of claims 1 to 3, wherein a viscous friction coefficient D is found from inclination (time change) of the torque command Tref when the speed command Vref is constant acceleration or constant deceleration. Control constant identification system as claimed in claim 1, wherein when the actual motor speed Vfb satisfies the following relationship: X1 ≤ Vfb ≤ X2 (where X1 ≤ 0 and X2 ≥ 0) in the predetermined interval [a, b], time integration of the torque command Tref of said speed control section and the torque command Tref' of said estimation section are not executed. Control constant identification system as claimed in claim 1, wherein the predetermined speed command Vref are set such that a time integration value of the actual motor speed Vfb becomes zero except during a time t1 (t1 ≥ 0) when the actual motor speed Vfb satisfies the following relationship: X1 ≤ Vfb ≤ X2. Control constant identification system as claimed in claim 1, further including an adjustment section (45) for adjusting speed loop gain Kv' of said estimation section (43) from information of the motor speed VFB of said speed control section, and the speed Vfb' and the torque command Tref of said estimation section (43). Control constant identification system as claimed in claim 12, wherein said adjustment section (45) raises the speed loop gain Kv' of said estimation section (43) if the torque command Tref' of said estimation section is greater than 0 and the actual motor speed Vfb is greater than the motor speed Vfb'; lowers the speed loop gain Kv' of said estimation section (43) if the torque command Tref' of said estimation section (43) is less than 0 and the actual motor speed Vfb is greater than the motor speed Vfb'; and raises the speed loop gain Kv' of said estimation section if the torque command Tref' of said estimation section (43) is less than 0 and the actual motor speed Vfb is less than the motor speed Vfb'.

Inventors: NAKAMURA HIROSHI, TSURUTA KAZUHIRO, NAKAMURA, HIROSHI, TSURUTA, KAZUHIRO, NAKAMURA, Hiroshi Kabushiki Kaisha Yaskawa Denki, TSURUTA, Kazuhiro Kabushiki Kaisha Yaskawa Denki
Applicants: YASKAWA DENKI SEISAKUSHO KK, KABUSHIKI KAISHA YASKAWA DENKI
Application year: 1996
Main classification: H02P5
IPC codes: H02P23