JP6604157B2 - Resonance suppression controller in multi-inertia resonance system - Google Patents

Description

  The present invention relates to a resonance suppression control apparatus in a multi-inertia resonance system that performs resonance suppression control in consideration of the effect of dead time on a multi-inertia resonance system.

  Shaft torsional vibration suppression and disturbance suppression control originating in rolling systems are important issues in motion control of large structures such as buildings and bridges, flexible joints and arms of robots, and space structures. Against this background, a lot of research and development has been carried out on the problem of vibration control of systems with flexible mechanisms, such as state feedback, H∞ control, resonance ratio control, control by slow disturbance observer, etc. Have been proposed.

  On the other hand, it is known that when the delay of the inverter or the detection delay by the sensor exists in the system, the performance of the control system is significantly deteriorated.

  For example, Patent Documents 1 and 2 describe that resonance suppression control is performed on a multi-inertia resonance system.

Japanese Patent No. 4766039 JP 2012-68200 A

  However, since Patent Document 1 does not consider the adverse effects due to the above-described dead time in the control system design, there is a problem that the control becomes unstable if a phase delay due to the dead time exists in the feedback loop.

  In Patent Document 2, the control system is designed in consideration of the dead time. However, in the system where the dead time is extremely large (for example, when the phase delay is 90 degrees or more near the resonance frequency), When applied, the problem of unstable control occurs. Such a problem becomes remarkable particularly in a system having a resonance point in a high frequency band.

  The present invention solves the above-described problems, and an object thereof is to provide a resonance suppression control apparatus in a multi-inertia resonance system with enhanced resonance suppression effect.

A resonance suppression control apparatus in a multi-inertia resonance system according to claim 1 for solving the above-described problem controls a mechanical system configuration in which a motor and a load are coupled via a coupling shaft, and the rotational speed and torque of the motor. A controller that gives to the inverter a motor torque command that suppresses shaft torsional resonance based on the torque detected by the torque detector provided on the coupling shaft and the rotation speed detected by the speed detector. In a multi-inertia resonance system comprising:
The mechanical system configuration is expressed as a multi-inertia machine model having at least a motor inertia model and a load inertia model,
The motor inertia model is _obtained by subtracting the motor torque disturbance T _mdis from the motor torque T _m and subtracting the shaft torsion torque T _reac from the subtraction result to 1 / (J _m · s) (J _m is the motor inertia moment , S is a motor rotation speed ω _m through a transfer function term of a Laplace operator) , and the motor rotation speed ω _m has a transfer characteristic of a motor rotation phase angle θ _m through a 1 / s transfer function term .
The load inertia model is _obtained by subtracting the load torque T _l from the shaft torsional torque T _reac and the load rotation phase angle θ through a transfer function term of 1 / (J _l · s ² ) (J _l is the load inertia moment). _The torsion of the shaft through the transfer function term of K _f (K _f is the torsional rigidity of the shaft (spring coefficient) [Nm / rad]) is obtained by subtracting the load rotation phase angle θ _l from the motor rotation phase angle θ _m. It has a transmission characteristic of torque T _reac
The controller is
The shaft torsion torque detection value T _det obtained by adding the _dead time element to the feedback of the shaft torsion torque T _reac is passed through the set shaft torque feedback gain K _r as a new shaft torsion torque detection value,
From the torque command value obtained by subtracting the new shaft torsion torque detection value from the set torque command and the rotation speed detection value ω _{det obtained} by adding a dead time element to the motor rotation speed ω _m , the disturbance disturbance causes a motor disturbance. Estimate the torque and obtain the estimated disturbance torque T ^ _dis
Subtracting the new shaft torsion torque detection value from the value obtained by adding the disturbance torque estimated value T _dis to the set torque command to obtain a pre-phase compensation torque command value,
The torque command value before phase compensation is expressed by the transfer function G _PHC

(Where α is the phase compensation parameter, ω _Phc is the phase compensation filter cutoff frequency, and s is the Laplace operator)
To obtain a torque command value after phase compensation through a phase compensator represented by
The phase-compensated torque command value is given to the inverter as a motor torque command.

  In the above configuration, the controller performs the resonance suppression control. At that time, the torque command is passed through the phase compensator, so that the motor torque command value given to the inverter is the torque command after phase compensation. The effect of delay such as dead time is compensated, and the stability of the system is improved.

In addition, the resonance frequency component is suppressed by feeding back the detected value of the shaft torsion torque via the shaft torque feedback gain K _r, and the disturbance observer is used so that a disturbance suppression effect can be obtained and the control is robust against the disturbance. A system can be constructed.

According to a second aspect of the present invention, there is provided a resonance suppression control apparatus for a multi-inertia resonance system comprising: a mechanical system configuration in which a motor and a load are coupled via a coupling shaft; an inverter for controlling the rotation speed and torque of the motor; A controller that provides the inverter with a motor torque command that suppresses shaft torsional resonance based on the torque detected by the torque detector provided on the shaft and the rotation speed detected by the speed detector. In a multi-inertia resonance system,
The mechanical system configuration is expressed as a multi-inertia machine model having at least a motor inertia model and a load inertia model,
The motor inertia model is _obtained by subtracting the motor torque disturbance T _mdis from the motor torque T _m and subtracting the shaft torsion torque T _reac from the subtraction result to 1 / (J _m · s) (J _m is the motor inertia moment , S is a motor rotation speed ω _m through a transfer function term of a Laplace operator) , and the motor rotation speed ω _m has a transfer characteristic of a motor rotation phase angle θ _m through a 1 / s transfer function term .
The load inertia model is _obtained by subtracting the load torque T _l from the shaft torsional torque T _reac and the load rotation phase angle θ through a transfer function term of 1 / (J _l · s ² ) (J _l is the load inertia moment). _The torsion of the shaft through the transfer function term of K _f (K _f is the torsional rigidity of the shaft (spring coefficient) [Nm / rad]) is obtained by subtracting the load rotation phase angle θ _l from the motor rotation phase angle θ _m. It has a transmission characteristic of torque T _reac
The controller is
The torsional torque detection value T _det to dead time element is added to that feedback the shaft torsional torque T _REAC, as a new torsional torque detection value through a shaft torque feedback gain k _r set, the new The shaft torsion torque detection value is expressed by the transfer function G _PHC

(Where α is the phase compensation parameter, ω _Phc is the phase compensation filter cutoff frequency, and s is the Laplace operator)
Through a first phase compensator represented by
From the torque command value obtained by subtracting the phase-compensated shaft torsion torque detection value from the set torque command and the rotation speed detection value ω _{det obtained} by adding a dead time element to the motor rotation speed ω _m , the disturbance observer observes the motor. Disturbance torque is estimated, disturbance torque estimated value T ^ _dis is obtained, and the disturbance torque estimated value T ^ _dis is passed through a second phase compensator having the same configuration as that of the first phase compensator. Find the torque estimate,
The motor torque command is obtained by subtracting the phase torsion torque detection value after phase compensation from a value obtained by adding the post-phase compensation disturbance torque estimated value to the set torque command.

  In the above configuration, the controller performs resonance suppression control. At this time, only the feedback of the shaft torsion torque is passed through the phase compensator, and therefore the phase compensation effect contributes only to the feedback of the shaft torsion torque, and the torque The resonance suppression control can be adjusted independently of the command.

In addition, since the feedback amount of the detected shaft torsion torque is passed through the first phase compensator and the output of the disturbance observer is passed through the second phase compensator, higher resonance suppression and disturbance suppression effects can be expected.

Further, the resonance suppression control apparatus in the multi-inertia resonance system according to claim 3 is the resonance compensator according to claim 1 or 2 , wherein the phase compensator has a transfer function _GPHC ,

(Where ω _b is the primary delay cutoff frequency, ω _h is the primary advance cutoff frequency, s is the Laplace operator, and p is any fractional order)
It is characterized by comprising a phase compensator using a fractional order expressed as follows.

  According to the above configuration, since the phase compensator uses a fractional order, the phase compensation amount (phase compensation width) is finely set, and the resonance suppression effect is enhanced.

According to a fourth aspect of the present invention, there is provided a resonance suppression control apparatus for a multi-inertia resonance system according to any one of the first to third aspects, wherein the transfer function G _PHC of the phase compensator is

(Where ω _b is the primary delay cutoff frequency, ω _h is the primary advance cutoff frequency, s is the Laplace operator, p is any fractional order, ω _PhC is the phase compensation filter cutoff frequency, and α is the phase compensation parameter. )
And define
The phase compensation amount is adjusted by changing the setting of the phase compensation parameter α.

  According to the above configuration, by confirming the operation of the phase compensation parameter α by, for example, a simulation or an actual system dead time, and setting the phase compensation parameter α to an appropriate value accordingly, the resonance suppression effect can be further enhanced. Stability is further improved.

Further, the resonance suppression control apparatus in the multi-inertia resonance system according to claim 5 causes the ω _b and ω _h in claim 4 to function as a phase lag compensator by setting ω _b <ω _h , It is characterized by functioning as a phase advance compensator by setting ω _b > ω _h .

  According to the above configuration, the resonance suppression effect can be enhanced by functioning either the phase lag compensator or the phase lead compensator.

(1) According to the invention described in claims 1 to 5, the influence of the delay of the dead time and the like contained in the feedback loop is compensated, the stability of the system is improved. In addition, the resonance frequency component is suppressed by feeding back the detected value of the shaft torsion torque via the shaft torque feedback gain K _r, and the disturbance observer is used so that a disturbance suppression effect can be obtained and the control is robust against the disturbance. A system can be constructed.
(2) According to the invention described in claim 2 , since only the feedback of the shaft torsion torque is passed through the phase compensator, the phase compensation effect contributes only to the feedback of the shaft torsion torque. The resonance suppression control can be adjusted independently. In addition, since the feedback amount of the detected shaft torsion torque is passed through the first phase compensator and the output of the disturbance observer is passed through the second phase compensator, higher resonance suppression and disturbance suppression effects can be expected.
(3) According to the invention described in claim 3 , since the phase compensator uses a fractional order, the amount of phase compensation (the width of phase compensation) is set finely and the resonance suppression effect is enhanced.
(4) According to the invention described in claim 4 , the phase compensation amount can be adjusted, and by setting the phase compensation parameter to an appropriate value, the resonance suppression effect can be further enhanced, and the stability of the system can be improved. Further improve.
(5) According to the fifth aspect of the present invention, the resonance suppression effect can be enhanced by functioning either the phase lag compensator or the phase lead compensator.

The block diagram which shows an example of the multi inertia resonance system to which this invention is applied. The block diagram of Example 1 of this invention. The resonance suppression effect in the case of no resonance suppression is represented, (a) is a waveform diagram of shaft torque, and (b) is a waveform diagram of rotation speed. The resonance suppression effect at the time of implementing the resonance suppression control by Example 1 of this invention is represented, (a) is a waveform diagram of an axial torque, (b) is a waveform diagram of rotation speed. The block diagram of Example 2 of this invention. The block diagram of the disturbance observer of Example 2 of this invention. The resonance suppression effect at the time of performing disturbance suppression and resonance suppression using a general disturbance observer without a phase compensator is shown, (a) is a waveform diagram of shaft torque, and (b) is a waveform diagram of rotation speed. The resonance suppression effect at the time of performing disturbance suppression and resonance suppression with a phase compensator like Example 2 of this invention is represented, (a) is a waveform diagram of an axial torque, (b) is a waveform diagram of rotation speed. The gain diagram of the phase compensator in description of Example 3 of this invention. In Example 3 of this invention, the gain diagram at the time of reproducing the 0.5th order phase delay compensator by the 1st order broken line approximation. In Example 3 of this invention, the gain diagram at the time of reproducing the 1.5th-order phase delay compensator by the 1st-order broken line approximation. In Example 3 of this invention, the gain diagram at the time of reproducing the 1.5th order phase delay compensator by the 2nd order broken line approximation. The resonance suppression effect when no fractional order is set in the phase compensator is shown, (a) is a waveform diagram of shaft torque, and (b) is a waveform diagram of rotation speed. The resonance suppression effect at the time of setting a fractional order to a phase compensator like Example 3 of this invention is represented, (a) is a waveform diagram of shaft torque, (b) is a waveform diagram of rotation speed. The block diagram of Example 5 of this invention. The block diagram of Example 6 of this invention.

  Hereinafter, embodiments of the present invention will be described with reference to the drawings, but the present invention is not limited to the following embodiments. The present invention is intended for all multi-inertia resonance systems. In the present embodiment, a shaft torsion resonance system of a rotating machine system such as the motor drive device shown in FIG. 1 will be described as a representative example.

  In FIG. 1, the motor 1 and the load 2 are coupled by a shaft 3 (coupled shaft), and shaft torsional resonance occurs. Therefore, the shaft torque is detected by installing a shaft torque detector 4 on the shaft 3. Further, the rotational speed of the motor 1 is detected using the speed detector 5.

The controller 6 realizes resonance suppression control that suppresses shaft torsional resonance using the shaft torsion torque detection value T _det detected by the shaft torque detector 4, the rotational speed detection value ω _det detected by the speed detector 5, and the like. Then, a torque command T ^* (motor torque command) is given to the inverter 7.

The inverter 7 controls the motor 1 with a desired rotation speed and torque based on the torque command T ^* .

  Hereinafter, the resonance suppression control performed in the controller 6 will be described in detail.

  FIG. 2 shows the configuration of the first embodiment. In FIG. 2, reference numeral 10 denotes a two-inertia machine model in which the mechanical system configuration of the motor 1, the load 2 and the shaft 3 in FIG. 1 is expressed by two inertias of a motor inertia model and a load inertia model.

The motor inertia model in the two-inertia machine model 10 is _obtained by subtracting a motor torque disturbance T _mdis from a motor torque T _m (output of a _dead time element 27 due to an inverter delay described later) by a subtractor 11 and subtracting from the subtraction result. 12 to the value obtained by subtracting the shaft torsion torque T _reac (torque generated by shaft 3 (corresponding to the shaft torsion reaction force)) to 1 / (J _m · s) (J _m is the motor inertia moment, s is the Laplace operator ), The motor rotation speed ω _m , and the motor rotation speed ω _m through the 1 / s transfer function term 14 and the motor rotation phase angle θ _m .

The load inertia model in the two-inertia machine model 10 is _obtained by subtracting the load torque T _l from the shaft torsion torque T _reac by the subtractor 15 to 1 / (J _l · s ² ) (J _l is the load inertia moment. through the transfer function section 16) of the load rotational phase angle theta _l, the motor from the rotational phase angle theta _m to a value obtained by subtracting the load rotational phase angle theta _l by the subtracter 17, K _f (K _f is the axial torsional stiffness ( It has a transmission characteristic of a shaft torsion torque T _reac through the transfer function term 18 of the spring coefficient) [Nm / rad]).

In this embodiment, the dead time element 24 by torque detection is considered in consideration of the dead time of the torque detection of the shaft torque detector 4, and the dead time 27 is taken in consideration of the dead time due to the inverter delay. A shaft torsion torque detection value T _det is obtained by adding a _dead time element 24 due to a torque detection delay to the fed back shaft torsion torque T _reac .

In the controller 6, the shaft torsion torque detection value T _det is passed through the high-pass filter 31 (high-pass filter) to suppress the resonance frequency component without affecting the DC component of the torque. The transfer function G _HPF of the high-pass filter 31 is, for example, as shown in the following equation (1).

Where s: Laplace operator, ω _hpf : high-pass filter cutoff frequency.

The subtracter 32 subtracts the output of the high-pass filter 31 (a new shaft torsion torque detection value in which the resonance frequency component is suppressed) from the set torque command T _cmd .

The output of the subtractor 32 (torque command value before phase compensation) is passed through the phase compensator 33 of the transfer function _GPHC to obtain a motor torque command T ^* (including compensation torque). A motor time _Tm is obtained by adding a dead time element 27 due to an inverter delay to the motor torque command T ^* .

In this way, by introducing the phase compensator 33 to the motor torque command (T ^* ) given to the inverter 7, the influence of delay such as dead time included in the feedback loop is compensated, and the stability of the system is improved. Yes.

A general transfer function G _PHC of the phase compensator 33 is, for example, as shown in the following equation (2).

Where α: phase compensation parameter, ω _phc : phase compensation filter cutoff frequency.

  In the method in which the resonance frequency component of the detected shaft torque value is simply fed back and canceled, the resonance suppression control becomes unstable due to the dead time of the inverter 7 and the sensor (shaft torque detector 4) and the phase delay due to the transfer characteristics. Or the suppression effect is reduced.

  Therefore, in the present embodiment, the phase compensation parameter α is appropriately adjusted in consideration of dead time and transfer characteristics included in the feedback loop. Thereby, the stability of control and the suppression effect can be improved.

  The phase compensation parameter α functions as a phase advance compensator when α> 1, and as a phase delay compensator when α <1, and confirms the operation by simulation or dead time of an actual system and sets an appropriate parameter. decide. Since there is only one phase compensation parameter, it can be adjusted very easily according to the dead time and phase delay of the system.

  Here, the resonance suppression effect was verified in the case of no resonance suppression without using a phase compensator and in the case of resonance suppression using a general phase compensator having the transfer function of equation (2). An example is shown in FIGS. 3 and 4 show the shaft torque waveform (a) and the rotation speed waveform (b) when the rotation speed is increased, respectively.

  In the case of FIG. 3 without resonance suppression, the torque resonates greatly when disturbance such as torque ripple coincides with the resonance frequency. On the other hand, in the case of FIG. 4 in which the resonance suppression control is performed, it can be seen that the resonance of the shaft torque can be relatively suppressed.

  FIG. 5 shows the configuration of the second embodiment, and the same parts as those in FIG.

In the second embodiment, instead of the high-pass filter 31 of FIG. 2, the shaft torsion torque detection value T _det is used as a new shaft torsion torque detection value via the gain setting unit 34 in which the shaft torque feedback gain K _r is set. feedback (a negative input of the adder-subtracter 35), suppressing the resonance frequency component (K _r can be arbitrarily set).

Further, since a motor torque disturbance T _mdis generated by inertia fluctuation, torque ripple, friction, etc. exists in the motor, a disturbance observer 36 for removing and reducing these disturbances is also provided to constitute a robust control system.

That is, a dead time element 25 due to speed detection delay is added to the motor rotation speed ω _m in the two-inertia machine model 10 to obtain a rotation speed detection value ω _det, and this rotation speed detection value ω _det and the torque command value before phase compensation From T _cmd ′ (the output of the adder / subtractor 35), the disturbance observer 36 estimates the disturbance torque of the motor to obtain the estimated disturbance torque T ^ _dis . Then, the adder / subtracter 35 subtracts the output (new shaft torsion torque detection value) of the gain setting device 34 from the value obtained by adding the disturbance torque estimated value T _dis to the torque command _Tcmd, and the torque command value T before phase compensation. _cmd '.

Although the disturbance suppression and the resonance suppression can be configured as described above, there are delays and dead times of the inverter and sensor in the feedback loop, and if applied as they are, the suppression effect and control stability are impaired. Therefore, the phase compensator 33 is introduced into the motor torque command value (T _cmd ′) given to the inverter 7 as in FIG. 2 of the first embodiment, thereby improving the stability and suppression effect of the system.

A configuration example of the disturbance observer 36 is shown in FIG. The disturbance torque T _dis can be expressed as the following equation (3). The disturbance torque that acts on the load torque is included in the shaft torsion torque T _reac .

However, it s: Laplace operator, J _mn: motor inertia nominal value, G _inv: inverter transfer characteristic, J _m: motor inertia, G _INVn: inverter transfer characteristic nominal value, T _Fric: Coulomb friction torque, D _m: Coefficient of viscous friction.

When the motor torque command value T ^* (T _cmd ′) and the motor rotation speed ω _det can be detected, the disturbance torque estimation value T ^ _dis is a first-order low-pass filter (cut-off frequency ω _obs ) as shown in equation (4). [rad / s]). The control block at that time is as shown in FIG.

However, T _mdis in FIG.
T _mdis = T _fric + D _m ω _m + F _m (F _m is disturbance due to inertia variation, inverter characteristic error, torque ripple, etc.).

In FIG. 6, the value _obtained by passing the torque command value T _cmd ′ before phase compensation (the output of the adder / subtractor 35 in FIG. 5) through the transfer function term 41 of the inverter transfer characteristic nominal value G _invn and the detected rotational speed value ω _det ( 5 is added to the value obtained by passing the output of the dead time element 25 due to the speed detection delay of 5 to the transfer function term 42 of ω _obs · J _mn .

From the value obtained by passing the output of the adder 43 through the transfer function term 44 of ω _obs / (s + ω _obs ), the output of the transfer function term 42 is subtracted by the subtractor 45 to output a disturbance torque estimated value T _dis .

By feeding back the estimated disturbance torque T ^ _dis as shown in FIG. 5, a control system that is robust against the disturbance can be constructed.

  The phase compensator 33 according to the second embodiment employs a phase compensator having the above equation (2) as a transfer function, and the operation thereof is the same as that of the first embodiment.

  Resonance suppression control becomes unstable due to the dead time of the inverter 7 and sensor (shaft torque detector 4) and the phase delay due to transmission characteristics only by resonance suppression by shaft torque feedback and disturbance suppression by a disturbance observer. Or, the suppression effect may be reduced.

  Therefore, in the present embodiment, the phase compensation parameter α is appropriately adjusted in consideration of dead time and transfer characteristics included in the feedback loop. Thereby, the stability of control and the suppression effect can be improved.

  The phase compensation parameter α functions as a phase advance compensator when α> 1, and as a phase delay compensator when α <1, and confirms the operation by simulation or dead time of an actual system and sets an appropriate parameter. decide. Since there is only one phase compensation parameter, it can be adjusted very easily according to the dead time and phase delay of the system.

  Here, when the disturbance suppression and the resonance suppression are simply performed using a general disturbance observer without the phase compensator, the disturbance suppression and the resonance suppression are performed with the phase compensator as in the second embodiment (FIG. 5). An example of verifying the resonance suppression effect in the case where it is performed is shown in FIGS. 7 and 8 show the shaft torque waveform (a) and the rotation speed waveform (b) when the rotation speed is increased.

  In the case of FIG. 7 which is suppressed by only a general disturbance observer without a phase compensator, the resonance can be suppressed to some extent. On the other hand, in the case of FIG. 8 in which the resonance suppression control using the phase compensator of the second embodiment is performed, it can be seen that the resonance of the shaft torque can be suppressed more effectively.

  In the first and second embodiments, the resonance suppression control can be easily stabilized by using the general phase compensator of the formula (2). However, in order to increase the suppression effect, fine phase adjustment is required. Become. Therefore, in this embodiment, a phase compensator to which a fractional order is applied is introduced. The phase lag compensator can also be expressed as a product of a first-order lag element and a lead element as shown in the following equation (5). An example of a gain diagram in this case is shown in FIG.

Where ω _b : first-order lag cutoff frequency, ω _h : first-order advance cutoff frequency.

  In the present embodiment, a phase lag compensator having a transfer function of Equation (6) in which a fractional order is given to Equation (5) is employed.

  Where p: any fractional order.

  Since the fractional-order phase compensator shown in equation (6) is difficult to implement as it is, the broken line approximation equation shown in equation (7) is used.

Ω _i and ω _i ′ in the equation (7) are the equations (8) and (9).

  Where N is the order of the approximate expression.

  FIG. 10 shows a gain diagram when a 0.5th-order phase lag compensator is reproduced by first-order broken line approximation. From FIG. 10, it can be confirmed that approximation at −10 dB / dec is realized. FIG. 11 shows a gain diagram when a 1.5th-order phase delay compensator is reproduced by first-order broken line approximation. In this case, it can be confirmed that approximation at −30 dB / dec is realized.

  FIG. 12 shows a gain diagram when a 1.5th-order phase delay compensator is reproduced by second-order broken line approximation. It can be confirmed that the approximation can be made with higher accuracy than in the first-order case.

  10 to 12, “real” represents the frequency characteristic of the fractional order (characteristic of the expression (6)), and “app.” Represents the frequency characteristic when the fractional order is approximated by a broken line (right side of the expression (7)). Of each).

  As described above, by finely adjusting the arbitrary fractional order p, not only the control by the phase compensator but also the effect of suppressing the resonance can be enhanced.

When the phase compensator of equation (2) is a fractional order, ω _b and ω _h can be set as follows by comparing with equation (6).

  Here, FIGS. 13 and 14 show examples in which the resonance suppression effect is verified when the fractional order is not set in the phase compensator and when the fractional order (p = 1.2) is set. FIGS. 13 and 14 respectively show the shaft torque waveform (a) and the rotation speed waveform (b) when the rotation speed is increased.

  In the case of FIG. 14 in which the fractional order p = 1.2 is set, the resonance peak value of the waveform of the axial torque is lower than in the case of FIG. 13 in which the fractional order is not set, and it can be seen that the suppression effect is high.

In the third embodiment, the fractional order in the case of phase lag compensation is defined in the phase compensator 33. However, in the fourth embodiment, the fractional order is applied to the phase advance compensator. At that time, in the definition of equation (6), it is possible to function as a phase advance compensator by defining (setting) ω _b > ω _h . As the mounting equations, the equations (7) to (9) can be used as they are.

  According to the present embodiment, not only the phase delay compensation but also the phase lead compensator can similarly increase the resonance suppression effect as a fractional order. In actual application, it depends on the degree of influence of dead time included in the resonance suppression feedback loop, and it may be arbitrarily selected which phase lag / lead compensation is applied.

In the first embodiment (FIG. 2) and the second embodiment (FIG. 5), the phase compensator 33 is inserted after the new shaft torsion torque detection value is subtracted from the torque command _Tcmd. Instead, as shown in FIG. 15, the phase compensator 33 is inserted after the high-pass filter 31 of the shaft torque feedback loop, and the output thereof is input to the subtractor 32.

  15, the same parts as those in FIG. 2 are denoted by the same reference numerals, and the operations of the same parts are the same as those in FIG.

In the first and second embodiments, the transfer characteristic of the phase compensator 33 affects the torque command value _Tcmd , but in the fifth embodiment, the effect of the phase compensation contributes only to the shaft torque feedback for suppressing the resonance. Adjustment of the torque command value and resonance suppression control can be controlled independently.

  Also in the configuration of FIG. 15, the resonance suppression effect can be enhanced by finely adjusting the fractional order of the phase compensator 33 described in the third and fourth embodiments.

  In the sixth embodiment, the insertion position of the phase compensator 33 in FIG. 5 is changed to the output part of the disturbance observer and the shaft torque feedback part as shown in FIG. 16, and the phase compensation parameters of the respective phase compensators 33a and 33b are changed. Is adjusted according to the phase delay such as dead time.

  16 differs from FIG. 5 in that the phase compensator 33 is deleted, the output of the gain setter 34 is passed through the fractional-order type phase compensator 33a, and the output is input to the adder / subtractor 35 as a subtraction, and disturbance The output of the observer 36 is passed through the fractional order type phase compensator 33b, and the output is input as an addition to the adder / subtractor 35. The other parts are the same as in FIG.

  According to the sixth embodiment, the phase compensator for the torque detection delay and the speed detection delay can be divided and the optimum phase compensation parameter can be adjusted for each, so that higher resonance suppression and disturbance suppression effects can be expected.

In addition, no phase compensation is applied to the torque command value T _cmd ′, and the effect of the phase compensation is effective only for the output of the shaft torque feedback and disturbance observer (disturbance torque estimated value T ^ _dis ) for suppressing the resonance. Since this contributes, adjustment of the torque command value and resonance suppression and disturbance suppression can be controlled independently.

  The present invention can be applied not only to a two-inertia resonance system but also to a multi-inertia resonance system such as a three-inertia system. In this case, the same effect as described above can be obtained.

DESCRIPTION OF SYMBOLS 1 ... Motor 2 ... Load 3 ... Shaft 4 ... Shaft torque detector 5 ... Speed detector 6 ... Controller 7 ... Inverter 10 ... 2 Inertial machine model 11, 12, 15, 17, 32, 45 ... Subtractor 13, 14 , 16, 18, 41, 42, 44 ... transfer function terms 24, 25, 27 ... dead time element 31 ... high-pass filter 33, 33a, 33b ... phase compensator 34 ... gain setter 35 ... adder / subtractor 36 ... disturbance observer 43 ... Adder

Claims (5)

A mechanical system configuration in which a motor and a load are coupled via a coupling shaft, an inverter that controls the rotational speed and torque of the motor, and a torque detected by a torque detector provided on the coupling shaft and a rotational speed of the motor In a multi-inertia resonance system comprising: a controller that provides a motor torque command for suppressing shaft torsional resonance to the inverter based on the rotational speed detected by the detector;
The mechanical system configuration is expressed as a multi-inertia machine model having at least a motor inertia model and a load inertia model,
The motor inertia model is _obtained by subtracting the motor torque disturbance T _mdis from the motor torque T _m and subtracting the shaft torsion torque T _reac from the subtraction result to 1 / (J _m · s) (J _m is the motor inertia moment , S is a motor rotation speed ω _m through a transfer function term of a Laplace operator), and the motor rotation speed ω _m has a transfer characteristic of a motor rotation phase angle θ _m through a 1 / s transfer function term.
The load inertia model is _obtained by subtracting the load torque T _l from the shaft torsional torque T _reac and the load rotation phase angle θ through a transfer function term of 1 / (J _l · s ² ) (J _l is the load inertia moment). _The torsion of the shaft through the transfer function term of K _f (K _f is the torsional rigidity of the shaft (spring coefficient) [Nm / rad]) is obtained by subtracting the load rotation phase angle θ _l from the motor rotation phase angle θ _m. It has a transmission characteristic of torque T _reac
The controller is
The shaft torsion torque detection value T _det obtained by adding the _dead time element to the feedback of the shaft torsion torque T _reac is passed through the set shaft torque feedback gain K _r as a new shaft torsion torque detection value,
From the torque command value obtained by subtracting the new shaft torsion torque detection value from the set torque command and the rotation speed detection value ω _{det obtained} by adding a dead time element to the motor rotation speed ω _m , the disturbance disturbance causes a motor disturbance. Estimate the torque and obtain the estimated disturbance torque T ^ _dis
Subtracting the new shaft torsion torque detection value from the value obtained by adding the disturbance torque estimated value T ^ _dis to the set torque command to obtain a pre-phase compensation torque command value,
The torque command value before phase compensation is determined by the transfer function G _PHC

(Where α is the phase compensation parameter, ω _Phc is the phase compensation filter cutoff frequency, and s is the Laplace operator)
To obtain a torque command value after phase compensation through a phase compensator represented by
A resonance suppression control apparatus in a multi-inertia resonance system, wherein the phase-compensated torque command value is given to an inverter as a motor torque command. A mechanical system configuration in which a motor and a load are coupled via a coupling shaft, an inverter that controls the rotational speed and torque of the motor, and a torque detected by a torque detector provided on the coupling shaft and a rotational speed of the motor A multi-inertia resonance system comprising: a controller that provides a motor torque command for suppressing shaft torsional resonance to the inverter based on the rotational speed detected by the detector;
The mechanical system configuration is expressed as a multi-inertia machine model having at least a motor inertia model and a load inertia model,
The motor inertia model is _obtained by subtracting the motor torque disturbance T _mdis from the motor torque T _m and subtracting the shaft torsion torque T _reac from the subtraction result to 1 / (J _m · s) (J _m is the motor inertia moment , S is a motor rotation speed ω _m through a transfer function term of a Laplace operator), and the motor rotation speed ω _m has a transfer characteristic of a motor rotation phase angle θ _m through a 1 / s transfer function term.
The load inertia model is _obtained by subtracting the load torque T _l from the shaft torsional torque T _reac and the load rotation phase angle θ through a transfer function term of 1 / (J _l · s ² ) (J _l is the load inertia moment). _The torsion of the shaft through the transfer function term of K _f (K _f is the torsional rigidity of the shaft (spring coefficient) [Nm / rad]) is obtained by subtracting the load rotation phase angle θ _l from the motor rotation phase angle θ _m. It has a transmission characteristic of torque T _reac
The controller is
The torsional torque detection value T _det to dead time element is added to that feedback the shaft torsional torque T _REAC, as a new torsional torque detection value through a shaft torque feedback gain k _r set, the new the torsional torque detection value, the transfer function G _PHC

(Where α is the phase compensation parameter, ω _Phc is the phase compensation filter cutoff frequency, and s is the Laplace operator)
Through the first phase compensator represented by
From the torque command value obtained by subtracting the phase-compensated shaft torsion torque detection value from the set torque command and the rotation speed detection value ω _{det obtained} by adding a dead time element to the motor rotation speed ω _m , the disturbance observer observes the motor. Disturbance torque is estimated, disturbance torque estimated value T ^ _dis is obtained, and the disturbance torque estimated value T ^ _dis is passed through a second phase compensator having the same configuration as that of the first phase compensator. Find the torque estimate,
Resonance in a multi-inertia resonance system, wherein the motor torque command is obtained by subtracting the phase-compensated shaft torsion torque detection value from a value obtained by adding the post-phase compensation disturbance torque estimated value to the set torque command. Suppression control device. The phase compensator has a transfer function G _PHC

(Where ω _b is the primary delay cutoff frequency, ω _h is the primary advance cutoff frequency, s is the Laplace operator, and p is any fractional order)
The resonance suppression control apparatus in a multi-inertia resonance system according to claim 1, wherein the resonance suppression control apparatus is a phase compensator using a fractional order expressed as follows. The transfer function G _PHC of the phase compensator is

(Where ω _b is the primary delay cutoff frequency, ω _h is the primary advance cutoff frequency, s is the Laplace operator, p is any fractional order, ω _PhC is the phase compensation filter cutoff frequency, and α is the phase compensation parameter. )
And define
Multi inertia resonance suppression control in the resonance system according to any one of claims 1 to 3, characterized in that by changing the settings of the phase compensation parameter α for adjusting the amount of phase compensation. Claims the omega _b and omega _h, <to function as a phase lag compensator by setting the ω _h, ω _b> ω _b, characterized in that to function as a phase lead compensator by setting the omega _h 5. A resonance suppression control apparatus in the multi-inertia resonance system according to 4 .

Images