METHOD OF CONTROLLING SERVO MOTOR

Abstract: In order to derive a high power output, a servo motor has two coils with inductance La, Lb, resistance Ra, Rb and reverse voltage Ka, Kb, respectively, which carry currents (Ia,Ib) of the same phase. Its control system is provided with two separate integration (9) and proportion (10) controllers for the two coils whilst an error amplifier (2) and a pulse-width modulation control unit (3) operate based on a control signal obtained as a sum of the two outputs. Given an instruction current (Ir), the two currents (Ia,(b) are controlled more or less independently.

Description: The present invention relates to a method for controlling a servomotor, and more particularly, to a drive control method for a servomotor, in which a high output can be fetched from the servomotor by means of a motor-current control unit of a simple construction. The recent mainstream of servomotor drive control is PWM control using semiconductor switching elements, such as power transistors, thyristors, etc. Also, there is a demand that a high output should be obtained from servomotors. In order to obtain a high output from a servomotor, a large current must be supplied to the semiconductor elements. It is difficult, however, to obtain semiconductor elements which permit a large current to be applied thereto. Even if a large current is allowed to flow through a semiconductor element, moreover, the semiconductor element has the property of generating heat in its active region, and hardly in its cut-off region and saturated region. Therefore, the calorific value of the semiconductor element increases in proportion to the chopping frequency, so that the chopping frequency must be lowered. If the chopping frequency is lowered, however, the motor control inevitably becomes difficult. Thereupon, a tentative arrangement is provided such that each of switching elements of a PWM control section is composed of a plurality of semiconductor elements, and the driving current of the servomotor is increased by reducing the currents flowing through the individual semiconductor elements. In such a case, however, current concentration in the semiconductor elements (or large current flow only in some of the semiconductor elements) is caused, so that the driving current cannot be increased in proportion to the number of parallel-connected semiconductor elements. Conventionally, therefore, a high output is obtained by operating a plurality of motors in a parallel manner. In this case, however, it is necessary to mechanically connect the individual motors with one another and with an output shaft. This results in an increase in cost. An object of the present invention is to provide a drive control method for a servomotor, in which a high output can be fetched from the servomotor while preventing switching elements of a motor-current control unit from being damaged by excess current. Another object of the present invention is to provide a drive control method for a servomotor which can be effected by using a motor-current control unit of a simple construction. According to the present invention there is provided a method for controlling the phase current in a servomotor comprising a plurality of winding portions in each armature phase, comprising the steps of: a) generating a command current common to said plurality of winding portions; b) for each of said plurality of winding portions calculating and integrating with the use of an integrating element the individual deviation between said command current and the individual current flowing through each of said plurality of winding portions, calculating the individual deviation between the output of said integrating element and the output of a proportional element amplifying said individual current; c) obtaining a control signal common to said plurality of winding portions by adding all the individual deviations calculated in step b); d) amplifying said control signal by the use of a common error amplifier means; e) controlling the individual current supplied to said plurality of winding portions by the means of a common PWM control means and individual voltage amplifier means; the constant of the individual proportional elements and the constant of the total transfer function of error amplifier means, the PWM control means and the voltage amplifier means being set to be larger than the other parameters of the transfer functions of the individual winding portions. Thus, according to the present invention, the control signal is obtained with use of the integrating element and the proportional element corresponding to each of the plurality of winding portions, which constitute the armature winding of each phase of the servomotor. Therefore, the current flowing through the individual winding portions can be controlled independently for equal values by the use of one PWM control means. Thus, a high output can be obtained from the servomotor, and besides, a motor-current control section can be simplified in construction and lowered in cost. Brief Description of the Drawings Fig. 1 is a block diagram of a motor-current control unit to which is applied a method for controlling a servomotor according to an embodiment of the present invention; Fig. 2 is a block diagram showing a typical example of a speed control section of a DC servomotor; Fig. 3 is a block diagram showing an example of the arrangement of a current control section used for the control of a servomotor having an armature winding composed of a plurality of winding portions; and Fig. 4 is a block diagram showing a modification of the arrangement of Fig. 3 in which a PWM control section and the like are used in common. Before describing the present invention, a typical example of speed control of a DC servomotor will be explained with reference to Fig. 2. Fig. 2 shows only those elements which are related to one phase of the motor. In Fig. 2, the difference between a speed command r delivered from an error register or the like and an actual speed V of the servomotor detected by a speed detector is amplified by an error amplifier 1, and is delivered as a current command Ir to an error amplifier 2. The difference between the current command Ir and a present drive current Ia detected by a current detector is amplified. Then, an armature winding of the servomotor is supplied with a drive current from a voltage amplifier 4, which is controlled by a PWM control section 3 operating in response to an output from the error amplifier 2. Numerals 5, 6 and 7 denote transfer functions based on an inductance La of the armature winding, a resistance Ra of the winding, and a back electromotive voltage constant Ka of the servomotor, respectively. Numeral 8 denotes a transfer function for conversion from an output torque of the servomotor to a speed. Symbols Kt and Jm designate a torque constant and a resultant inertial efficiency of the servomotor and a load, respectively. In order to increase the servomotor output without applying excess current to semiconductor elements of the PWM control section 3, the inventors hereof first devised an arrangement shown in Fig. 3, in which the armature winding of each phase of the motor is composed of two independent winding portions, and in which a PWM-controlled drive current is fed to each of the winding portions. The two independent winding portions, which constitute each phase, are located relatively to the slots (not shown) of an armature so as to act equally on a rotor in phasic relation. Namely, the winding of each phase of a conventional servomotor is divided so that each phase includes two independent winding portions. The simplest way to attain this, for example, is to arrange two independent winding portions of the same phase in the same slot of the armature. Also when arranging two winding portions of the same phase in different slots, it is necessary only that the two winding portions be relatively located so as to act equally on the rotor. In Fig. 3, elements 2 to 7 identical with the elements shown in Fig. 2 are arranged corresponding to a first winding portion, while similar elements 2' to 7' are arranged corresponding to a second winding portion. Symbols La, Ra, and Ka designate an inductance, resistance, and back electromotive voltage constant, respectively, at the first winding portion, and symbol Ia designates a current flowing through the first winding portion. Symbols Lb, Rb, and Kb designate an inductance, resistance, and back electromotive voltage constant at the second winding portion, and symbol Ib designates a current flowing through the second winding portion. If error amplifiers 2 and 2', PWM control sections 3 and 3', voltage amplifiers 4 and 4', etc., are arranged in their corresponding winding portions, as shown in Fig. 3, the individual winding portions are controlled independently. Accordingly, there is no interference between the currents flowing through the winding portions, and this arrangement is equivalent to one which controls two motors. This arrangement is uneconomical, however, since it requires the error amplifiers, PWM control sections, and voltage amplifiers in pairs. Thereupon, an arrangement of Fig. 4 has been contrived in which the current control section shown in Fig. 3 is modified so that the error amplifier and the PWM control section 3 are used in common for the first and second winding portions. Analyzing the block diagram of Fig. 4, we obtain the following eqs. (1) to (3): {(2Ir - Ia - Ib)·G(S)·Kv - Ia·La·S - V·Ka}·(1/Ra) = Ia, (1) {(2Ir - Ia - Ib)·G(S)·Kv - Ib·Lb·S - V·Kb}·(1/Rb) = Ib, (2) (Ia + Ib)·(Kt/Jm·S) = V, (3) where G(S) is the transfer function of the error amplifier 2 and the PWM control section 3, and Kv is the transfer function of the voltage amplifiers 4 and 4'. Rearranging eq. (1), we obtain (2Ir - Ib)·G(S)·Kv - Ka·V = {Ra + La·S + G(S)·Kv}Ia. (4) Rearranging eq. (2), we obtain (2Ir - Ia)·G(S)·Kv - Kb·V = {Rb + Lb·S +G(S)·Kv}Ib. (5) Substituting for eqs. (4) and (5) from eq. (3) and rearranging the resulting equations, we obtain the following eqs. (6) and (7). Solving eqs. (6) and (7), we obtain As seen from eq. (8), the currents Ia and Ib flowing through the two winding portions are not independent of each other and are different from each other, with their ratios to the speed command Ir varying according to variations of parameters. Based on the above consideration, the present invention is arranged so that the currents Ia and Ib flowing through the two winding portions are independent of each other. More specifically, integrating elements 9 and 9', whose transfer function is Ki/S, are arranged individually in the stages preceding the error amplifier 2, whereby the deviations between the command current Ir for the first and second winding portions and the currents Ia and Ib flowing through the winding portions are integrated. Also, the currents Ia and Ib flowing through the first and second winding portions are amplified, respectively, by proportional elements 10 and 10' whose transfer function is Kp. Further, the deviations between the outputs of the integrating elements 9 and 9' and the proportional elements 10 and 10' are obtained, and the sum total of these deviations is then supplied to the PWM control section 3 via the error amplifier 2. Referring now to the block diagram of Fig. 1, an analysis will be made. First, if the total transfer function of the error amplifier 2, PWM control section 3, and voltage amplifier 4 and that of the error amplifier 2, PWM control section 3, and voltage amplifier 4' are Kv(1) and Kv(2), respectively, the following eqs. (9) to (11) hold for the currents Ia and Ib flowing through the first and second winding portions. [{(Ir - Ia)· Ki S - Ia·Kp + (Ir - Ib)· Ki S - Ib·Kp} Kv(1) - Ia·La·S - V·Ka]· 1 Ra = Ia, (9) [{(Ir - Ia)· Ki S - Ia·Kp + (Ir - Ib)· Ki S - Ib·Kp} Kv(2) - Ib·Lb·S - V·Kb]· 1 Rb = Ib, (10) (Ia + Ib)·(Kt/Jm·S) = V. (11) Substituting for V of eq. (9) from the left side of eq. (11) and rearranging the resulting equation, we obtain the following eq. (12). Substituting for V of eq. (10) from the left side of eq. (11) and rearranging the resulting equation, moreover, we obtain the following eq. (13). Here if we have Kv(1), Kv(2) » 1 and Kv(1) = Kv(2) = Kv, eq. (12) can be approximated by the following eq. (14). Likewise, eq. (13) can be approximated by the following eq. (15). Since the respective left sides of eqs. (14) and (15) are identical, the following eq. (16) holds true. Since Ki·Kv/S is used in common for both sides of eq. (16), the following equation can be obtained by rearranging eq. (16). Further rearranging eq. (17), we obtain Here if Kp·Kv »1, and if other parameters are negligible, we obtain If the proportional constant Kv of the transfer function of the elements 2 to 4 and 2' to 4 and the proportional constant Kp of the transfer function of the interposed proportional elements 10 and 10', as shown in Fig. 1, are made greater than the other parameters, at least the PWM control section 3 can be used in common for the two winding portions. Also, the currents Ia and Ib flowing through the individual winding portions have substantially independent and equal values. Accordingly, the rotor of the servomotor is rotated by substantially equal rotatory forces which are attributable to the currents flowing through the two winding portions. Thus, the servomotor can produce a large output torque. Although the DC servomotor has been described in connection with the above embodiment, an AC servomotor may be used with the same result.

Claims: A method for controlling the phase current in a servomotor comprising a plurality of winding portions in each armature phase, comprising the steps of: a) generating a command current (Ir) common to said plurality of winding portions; b) for each of said plurality of winding portions calculating and integrating with the use of an integrating element (9) the individual deviation between said command current (Ir) and the individual current (Ia, Ib) flowing through each of said plurality of winding portions, calculating the individual deviation between the output of said integrating element and the output of a proportional element (10) amplifying said individual current (Ia, Ib); c) obtaining a control signal common to said plurality of winding portions by adding all the individual deviations calculated in step b); d) amplifying said control signal by the use of a common error amplifier means (2); e) controlling the individual current supplied to said plurality of winding portions by the means of a common PWM control means (3) and individual voltage amplifier means (4); the constant (Kp) of the individual proportional elements (10) and the constant (Kv) of the total transfer function of error amplifier means (2), the PWM control means (3) and the voltage amplifier means (4) being set to be larger than the other parameters of the transfer functions of the individual winding portions.

Inventors: KOBAYASHI, TOSHIO, SAKAMOTO, KEIJI
Applicants: FANUC LTD.
Application year: 1987
Main classification: H02P5
IPC codes: H02P29, H02P23, H02H7