MOTOR CONTROLLER

Abstract
A motor controller which controls a servo motor for driving a machine, includes: a speed command unit which commands the speed of the machine; a speed detection unit which detects the speed of the servo motor; and a speed control unit which produces a torque command based on a speed command and a motor speed detected so as to control the speed of the servo motor, where the speed control unit includes a filter which approximates the inverse characteristic of a transmission characteristic from the servo motor to the machine, the filter has a transmission characteristic F(s) based on a frequency ω, a vibration damping coefficient ζ and a cutoff frequency ωadj which are adjustment parameters and the frequency ω is adjusted so as to be equal to or more than an antiresonant frequency ω0 of the machine but less than a resonant frequency ωp.
Description

This application is based on and claims the benefit of priority from Japanese Patent application No. 2017-121341, filed on Jun. 21, 2017, the content of which is incorporated herein by reference.


BACKGROUND OF THE INVENTION
Field of the Invention

The present invention relates to a motor controller which controls a servo motor.


Related Art

For example, in a machine tool, a motor controller known which controls a servo motor so as to drive a feed axis. When in the machine tool described above, the servo motor and a machine are coupled with the feed axis such as a ball screw, the rigidity of the feed axis is low such that e servo motor and the machine are brought into a state of spring coupling. Due to the spring coupling, in the feed axis of the machine, low-frequency resonance (vibration) in a servo control band may occur.


As a method of reducing the low-frequency resonance (vibration) described above, a method of correcting a position command, a method of using a filter for a servo position control loop and the like are examined. Patent Documents 1 and 2 disclose a motor drive device in which in a motor controller for performing position control based on a position command to drive a feed axis in a machine tool, a filter is used for a servo position control loop.


Patent Document 1: Japanese Patent No. 6017595


Patent Document 2:Japanese Patent No. 6046182


SUMMARY OF THE INVENTION

In a motor controller for driving a spindle (drive unit) in a machine tool or in a motor controller for driving a hydraulic pump, a belt conveyor (drive unit) or the like in an industrial machine, without position control based on a position command being performed, speed control based on a speed command may be performed. In control on a feed axis (drive unit) in a machine tool, position control and speed control on one motor may be performed with separate motor controllers. The motor controller for performing such speed control itself is required to reduce low-frequency vibrations in the drive unit of a machine.


Although Patent Documents 1 and 2 disclose a method of reducing vibrations in the motor controller for performing the position control, they do not disclose a method of reducing vibrations in a motor controller for performing speed control.


An object of the present invention is to provide a motor controller which performs speed control based on a speed command and which reduces vibrations in the drive unit of a machine.


(1) A motor controller (for example, a motor controller 1 which will be described later) according to the present invention which controls a servo motor (for example, a servo motor 50 which will be described later) for driving a machine (for example, a machine 60 which will be described later (including a ball screw 70 )), includes: a speed command unit for example, a speed command unit 10 which will be described later) which issues a speed command for commanding the speed of the machine; a speed detection unit (for example, an encoder 40 which will be described later) which detects the speed of the servo motor; and a speed control unit (for example, a speed control unit 20 which will be described later) which produces a torque command based on the speed command issued by the speed command unit and a motor speed detected the speed detection unit so as to control the speed of the servo motor, where the speed control unit includes a filter (for example, a filter 31 or 32 which will be described later) which approximates the inverse characteristic of a transmission characteristic from the servo motor to the machine, the filter has a transmission characteristic F(s) of formula (1) below based on a frequency ω, a vibration damping coefficient and a cutoff frequency ωadj which are adjustment parameters and the frequency ω is adjusted so as to be equal to or more than an antiresonant frequency ω0 of the machine but less than a resonant frequency ωp of the machine.









[

Formula





1

]












F


(
s
)


=



s
2

+

2

ϛω





s

+

ω
2




s
2

+


2



ω
adj


s

+

ω
adj
2







(
1
)







(2) Preferably, in the motor controller according to (1), the speed control unit includes: a feedforward control unit (for example, a FF control unit 21) which produces a first torque command based on the speed command; a feedback control unit (for example, a FB control unit 23 which will be described later) which produces a second torque command based on a difference between the speed command and the motor speed; and an addition unit (for example, an adder 26 which will be described later) which adds together the first torque command and the second torque command so as to produce the torque command, and the feedforward control unit and the feedback control unit include the filters for which the transmission characteristic F(s) can be set individually and independently.


(3) Preferably, in the motor controller according to (2), the feedforward control unit includes the filter which approximates the inverse characteristic of a transmission characteristic from the torque command to a speed of the machine, and the feedback control unit includes the filter which approximates the inverse characteristic of a transmission characteristic from the motor speed to the speed of the machine.


Preferably, in the motor controller according to (2) or (3), the frequency ω in the transmission characteristic F(s) of the filter in the feedforward control unit can be adjusted in a range equal to or more than the frequency ω in the transmission characteristic F(s) of the filter in the feedback control unit.


According to the present invention, it is possible to provide a motor controller which performs speed control based on a speed command and which reduces vibrations in the drive unit of a machine.





BRIEF DESCRIPTION OF THE DRAWINGS


FIG. 1 is a schematic view of the configuration of a motor controller according to the present embodiment;



FIG. 2 is a diagram showing in detail the configuration of the motor controller according to the present embodiment;



FIG. 3 is is a diagram showing a configuration from a motor to a machine as a model of a two-inertia system model;



FIG. 4 is a block diagram of the two-inertia system shown in FIG. 3; and



FIG. 5 is a schematic view showing, as transmission characteristics, part of the motor controller according to the present embodiment.





DETAILED DESCRIPTION OF THE INVENTION

An example of an embodiment of the present invention will be described below with reference to accompanying drawings. In the drawings, the same or corresponding portions are identified with the same reference numerals.



FIG. 1 is a schematic view of the configuration of a motor controller according to the present embodiment, and FIG. 2 is a diagram showing in detail the configuration of the motor controller according to the present embodiment. The motor controller 1 shown in FIGS. 1 and 2 controls the speed of a servo motor 50 based on a speed command value corresponding to a machining program and an actual motor speed value (speed feedback value). The servo motor 50 is coupled to a ball screw 70 in a machine 60. The servo motor 50 rotates and drives the ball screw (drive unit) 70 so as to drive the machine 60. The motor controller 1 includes a speed command unit 10, a speed control unit 20 and an encoder (speed detection unit) 40.


The speed command unit 10 produces the speed command value for the servo motor 50 (that is, the speed command value for the machine 60) according to a program and a command input from a higher controller, an external input device or the like which is unillustrated.


The encoder 40 is provided in the servo motor 50 so as to detect the rotation speed of the servo motor 50. The detected motor speed is utilized as a speed feedback.


The speed control unit 20 produces a torque command value based on the speed command value produced in the speed command unit 10 and a motor speed value detected in the encoder 40. The speed control unit 20 includes a feedforward control unit (hereinafter referred to as a FF control unit) 21, a feedback control unit (hereinafter referred to as a FB control unit) 23 and an adder 26.


The FF control unit 21 produces a first torque command value based on the speed command value produced in the speed command unit 10. The FF control unit 21 includes a FF controller 22 and a filter 31.


The FF controller 22 differentiates the speed command value which is produced in the speed command unit 10 and which is then passed through the filter 31, and thereby produces the first torque command value.


The filter 31 is provided in the step preceding the FF controller 22. The filter 31 has the transmission characteristic F(s) of a formula (1) below based on a frequency ω, a vibration damping coefficient ζ and a cutoff frequency ωadj which are adjustment parameters.









[

Formula





2

]












F


(
s
)


=



s
2

+

2

ϛ





ω





s

+

ω
2




s
2

+


2



ω
adj


s

+

ω
adj
2







(
1
)







The frequency ω is adjusted in a range equal to or more than the antiresonant frequency ω0 of the machine 60 (the ball screw 70) but less than the resonant frequency ωp thereof, and is preferably set near the resonant frequency ωp. In this way, as will be described later, the transmission characteristic F(s) of the filter 31 approximates the inverse characteristic of the transmission characteristic based on a two-inertia system model from the servo motor 50 to the machine 60 (the ball screw 70), more specifically, the inverse characteristic of the transmission characteristic from a torque command to a machine speed.


The FB control unit 23 produces a second torque command value based on a difference between the speed command value produced in the speed command unit 10 and the motor speed value detected in the encoder 40. The FB control unit 23 includes a subtractor 24, a proportional-integral controller (hereinafter referred to as a PI controller) 25 and filter 32.


The subtractor 24 determines the difference between the speed command value produced in the speed command unit 10 and passed through the filter 32 and the motor speed value detected in the encoder 40. The PI controller 25 performs PI control on the difference determined in the subtractor 24 so as to produce the second torque command value.


The filter 32 is provided in the step preceding the subtractor 24. As with the filter 31, the filter 32 has the transmission characteristic F(s) of formula (1) above. The frequency ω is adjusted in the range equal to or more than the antiresonant frequency ω0 of the machine 60 (the ball screw 70) but less than the resonant frequency ωp thereof, and is preferably set near the antiresonant frequency ω0. In this way, as will be described later, the transmission characteristic F(s) of the filter 32 approximates the inverse characteristic of the transmission characteristic based on the two-inertia system model from the servo motor 50 to the machine 60 (the ball screw 70), more specifically, the inverse characteristic of the transmission characteristic from the motor speed to the machine speed.


For the filter 31 of the FF control unit 21 and the filter 32 of the FB control unit 23, the transmission characteristic F(s) can be set individually and independently. The frequency ω in the transmission characteristic F(s) of the filter 31 in the FF control unit 21 can be adjusted in a range equal to or more than the frequency ω in the transmission characteristic F(s) of the filter 32 in the FB control unit 23.


The adder 26 adds together the first torque command value from the FF control unit 21 and the second torque command value from the FB control unit 23.


Here, the rigidity of the ball screw 70 in the machine 60 is low such that the servo motor 50 and the machine 60 are brought into a state of spring coupling. Due to the spring coupling, in the ball screw 70 of the machine 60, low-frequency resonance (vibration) in a servo control band may occur.


In order to reduce the low-frequency resonance (vibration) in the ball screw 70 of the machine 60, the motor controller 1 of the present embodiment is characterized to include the filters 31 and 32 which have the transmission characteristic F(s) of formula (1) above that approximates the inverse characteristic of the transmission characteristic from the servo motor 50 to the machine 60 (the ball screw 70). A method of determining the transmission characteristic F(s) of the filters 31 and 32 will be described below.



FIG. 3 is a diagram showing the two-inertia system model from the servo motor 50 to the machine 60 (the ball screw 70), and FIG. 4 is a block diagram of the two-inertia system model shown in FIG. 3. In the two-inertia system model shown in FIG. 3, the servo motor 50 and the machine 60 are mass points, and are coupled with a spring 70A and a dumper 70B corresponding to the ball screw 70. In FIG. 3, friction is ignored. Here, it is assumed that the masses of the servo motor 50 and the machine 60 are respectively Jm and JL, that the spring constant of the spring 70A is K, that the dumper constant of the dumper 70B is C, that the drive torque (torque command) of the servo motor 50 is u, that the resultant force of the spring 70A and the dumper 70B is that the motor speed is Vm and that the machine speed is VL, the motion equations of Vm and VL and the resultant force T of the spring 70A and the dumper 70B are represented by formulas below.









[

Formula





3

]













V
m

=


1


J
m


s




(

u
-
T

)










V
L

=


1


J
L


s



T








T
=


(


K
s

+
C

)



(


V
m

-

V
L


)















In this way, the model shown in FIG. 3 is represented by the block diagram shown in FIG. 4. The motion equations of Vm and VL and the formula of the resultant force T of the spring 70A and the dumper 70B are modified, and thus the transmission characteristic from the torque (torque command) u to the motor speed Vm and the transmission characteristic from the torque (torque command) u to the machine speed VL are respectively determined by formulas below. Torque→motor speed (transmission characteristic):














[

Formula





4

]














V
m

u

=



1
s






J
L



s
2


+
Cs
+
K




J
m



J
L



s
2


+


(


J
m

+

J
L


)


Cs

+


(


J
m

+

J
L


)


K




=


1


J
m


s






s
2

+

2


ϛω
0


s

+

ω
0
2




s
2

+

2


ϛ




ω
p


s

+

ω
p
2









(
2
)







Torque→machine speed (transmission characteristic):














[

Formula





5

]














V
L

u

=



1
s




Cs
+
K




J
m



J
L



s
2


+


(


J
m

+

J
L


)


Cs

+


(


J
m

+

J
L


)


K




=


1


J
m


s






2


ϛω
0


s

+

ω
0
2




s
2

+

2


ϛ




ω
p


s

+

ω
p
2









(
3
)







In formulas (2) and (3) above, forms which are converted into a secondary standard system are simultaneously represented. Here, ωp and ζ′ are a resonant frequency and a vibration damping coefficient when the servo motor 50 is fixed in the two-inertia system model, and ω0 and ζ are an antiresonant frequency and a vibration damping coefficient thereof. The antiresonant frequency ω0 and the resonant frequency ωp are represented by formulas below.














[

Formula





6

]













ω
0

=


K

J
L







(
4
)







ω
p

=



(

1
+


J
L


J
m



)



K

J
L








(
5
)







By formulas (2) and (3) above, the transmission characteristic from the motor speed Vm to the machine speed VL is represented by formula below. Motor speed→machine speed (transmission characteristic):









[

Formula





7

]













V
L


V
m


=



2


ϛω
0


s

+

ω
0
2




s
2

+

2


ϛω
0


s

+

ω
0
2







(
6
)








FIG. 5 is a diagram showing, as transmission characteristics, part of the motor controller according to the present embodiment. In FIG. 5, the configuration from the servo motor 50 to the machine 60 (the ball screw 70) shown in FIG. 2 is shown by the transmission characteristic from the torque (torque command) u to the motor speed Vm, the transmission characteristic from the torque (torque command) u to the machine speed VL and the transmission characteristic from the motor speed Vm to the machine speed VL described above.


Here, the speed command issued by the speed command unit 10 is considered to be a command for the machine speed. This is a way of considering the reduction of vibrations in the machine 60 (the ball screw 70) regardless of whether or not vibrations are present from the speed command to the machine speed, that is, in the step preceding the machine 60 (the ball screw 70).


In order to consider that the speed command is a command for the machine speed, it is preferable to make the transmission characteristic from the speed command to the machine speed approach 1. Preferably, in order for the transmission characteristic from the speed command to the machine speed to be made the filter 31 of the FF control unit 21 has the inverse characteristic of the transmission characteristic from the torque (torque command) u to the machine speed VL, that is, the transmission characteristic from the machine speed VL to the torque (torque command) u, and the filter 32 in the step preceding the subtractor 24 of the FB control unit 23 has the inverse characteristic of the transmission characteristic from the motor speed Vm to the machine speed VL, that is, the transmission characteristic from the machine speed VL to the motor speed Vm.


The transmission characteristic from the machine speed VL to the torque (torque command) u and the transmission characteristic from the machine speed VL to the motor speed Vm are represented from formulas (3) and (6) above by formulas below. Machine speed→torque (transmission characteristic):









[

Formula





8

]












u

V
L


=


J
m


s




s
2

+

2


ϛ




ω
p


s

+

ω
p
2




2


ϛω
0


s

+

ω
0
2








(
7
)







Machine speed→motor speed (transmission characteristic):









[

Formula





9

]













V
m


V
L


=



s
2

+

2


ϛω
0


s

+

ω
0
2




2


ϛω
0


s

+

ω
0
2







(
8
)







It is found from formulas (7) and (8) above that


(1) denominator polynomials are common,


(2) numerator polynomials are different in parameters for the frequencies ωp and ω0 and the vibration damping coefficients ζ and ζ′ but are the same in the form and


(3) the numerator polynomials include the secondary transmission characteristic of the frequency ωp or the antiresonant frequency ω0. Hence, the sharing of the transmission characteristic (formula (7) above) of the filter 31 in the FF control unit 21 and the transmission characteristic (formula (8) above) of the filter 32 in the FB control unit 23 will be examined below.


The zero point and the pole of the secondary transmission characteristic of formulas (7) and (8) above are determined by formulas below. Machine speed→zero point of torque (transmission characteristic):






s=−ζω
p
±j√{square root over (1−ζ2)}ωp   [Formula 10]


Machine speed→zero point of motor speed (transmission characteristic):






s=−ζω
0
±j√{square root over (1−ζ2)}ω0   [Formula 11]


Pole (common)









[

Formula





12

]











s
=

-


ω
0


2

ϛ















In this way, the distances of the zero point and the pole from the complex plane origin are determined by formulas below. Machine speed→zero point of torque (transmission characteristic):





|s|=ωp   [Formula 13]


Machine speed→zero point of motor speed (transmission characteristic):





|s|=ω0  [Formula 14]


Pole (common):









[

Formula





15

]













s


=


ω
0


2

ϛ






(
9
)







Here, when it is assumed that as a general machine tool, a load inertia ratio JL/Jm is approximately 1 and that the vibration damping coefficient ζ is about 0.1, by formulas (4) and (5) above, the resonant frequency ωp is about √2 times the antiresonant frequency ω0. It is found from formula (9) above that since the distance of the pole from the complex plane origin is separated 5 to 7.07 times (5√2 times) as much as the distance of the zero point from the complex plane origin, the zero point is dominant in the transmission characteristic.


In this way, as the common transmission characteristic F(s) of the filters 31 and 32, the transmission characteristic of formula (1) below including the dominant zero point is approximated.









[

Formula





16

]












F


(
s
)


=



s
2

+

2

ϛω





s

+

ω
2




s
2

+


2



ω
adj


s

+

ω
adj
2







(
1
)







In formula (1) above, a denominator polynomial is made to have the format of a general secondary filter of the cutoff frequency ωadj. From the numerator polynomials of formulas (7) and (8) above, a numerator polynomial is made to have a format based on the frequency to and the vibration damping coefficient ζ serving as the adjustment parameters.


In formula (1) above, the frequency ω serving as the adjustment parameter is adjusted in the range equal to or more than the antiresonant frequency ω0 of the machine 60 (the ball screw 70) but less than the resonant frequency ωp thereof. For example, in the transmission characteristic F(s) of the filter 31 in the FF control unit 21, by formula (7) above, the frequency ω is preferably set near the resonant frequency ωp, and the transmission characteristic F(s) of the filter 32 in the FB control unit 23, by formula (8) above, the frequency ω is preferably set to the antiresonant frequency ω0. As described previously, since as a general machine tool, the resonant frequency ωp is about √2 times the antiresonant frequency ω0, the frequency ω in the transmission characteristic F(s) of the filter 31 in the FF control unit 21 is adjusted the range equal to or more than the frequency ω in the transmission characteristic F(s) of the filter 32 in the FB control unit 23.


As described above, in the motor controller 1 of the present embodiment which performs the speed control based on the speed command, the speed control unit 20 includes the filters 31 and 32 which approximate the inverse characteristic of the transmission characteristic from the servo motor 50 to the machine 60 (the ball screw 70), the filters 31 and 32 have the transmission characteristic F(s) of formula (1) above based on the frequency ω, the vibration damping coefficient ζ and the cutoff frequency ωadj which are the adjustment parameters and the frequency ω is adjusted so as to be equal to or more than the antiresonant frequency ω0 of the machine 60 (the ball screw 70) but less than the resonant frequency ωp. In this way, it is possible to make the transmission characteristic from the speed command to the machine speed approach 1, and thus the speed command can be considered to be a command for the machine speed. Hence, it is possible to reduce vibrations in the ball screw (drive unit) 70 of the machine 60.


Incidentally, according to formulas (7) and (8) above, the characteristic (the inverse characteristic of the transmission characteristic from the torque (torque command) to the machine speed) necessary for the filter 31 of the FF control unit 21 in the speed control unit 20 is different from the characteristic (the inverse characteristic of the transmission characteristic from the motor speed to the machine speed) necessary for the filter 32 of the FB control unit 23. In the motor controller 1 of the present embodiment, since the FF control unit 21 and the FB control unit 23 include the filters 31 and 32 for which the transmission characteristic F(s) can be set individually and independently, it is possible to more reduce vibrations in the ball screw 70 of the machine 60 with the filters 31 and 32 shared.


Specifically, the frequency ω in the transmission characteristic F(s) of the filter 31 in the FF control unit 21 is set near the resonant frequency ωp, and the frequency ω in the transmission characteristic F(s) of the filter 32 in the FB control unit 23 is set near the antiresonant frequency ω0. In this way, the FF control unit 21 includes the filter 31 which approximates the inverse characteristic of the transmission characteristic from the torque to the machine speed, and the FB control unit 23 includes the filter 32 which approximates the inverse characteristic of the transmission characteristic from the motor speed to the machine speed. In this way, it is possible to make the transmission characteristic from the speed command to the machine speed approach 1, and thus the speed command can be more considered to be a command for the machine speed. Hence, it is possible to more reduce vibrations in the ball screw (drive unit) 70 of the machine 60.


Although the embodiment of the present invention is described above, the present invention is not limited to the embodiment described above. The effects described in the present embodiment are simply a list of most preferred effects produced from the present invention, and the effects of the present invention are not limited to the effects described in the present embodiment.


For example, in the embodiment described above, the motor drive device which performs the speed control based on the speed command is illustrated. However, the feature of the present invention is not limited to this configuration, and the present invention can also be applied to motor drive devices for speed control in which position control based on a position command and the speed control based on the speed command are performed with separate motor drive devices.


In the embodiment described above, the motor controller which performs the speed control on the ball screw (drive unit) of the machine is illustrated. However, the feature of the present invention is not limited to this configuration, and the present invention can also be applied to a motor controller which performs speed control on the feed axis (drive unit) of a machine, a motor controller which performs speed control on a hydraulic pump, a belt conveyor (drive unit) or the like in an industrial machine and the like.


EXPLANATION OF REFERENCE NUMERALS




  • 1 motor controller


  • 10 speed command unit


  • 20 speed control unit


  • 21 FF control unit


  • 22 FF controller


  • 23 FB control unit


  • 24 subtractor


  • 25 PI controller


  • 26 adder (addition unit)


  • 31, 32 filter


  • 40 encoder (speed detection unit)


  • 50 servo motor


  • 60 machine


  • 70 ball screw (drive axis)


  • 70A spring


  • 70B dumper


Claims
  • 1. A motor controller which controls a servo motor for driving a machine, the motor controller comprising:a speed command unit which issues a speed command for commanding a speed of the machine;a speed detection unit which detects a speed of the servo motor; anda speed control unit which produces a torque command based on the speed command issued by the speed command unit and a motor speed detected by the speed detection unit so as to control the speed of the servo motor,wherein the speed control unit includes a filter which approximates an inverse characteristic of a transmission characteristic from the servo motor to the machine,the filter has a transmission characteristic F(s) of formula below based on a frequency ω, a vibration damping coefficient ζ and a cutoff frequency ωadj which are adjustment parameters andthe frequency ω is adjusted so as to be equal to or more than an antiresonant frequency ω0 of the machine but less than a resonant frequency ωp of the machine.
  • 2. The motor controller according to claim 1, wherein the speed control unit includes: a feedforward control unit which produces a first torque command based on the speed command;a feedback control unit which produces a second torque command based on a difference between the speed command and the motor speed; andan addition unit which adds together the first torque command and the second torque command so as to produce the torque command, andthe feedforward control unit and the feedback control unit include the filters for which the transmission characteristic F(s) can the set individually and independently.
  • 3. The motor controller according to claim 2, wherein the feedforward control unit includes the filter which approximates an inverse characteristic of a transmission characteristic from the torque command to a speed of the machine, and the feedback control unit includes the filter which approximates an inverse characteristic of a transmission characteristic from the motor speed to the speed of the machine.
  • 4. The motor controller according to claim 2, wherein the frequency ω in the transmission characteristic F(s) of the filter in the feedforward control unit can be adjusted in a range equal to or more than the frequency ω in the transmission characteristic F(s) of the filter in the feedback control unit.
Priority Claims (1)
Number Date Country Kind
2017-121341 Jun 2017 JP national