Synchronization control device
11012012 · 2021-05-18
Assignee
Inventors
Cpc classification
H02P5/60
ELECTRICITY
H02P5/46
ELECTRICITY
International classification
Abstract
Provided is a synchronization control device that can control a mechanical system with good track followability. A control unit for each shaft of the synchronization control device includes: a delay time compensator which delays a position command to an FB torque command generation unit, and of which equivalent time constant is approximately the same as an equivalent time constant as a gain compensator. The synchronization control device also includes a phase adjustment unit, which adjusts a phase of at least one of the position commands, in a previous stage of each control unit, so that the time until the position command, input to each control unit, is output from the delay time compensator, becomes approximately the same.
Claims
1. A synchronization control device that controls a first motor and a second motor, comprising: an adjustment unit where a first position command that is a position command for the first motor, and a second position command that is a position command for the second motor are to be input, and at least one of a phase of the first position command which were input and a phase of the second position command which were input is adjusted; a first feed forward (FF) torque command generation unit that generates a first FF torque command on the basis of the first position command which is input via the adjustment unit; a first delay time compensator that filters the first position command which is input via the adjustment unit; a first feed back (FB) torque command generation unit that generates a first FB torque command on the basis of the first position command which passed through the first delay time compensator, and a measurement result of an index value of a position of the first motor or a position of a mechanical load driven by the first motor; a first gain compensator that filters a first torque command acquired by adding the first FF torque command and the first FB torque command; a first motor control unit that controls the first motor in accordance with the first torque command which passed through the first gain compensator; a second FF torque command generation unit that generates a second FF torque command on the basis of the second position command which is input via the adjustment unit; a second delay time compensator that filters the second position command which is input via the adjustment unit; a second FB torque command generation unit that generates a second FB torque command on the basis of the second position command which passed through the second delay time compensator, and a measurement result of an index value of a position of the second motor or a position of a mechanical load driven by the second motor; a second gain compensator that filters a second torque command acquired by adding the second FF torque command and the second FB torque command; and a second motor control unit that controls the second motor in accordance with the second torque command which passed through the second gain compensator, wherein the first delay time compensator has an equivalent time constant which is in accordance with an equivalent time constant of the first gain compensator, the second delay time compensator has an equivalent time constant which is in accordance with an equivalent time constant of the second gain compensator, and the adjustment unit adjusts at least one of the phase of the first position command and the phase of the second position command such that the difference between a time until the input first position command is output from the first delay time compensator and a time until the input second position command is output from the second delay time compensator becomes smaller.
2. The synchronization control device according to claim 1, wherein the first delay time compensator has an equivalent time constant that is the same as the equivalent time constant of the first gain compensator, and the second delay time compensator has an equivalent time constant that is the same as the equivalent time constant of the second gain compensator.
3. The synchronization control device according to claim 1, wherein the adjustment unit adjusts at least one of the phase of the first position command and the phase of the second position command such that the difference between a time until the input first position command is output from the first delay time compensator and a time until the input second position command is output from the second delay time compensator becomes “0”.
4. The synchronization control device according to claim 1, wherein the equivalent time constant of the second delay time compensator is larger than the equivalent time constant of the first delay time compensator, and the adjustment unit adjusts the phase of the second position command without adjusting the phase of the first position command.
5. The synchronization control device according to claim 4, wherein the adjustment unit is an all-pass filter that adjusts the phase of the second position command.
6. The synchronization control device according to claim 1, wherein the adjustment unit includes a first all-pass filter which adjusts the phase of the first position command, and a second all-pass filter which adjusts the phase of the second position command.
7. The synchronization control device according to claim 1, wherein the first delay time compensator is a low-pass filter or an all-pass filter, and the second delay time compensator is a low-pass filter or an all-pass filter.
Description
BRIEF DESCRIPTION OF DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
(14)
(15)
(16)
(17)
DESCRIPTION OF EMBODIMENTS
Application Example
(18) An application example of the present invention will be described first.
(19) The present invention is applied to a synchronization control device having a configuration illustrated in
(20) This synchronization control device is a device that synchronously controls two shafts (two motors 30 to which a load 35 is connected). The synchronization control device includes a control unit 50 which controls a first motor 30 on the basis of a first position command, and a control unit 50 which controls a second motor 30 on the basis of a second position command. In
(21) An n-th (n=1, 2) FF torque command generation unit 11 is a unit (functional block) that generates a feed forward (FF) torque on the basis of the n-th position command. An n-th FB torque command generation unit 13 is a unit that generates a feed back (FB) torque command which compensates excess or deficiency of the FF torque command on the basis of the difference between the actual position of the n-th motor 30, which is detected by a position detector 31 installed in the n-th motor 30, and the n-th position command. The information that is input to each FB torque command generation unit 13 from the motor 30 side may be a measurement result of information by which the position of the motor 30 or the position of a load (mechanical load) 35 can be detected. Therefore, the information that is input to the FB torque command generation unit 13 from the motor 30 side may be a measurement result of the velocity of the motor 30, the position of the load 35, the velocity of the load 35 or the like.
(22) Each gain compensator 14, to which a result of adding the FF torque command and the FB torque command by an adder 18 (hereafter called a torque command) is input, is a digital filter to decay a signal in a specific frequency band (e.g. notch filter, torque filter). Each inverter unit (INV) 15 is a unit constituted of an inverter that generates current which is supplied to the motor 30, and a pulse width modulation (PWM) control unit which PWM-controls the inverter in accordance with a torque command supplied by the gain compensator 14.
(23) In the case of controlling the motor 30 by the control unit 50 having the above mentioned configuration, transfer of the torque command to the inverter unit 15 is delayed by a gain compensator 14. Hence, the transfer of the actual position also delays accordingly, but the position command, by which the difference from the actual position is calculated, is not delayed in the FB torque command generation unit 13. Therefore, the FB torque command generated by the FB torque command generation unit 13 of the control unit 50 includes an error generated by the difference of delay times between the transfer of the position command and that of the actual position.
(24) The delay time of the actual position is in accordance with the equivalent time constant of the gain compensator 14. The characteristic of the gain compensator 14, however, is determined in accordance with the resonance frequency and the like of the load 35, hence the equivalent time constant of the gain compensator 14 in each control unit 50 is normally different. Hence in the case of the synchronization control device having the configuration illustrated in
(25) Therefore in order to improve the track followability of the above mentioned type of synchronization control device, the present invention uses the configuration illustrated in
(26) The n-th (n=1, 2) control unit 10 of the synchronization control device (
(27) A phase adjustment unit 20, which is disposed in the previous stage of the two control units 10, is a unit that adjusts at least one of the phase of the first position command and the phase of the second position command, so that the time difference between the time until the first position command is output from the first delay time compensator 12 and the time until the second position command is output from the second delay time compensator 12 becomes smaller than that in the case of not adjusting the phases of these position commands. This phase adjustment unit 20 may be any unit, as long as the above mentioned time difference can be decreased. Therefore, as illustrated in
(28) The hardware configuration of the synchronization control device is not especially limited. For example, as illustrated in
(29) The present invention will be concretely described on the basis of embodiments. In each embodiment to be described herein below as well, a control unit, to which the n-th position command is input, is called the n-th control unit, and each unit in the n-th control unit is called the n-th unit.
Embodiment 1
(30)
(31) As illustrated in
(32) In the synchronization control device 1, a notch filter NF1 and a notch filter NF2 are used for the first delay time compensator 12 and the second delay time compensator 12 respectively. In other words, the synchronization control device 1 has a configuration where the equivalent time constant τ.sub.d1 (=τ.sub.nf1) of the first delay time compensator 12 matches with the equivalent time constant τ.sub.g1 (=τ.sub.nf1) of the first gain compensator 14, and the equivalent time constant τ.sub.d2 (=τ.sub.nf2) of the second delay time compensator 12 matches with the equivalent time constant τ.sub.g2 (=τ.sub.nf2) of the second gain compensator 14.
(33) The phase adjustment unit 20 of the synchronization control device 1 includes a notch filter NF2 and a notch filter NF1 for the first phase adjustor 21 and the second phase adjustor 21 respectively. The phase adjustment unit 20 also includes a low-pass filter LPF2, of which equivalent time constant τ.sub.p2 is the same as the equivalent time constant τ.sub.nf1 of the notch filter NF1, for the second phase adjustor 21.
(34) When the first phase adjustor 21 is the notch filter NF2, the total of equivalent time constants of the filters (first phase adjustor 21, first delay time compensator 12), through which the first position command passes before reaching the first FB torque command generation unit 13, is “τ.sub.nf2+τ.sub.nf1”. When the second phase adjustor 21 is the notch filter NF1, the total of equivalent time constants of the filters (second phase adjustor 21, second delay time compensator 12) through which the second position command passes before reaching the second FB torque command generation unit 13, is “τ.sub.nf1+τ.sub.nf2”. Therefore, according to the phase adjustment unit 20 having the above configuration, the time difference between the time until the first position command is output from the first delay time compensator 12, and the time until the second position command is output from the second delay time compensator 12, can be decreased, compared with the case of not including the phase adjustment unit 20.
(35) Further, in the synchronization control device 1, the equivalent time constant τ.sub.d1 of the first delay time compensator 12 matches with the equivalent time constant τ.sub.g1 of the first gain compensator 14, and the equivalent time constant τ.sub.d2 of the second delay time compensator 12 matches with the equivalent time constant τ.sub.g2 of the second gain compensator 14, as mentioned above. Therefore, according to the synchronization control device 1, the two motors 30 can be well controlled.
(36) As a concrete example,
(37) The simulation results in
(38)
In these transfer functions, do (n=1, 2), ζ.sub.n and ω.sub.n are the notch depth, decay constant and central frequency of the notch filter NF.sub.n respectively.
(39) As indicated in
(40) In the case of the phase non-compensated device (the synchronization control device 1 from which the phase adjustment unit 20 is eliminated), the n-th (n=1, 2) position command is processed by the notch filter NF.sub.n (the n-th delay time compensator 12) that is the same as the notch filter NF.sub.n which processes the n-th torque command (n-th gain compensator). Therefore, if the mechanical system is controlled using the phase non-compensated device, the track reproducibility improves, as indicated in
(41) The synchronization control device 1, on the other hand, includes the phase adjustment unit 20 having the above configuration. Therefore, if the mechanical system is controlled using the synchronization control device 1, the mechanical system can be controlled without a major inclination of the actual track and increase in the amount of error, as indicated in
Embodiment 2
(42)
(43) As illustrated in
(44) In the synchronization control device 2, however, not the notch filter NF1 but a low-pass filter LPF1, of which equivalent time constant τ.sub.p1 is the same as the equivalent time constant T.sub.nf1 of the notch filter NF1 (first gain compensator 14), is used for the first delay time compensator 12. Further, in the synchronization control device 2, not the notch filter NF2 but a low-pass filter LPF2, of which equivalent time constant τ.sub.p2 is the same as the equivalent time constant τ.sub.nf2 of the notch filter NF2 (second gain compensator 14), is used for the second delay time compensator 12. The phase adjustment unit 20 of the synchronization control device 2 includes a low-pass filter LPF2 and a low-pass filter LPF1 as the first phase adjustor 21 and the second phase adjustor 21 respectively.
(45) This synchronization control device 2 as well, just like the synchronization control device 1, has a configuration where the equivalent time constant τ.sub.d1 (=τ.sub.p1=τ.sub.nf1) of the first delay time compensator 12 matches with the equivalent time constant τ.sub.g1 (=τ.sub.nf1) of the first gain compensator 14, and the equivalent time constant T.sub.d2 (=T.sub.p2=T.sub.nf2) of the second delay time compensator 12 matches with the equivalent time constant τ.sub.g2 (=τ.sub.nf1) of the second gain compensator 14. In the synchronization control device 2, just like the synchronization control device 1, the total of the equivalent time constants of the first phase adjustor 21 and the first delay time compensator 12 matches with the total of the equivalent time constants of the second phase adjustor 21 and the second delay time compensator 12.
(46) Therefore according to the synchronization control device 2, synchronization of the two shafts can be controlled well, as indicated in
(47) The actual track in
(48)
(49) As indicated in
Embodiment 3
(50)
(51) As the comparison between
(52) In concrete terms, the phase adjustment unit 20 of the synchronization control device 3 is constituted of the second phase adjustor 21 alone, which adjusts the phase of the second position command. For this second phase adjustor 21, a low-pass filter LPF0, of which equivalent time constant τ.sub.p0 matches with the “equivalent time constant τ.sub.d1 of the first delay time compensator 12—the equivalent time constant τ.sub.da2 of the second delay time compensator 12” is used. The first delay time compensator 12 and the second delay time compensator 12 according to Embodiment 3 are low-pass filter LPF1 and low-pass filter LPF2 respectively. In the case of the synchronization control device 3, τ.sub.p0=τ.sub.p1−τ.sub.p2, and τ.sub.p0=τ.sub.nf2−τ.sub.nf2 are also established.
(53) When the phase adjustment unit 20 has the above configuration, the total of the equivalent time constants of the filters (first delay time compensator 12), through which the first position command passes before reaching the first FB torque command generation unit 13, is τ.sub.d1. The total of the equivalent time constants of the filters (second phase adjustor 21, second delay time compensator 12), through which the second position command passes before reaching the second FB torque command generation unit 13, is τ.sub.d1−τ.sub.d2+τ.sub.d2=τ.sub.d1.
(54) In other words, in the case of the phase adjustment unit 20 having the above configuration as well, the total of the equivalent time constants of the filters, through which the first position command passes before reaching the first FB torque command generation unit 13, matches with the total of the equivalent time constants of the filters, through which the second position command passes before reaching the second FB torque command generation unit 13. Further, according to the phase adjustment unit 20 having the above configuration, the time difference between the time until the first position command is output from the first delay time compensator 12 and the time until the second position command is output from the second delay time compensator 12 can be decreased without delaying the phase of the first position command.
(55) Therefore according to the synchronization control device 3, the two shafts can be controlled with better track followability than the synchronization control device 2, as indicated in
Embodiment 4
(56)
(57) The synchronization control device 4 according to Embodiment 4 is a device where each low-pass filter of the synchronization control device 3 (
(58) In concrete terms, in the synchronization control device 4, an all-pass filter APF1, of which equivalent time constant τ.sub.a1 matches with the equivalent time constant τ.sub.nf1 of the notch filter NF1 used for the first gain compensator 14, is used for the first delay time compensator 12. Further, in the synchronization control device 4, an all-pass filter APF2, of which equivalent time constant τ.sub.a2 matches with the equivalent time constant τ.sub.nf2 of the notch filter NF2 used for the second gain compensator 14, is used for the second delay time compensator 12.
(59) The phase adjustment unit 20 of the synchronization control device 4 does not include the first phase adjustor 21, and includes for a second phase adjustor 21 an all-pass filter APF0, of which equivalent time constant Tao matches with “the equivalent time constant τ.sub.d1 (=τ.sub.a1) of the first delay time compensator 12—equivalent time constant τ.sub.d2 (=τ.sub.a2) of the second delay time compensator 12”.
(60) If the phase adjustor 21 or the delay time compensator 12 has a gain characteristic, the track reproducibility may drop because of this gain characteristic, but the synchronization control device 4 according to Embodiment 4 uses an all-pass filter which has no gain characteristic, for the phase adjustor 21 and the delay time compensator 12. Therefore, according to the synchronization control device 4, the mechanical system can be controlled with better track reproducibility than the above mentioned synchronization control devices 1 to 3, or the synchronization control devices 1 to 3 where all-pass filters are used for part of the phase adjustor 21 and the delay time compensator 12.
(61) As a concrete example,
(62)
<Modification>
(63) The above mentioned synchronization control device of each embodiment may be modified in various ways. For example, the synchronization control device of each embodiment may be modified as a device that controls three or more shafts. In order to modify the synchronization control device as a device that controls P (≥3) shafts, the control unit 10 having the above configuration is added to the synchronization control devices 1 to 4 for P-2 to P shafts, and instead of the above mentioned phase adjustment unit 20 for two shafts, a phase adjustment unit that can make “the equivalent time constant of the phase adjustor 21+the equivalent time constant of the delay time compensator 12” to be approximately the same for all shafts, is used, for example.
(64) In the synchronization control device of each embodiment, a phase adjustment unit 20, that performs the phase advance compensation instead of the phase delay compensation, may be used. The phase adjustment unit 20 of the synchronization control device may be disposed on the side of the host device (e.g. a programmable logic controller (PLC)), which outputs a position command.
(65) <Addition>
(66) To compare the configuration requirements of the present invention and the configuration of each embodiment, the configuration requirements of the invention according to Claim 1 will be stated herein below with the reference signs used in the drawings.
(67) [Claim1]
(68) A synchronization control device that controls a first motor (30) and a second motor (30), comprising:
(69) an adjustment unit (20) where a first position command that is a position command for the first motor (30), and a second position command that is a position command for the second motor (30) are to be input, and at least one of a phase of the first position command which were input and a phase of the second position command which were input is adjusted;
(70) a first feed forward (FF) torque command generation unit (11) that generates a first FF torque command on the basis of the first position command which is input via the adjustment unit (20);
(71) a first delay time compensator (12) that filters the first position command which is input via the adjustment unit (20);
(72) a first feed back (FB) torque command generation unit (13) that generates a first FB torque command on the basis of the first position command which passed through the first delay time compensator (12), and a measurement result of an index value of a position of the first motor (30) or a position of a mechanical load (35) driven by the first motor (30);
(73) a first gain compensator (14) that filters a first torque command acquired by adding the first FF torque command and the first FB torque command;
(74) a first motor control unit (15) that controls the first motor (30) in accordance with the first torque command which passed through the first gain compensator (14);
(75) a second FF torque command generation unit (11) that generates a second FF torque command on the basis of the second position command which is input via the adjustment unit (20);
(76) a second delay time compensator (12) that filters the second position command which is input via the adjustment unit (20);
(77) a second FB torque command generation unit (13) that generates a second FB torque command on the basis of the second position command which passed through the second delay time compensator (12), and a measurement result of an index value of a position of the second motor (30) or a position of a mechanical load (35) driven by the second motor (30);
(78) a second gain compensator (14) that filters a second torque command acquired by adding the second FF torque command and the second FB torque command; and
(79) a second motor control unit (15) that controls the second motor (30) in accordance with the second torque command which passed through the second gain compensator (14), wherein
(80) the first delay time compensator (12) has an equivalent time constant which is in accordance with an equivalent time constant of the first gain compensator (14),
(81) the second delay time compensator (12) has an equivalent time constant which is in accordance with an equivalent time constant of the second gain compensator (14), and
(82) the adjustment unit (20) adjusts at least one of the phase of the first position command and the phase of the second position command such that the difference between a time until the input first position command is output from the first delay time compensator (12), and a time until the input second position command is output from the second delay time compensator (12) becomes smaller.
REFERENCE SIGNS LIST
(83) 1, 2, 3, 4 Synchronous control device 10, 50 Control unit 11 FF torque command generation unit 12 Delay time compensator 13 FB torque command generation unit 14 Gain compensator 15 Invertor unit 18 Adder 20 Phase adjustment unit 21 Phase adjustor 22 Detection unit 30 Motor 31 Position detector 35 Load