Motor controlling apparatus for suppressing vibrations

Abstract

A motor control apparatus of the present invention is a motor control apparatus for compensating elastic deformation between a servo motor and a driven part, driven by the servo motor, which includes a position command generator for generating a position command of the motor, a compensation filter for compensating the position command generated by the position command generator and a servo control unit for controlling the movement of the motor based on a position command after compensation, i.e., the compensated position command by the compensation filter, and is constructed such that the compensation filter includes a filter F(s) having an inertia J.sub.L of the driven part, a stiffness coefficient K of an elastically deformable part and a damping coefficient C of the elastically deformable part as the elements of filter coefficients.

Claims

1. A motor control apparatus for controlling a servo motor, comprising: a position command generator configured to generate a position command of the motor; a compensation filter configured to compensate the position command generated by the position command generator; and, a servo control unit configured to control the movement of the motor based on a position command after compensation which is the compensated position command by the compensation filter, wherein the compensation filter includes a filter F(s) having an inertia Jr of a driven part, a stiffness coefficient K of an elastically deformable part and a damping coefficient C of the elastically deformable part as the elements of filter coefficients, wherein the filter F(s) included in the compensation filter is represented by F(s)=(J.sub.L×s.sup.2+C×s+K)/(C×s+K) wherein the position command after compensation is determined by adding a differential compensation amount for implementation of a filter, F(s)−1=(J.sub.L×s.sup.2)/(C×s+K), on the position command, to the position command, wherein the compensation filter includes: an acceleration command operator configured to calculate an acceleration command from the position command; a first compensation amount operator configured to multiply the acceleration command output from the acceleration command operator by a gain J.sub.L/K, determined by the inertia J.sub.L of the driven part and the stiffness constant K of an elastically deformable part; and, a second compensation amount operator configured to implement a first order low-pass filter with a time constant of C/K, determined by the damping constant C of the elastically deformable part and the stiffness constant K of the elastically deformable part, on a first compensation amount output from the first compensation amount operator, wherein the filter F(s) is realized by adding a second compensation amount output from the second compensation amount operator, to the position command, wherein the gain J.sub.L/K is determined by the inertia J.sub.L of the driven part and the stiffness constant K of the elastically deformable part, wherein the time constant C/K is determined by the damping constant C of the elastically deformable part and the stiffness constant K of the elastically deformable part, and wherein the gain J.sub.L/K and the time constant C/K are input to realize the filter F(s) after being determined by the following equations using the frequency ω and the vibration attenuation coefficient ξ
J.sub.L/K=1/ω.sub.2
C/K<=2ξ/ω.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) The object, features and advantages of the present invention will be better understood by reading the following description of the embodiments, taken together with the drawings wherein:

(2) FIG. 1 is a model showing a two-inertia system handled in a motor control apparatus according to a first embodiment of the invention;

(3) FIG. 2 is a block diagram showing the two-inertia system handled in a motor control apparatus according to the first embodiment of the invention;

(4) FIG. 3 is a schematic configurational diagram of a motor control apparatus according to the first embodiment of the invention;

(5) FIG. 4 is a block diagram of a motor control apparatus according to the first embodiment of the invention;

(6) FIG. 5A is a block diagram of a compensation filter of a motor control apparatus according to the first embodiment of the invention;

(7) FIG. 5B is a block diagram of a compensation filter of a motor control apparatus according to the first embodiment of the invention;

(8) FIG. 6A is a block diagram of a compensation filter of a motor control apparatus according to a second embodiment of the invention;

(9) FIG. 6B is a block diagram of a compensation filter of a motor control apparatus according to the second embodiment of the invention;

(10) FIG. 7 is a detailed block diagram of a compensation filter of a motor control apparatus according to the second embodiment of the invention; and,

(11) FIG. 8 is a detailed block diagram of a compensation filter of a motor control apparatus according to a third embodiment of the invention.

DESCRIPTION OF THE INVENTION

(12) Referring now to the drawings, the motor control apparatuses according to the present invention will be described. However, it should be noted that the technical scope of the present invention is not limited by the embodied mode of these but embraces the inventions defined by the claims and their equivalence.

First Embodiment

(13) To begin with, a motor control apparatus according to the first embodiment of the present invention will be described. In the motor control apparatus according to the first embodiment of the invention, command compensation is performed on the premise that path control is performed for a two-inertia system representing the simplest vibration model. FIG. 1 shows a two-inertia system model handled by the motor control apparatus according to the first embodiment of the present invention.

(14) In FIG. 1, a motor 100 such as a servo motor and a machine 200 are mass points having a mass of J.sub.m and J.sub.L, respectively. Friction is ignored. The motor 100 and machine 200 are connected to each other by a spring 30 having a spring constant (stiffness coefficient of the elastically deformable part) K and a damper 40 having a damping constant C. In the figure, u denotes torque, V.sub.m the motor speed, V.sub.L the machine speed, T a combined force of the spring and the damper.

(15) The equations of motion of the motor 100 and machine 200, V.sub.m and V.sub.L, and the combined force T of the spring 30 and damper 40 are given as the following equations.

(16) $V_{m} = \frac{1}{J_{m} s} (u - T)$ $V_{L} = \frac{1}{J_{L} s} T$ $T = (\frac{K}{s} + C) (V_{m} - V_{L})$

(17) The above three equations are illustrated as in a block diagram in FIG. 2.

(18) On the basis of the above equations of motion and the equation of the combined force of the spring and damper, the transfer functions from torque u to motor speed V.sub.m and to machine speed V.sub.L can be determined as the following (Eq. 1) and (Eq. 2), respectively:

(19) $\begin{matrix} Torque .fwdarw. Motor Speed : \\ \frac{V_{m}}{u} = \frac{1}{s} .Math. \frac{J_{L} s^{2} + Cs + K}{J_{m} J_{L} s^{2} + (J_{m} + J_{L}) Cs + (J_{m} + J_{L}) K} & (Eq . 1) \\ Torque .fwdarw. Machine Speed : \\ \frac{V_{L}}{u} = \frac{1}{s} .Math. \frac{Cs + K}{J_{m} J_{L} s^{2} + (J_{m} + J_{L}) Cs + (J_{m} + J_{L}) K} & (Eq . 2) \end{matrix}$

(20) In recent motor control apparatuses, thanks to the control gain becoming higher and use of feed-forward control, the actual position of the motor is promptly controlled as soon as a move command is given to the motor. In other words, the transfer characteristics from the position command of the motor to the actual position of the motor is almost 1.

(21) FIG. 3 shows a scheme of the configuration of the motor control apparatus according to the first embodiment of the present invention. FIG. 4 shows its block diagram. A motor control apparatus 101 for controlling a servo motor according to the first embodiment of the present invention includes: a position command generator 20 for generating a position command of the motor; a compensation filter 1 for compensating the position command generated by the position command generator; and a servo control unit 2 for controlling the movement of the motor based on a position command after compensation, i.e., the position command compensated by the compensation filter 1, and is characterized in that the compensation filter 1 includes a filter F(s) having an inertia J.sub.L of a driven part, a stiffness coefficient K of an elastically deformable part and a damping coefficient C of the elastically deformable part as the elements of filter coefficients.

(22) The operation of the motor control apparatus according to the first embodiment of the present invention will be described. The position command generated by position command generator 20 is input to the compensation filter 1. The compensation filter 1 outputs a position command after compensation as a compensated position command. The servo control unit 2, based on the position command after compensation, outputs torque to control the movement of the motor 100. The movement of the motor 100 causes a transfer mechanism 300 to move the machine 200.

(23) In the servo control unit 2, the position command after compensation is input to a first subtractor 3, which subtracts the feedback of the detected value of the motor position from the input to output a position error, which is, in turn, input to a position controller 4. The position command after compensation is also input to a feed forward unit 5, then is differentiated by a differentiator 6 to output the speed. The output speed is supplied together with the output from position controller 4 to an adder 7, from which a speed command is output.

(24) The speed command is input to a second subtractor 8, which subtracts the feedback of the detected value of the motor speed from the input to output a speed error. The output speed error is supplied to a speed controller 9, which outputs torque. The torque is input to the motor. The motor dynamics is represented as transfer characteristic from torque to motor speed 10, and thus yields motor speed. The generated motor speed is kinematically integrated by a first integrator 11 to give a motor position. On the other hand, in the present invention, transfer characteristic 12 from torque to machine speed is taken into account. Torque is processed through transfer characteristic 12 from torque to machine speed, so that a machine speed is output. Machine speed is kinematically integrated by a second integrator 13 to give a machine position.

(25) The transfer characteristic from the position command of the motor to the actual position of the motor becoming close to 1, is equivalent to the transfer function from the point B to the point C in FIG. 4 becoming close to 1.

(26) In the motor control apparatus according to the first embodiment of the present invention, differing from notch filters or input shaping, as stated above a vibration suppression filter taking path precision into account is provided. To be more specific, the position command given to the servo control system is not a position command to the motor but is regarded as a position command to the machine. This means that the motor is allowed to vibrate as long as the machine is not vibrated, which is markedly different from the conventional concept of notch filters or input shaping that “the components of energy corresponding to the resonance frequencies are removed”.

(27) The position command given to the servo control system is regarded as the position command to the machine. Accordingly, it is necessary to perform control such that the transfer characteristic from points A to D will approach to 1. Herein, when the transfer characteristic from points B to C is assumed to be 1, it is understood that the transfer characteristic from points A to B needs to have an inverse characteristic to that from points C to D.

(28) As can be seen in FIG. 4, the reverse characteristic of the transfer characteristic from points C to D, i.e., the transfer characteristic from points D to C equivalent to the transfer characteristic from points D′ to C′. This transfer characteristic can be obtained by dividing the above Eq. 1 by Eq. 2 as follows:—

(29) $F (s) = \frac{V_{m}}{V_{L}} = \frac{J_{L} s^{2} + Cs + K}{Cs + K}$

(30) In the motor control apparatus according to the first embodiment of the present invention, attention is focused on the fact that this filter is dependent on the mechanical system constants (J.sub.L, C, K) only, hence the filter can be defined by these three constants. That is, the compensation filter 1 is characterized by inclusion of a filter F(s) having an inertia J.sub.L of a driven part, a stiffness coefficient K of an elastically deformable part and a damping coefficient C of the elastically deformable part as the elements of filter coefficients. FIGS. 5A and 5B show block diagrams of the filter F(s). FIG. 5B shows the F(s) in FIG. 5A represented with mechanical constants (J.sub.L, C, K).

(31) As described, according to the motor control apparatus according to the first embodiment of the present invention, it is possible to provide a vibration suppressing filter that is designed by taking path precision into consideration, differing from notch filters or input shaping.

Second Embodiment

(32) Next, a motor control apparatus according to the second embodiment of the present invention will be described. In view of ease of implementation of software, there are cases where calculating a compensation amount to be added to the position command is easier than directly performing a filtering process to the position command. To achieve this, the filtering characteristic determined in the first embodiment should be transformed into a compensation amount.

(33) Formation of a compensation amount to the position command can be done by subtracting 1 from the filter characteristic. The block diagram of the compensation filter of the motor control apparatus according to the first embodiment of the present invention is illustrated in FIG. 5. With this, the block diagram of the compensation filter for the motor control apparatus according to the second embodiment of the present invention can be represented as in FIGS. 6A and 6B. FIG. 6B expresses the F(s)−1 in FIG. 6A by use of the constants (J.sub.L, C, K) of the mechanical system. By simple calculation, it is understood that the transfer function can be given by the following equation.

(34) $F (s) - 1 = \frac{J_{L} s^{2}}{Cs + K}$

(35) In this way, the position command after compensation can be determined by adding a differential compensation amount for implementation of a filter F(s)−1 on the position command, to the position command.

(36) On the basis of the above equation, this equation can be written as follows:—

(37) $F (s) - 1 = \frac{J_{L} s^{2}}{K} \frac{1}{(C / K) s + 1}$

(38) Therefore, as another way of implementing the filter F(s) included in the compensation filter 1, the following method can be considered, which includes the steps of:

(39) determining an acceleration command (a value obtained by differentiating the position command twice because s.sup.2 (the square of Laplace operator or differential operator) is attached;

(40) multiplying the acceleration command by a gain J.sub.L/K, determined by the mechanical inertia J.sub.L and the spring constant K of the elastic part; and

(41) implementing a first order low-pass filter with a time constant of τ=C/K, determined by the damping constant C and the spring constant K.

(42) FIG. 7 shows a detailed block diagram of a filter of the motor control apparatus according to the second embodiment. Herein, the part for outputting an acceleration command is given as an acceleration command operator 1a. The part for multiplying a gain J.sub.L/K, determined by the inertia J.sub.L of the driven part and the stiffness coefficient K of the elastically deformable part is given as a first compensation amount operator 1b. The part for implementing a first order low-pass filter with a time constant of C/K, determined by the damping constant C of the elastically deformable part and the stiffness constant K of the elastically deformable part is given as a second compensation amount operator 1c. With this configuration, it is understood that the filter F(s) included in the compensation filter 1 can be realized by adding the second compensation amount output from the second compensation amount operator 1c to the position command.

(43) In the motor control apparatus according to the second embodiment of the present invention, the compensation filter 1 includes: an acceleration command operator 1a for calculating an acceleration command, from a position command; a first compensation amount operator 1b for multiplying the acceleration command output from the acceleration command operator 1a, by a gain J.sub.L/K, determined by the inertia J.sub.L of the driven part and the stiffness constant K of the elastically deformable part; and a second compensation amount operator 1c for implementing a first order low-pass filter with a time constant of C/K, determined by the damping constant C of the elastically deformable part and the stiffness constant K of the elastically deformable part, on the first compensation amount output from the first compensation amount operator 1b, and is characterized in that the filter F(s) is realized by adding the second compensation amount output from the second compensation amount operator 1c, to the position command.

(44) According to the motor control apparatus of the second embodiment of the present invention, it is possible to suppress vibration that takes the damping coefficient into account and hence is more realistic. As a result, it is possible to expect a high vibration suppressing effect compared to the conventional art.

Third Embodiment

(45) Next, a motor control apparatus according to the third embodiment of the present invention will be described.

(46) The constants J.sub.L, C and K that appear in the calculation formula F(s)−1, are all the elements that form the numerator polynomial of the following transfer function from torque to motor speed.

(47) $\frac{V_{m}}{u} = \frac{1}{s} .Math. \frac{J_{L} s^{2} + Cs + K}{J_{m} J_{L} s^{2} + (J_{m} + J_{L}) Cs + (J_{m} + J_{L}) K}$

(48) As often used in vibrating systems, the numerator polynomial of the transfer function from torque to motor speed is written in a quadratic standard form.

(49) $J_{L} s^{2} + Cs + K = J_{L} (s^{2} + \frac{C}{J_{L}} s + \frac{K}{J_{L}}) = J_{L} (s^{2} + 2 ζ ω s + ω^{2})$

(50) As a result, the gain and time constant can be determined as follows:—
Gain: J.sub.L/K=1/ω).sup.2
Time Constant: C/K=2ζ/ω

(51) Since input of the two constants, the frequency co and the damping factor ζ given in the quadratic standard form, is easier than input of the three constants, the mechanical inertia J.sub.L, damping constant C and spring constant K, in the motor control apparatus according to the third embodiment the filter F(s) included in the compensation filter is realized based on the frequency co and the damping factor ζ.

(52) FIG. 8 shows a detailed block diagram of a filter of the motor control apparatus according to the third embodiment. Herein, the part for outputting an acceleration command is given as an acceleration command operator 1a′. The part for dividing by the square of ω is given as a first compensation amount operator 1b′. The part for implementing a first order low-pass filter with a time constant of 2ζ/ω, determined by the vibration attenuation coefficient ζ and the frequency co is given as a second compensation amount operator 1c′. As a result, it is understood that the filter F(s) included in the compensation filter 1 can be realized by adding the second compensation amount output from the second compensation amount operator 1c′ to the position command.

(53) As described, the motor control apparatus according to the third embodiment of the present invention, is characterized in that, instead of inputting the gain J.sub.L/K, determined by the inertia J.sub.L of the driven part and the stiffness constant K of the elastically deformable part and the time constant of C/K, determined by the damping constant C of the elastically deformable part and the stiffness constant K of the elastically deformable part, the frequency co and the vibration attenuation coefficient ζ are input to realize the filter F(s) included in the compensation filter.

(54) As described heretofore, according to the motor control apparatus of the embodiments of the present invention, it is possible to compensate the two-inertia system, which is the simplest vibration model, on the basis of path control.

Motor controlling apparatus for suppressing vibrations

Assignee

Inventors

Cpc classification

Classification Explorer

G05B19/404

PHYSICS

Classification Explorer

G05B2219/41251

PHYSICS

Classification Explorer

G05B19/19

PHYSICS

Classification Explorer

G05B2219/41427

PHYSICS

Classification Explorer

G05B2219/41145

PHYSICS

International classification

Classification Explorer

G05B19/404

PHYSICS

Classification Explorer

G05B19/19

PHYSICS

Abstract

Claims

Description