The present invention claims priority under 35 U.S.C. § 119 to Japanese Patent Application No. 2018-118781 filed on Jun. 22, 2018, the entire content of which is incorporated herein by reference.
The present disclosure relates to a motor driving apparatus, and in particular to a technique for suppressing a control error of a motor.
BACKGROUND
In the present specification, a technique will be described which reduces a torque ripple caused by an offset error of a current sensor in a driving apparatus of a three-phase alternating current motor exemplified as an embodiment of the present disclosure (a driving apparatus of a three-phase alternating current motor employed primarily in shaft control, in particular, feed shaft control, of an NC machine tool).
For a feed shaft of an NC machine tool, in many cases, a three-phase alternating current motor having a high torque and which can be easily controlled is used. When the three-phase alternating current motor is driven, if a detection value of a current sensor has an offset error, a ripple would be superposed on d-axis and q-axis currents when the three-phase alternating current is converted into a two-phase rotational coordinate system by vector control (in general, a magnetic pole direction is called a d axis, and an electrically orthogonal direction to the d axis is called a q axis). In the three-phase alternating current motor, because torque is generated proportional to the d-axis and q-axis currents, the torque ripple is caused proportional to the ripples of the d-axis and q-axis currents.
As a result, a torque ripple is caused in the three-phase alternating current motor due to the offset error of the d-axis and q-axis currents. In the feed shaft of the NC machine tool, a torque ripple component causes a position error which is an error of a rotational position of a rotor of the motor, which then becomes a cause for degradation of machining precision such as appearance of a streak on a cut surface or the like.
One effective means for suppressing the position error due to the torque ripple is increasing feedback gains for a speed and a position of a closed loop control system. However, because this depends on characteristics of the control target, in general, realization of such an increase is not easy. Therefore, a method may be considered in which the offset error of the detection value of the current sensor is corrected with high precision to reduce the torque ripple, to thereby suppress the position error.
Among driving apparatuses of the related art, there exist apparatuses in which the detection value of the current sensor during a period in which no current is applied to the motor is acquired, and the acquired detection value is used as an offset correction amount. That is, in the state where the motor is not driven, the detection value of the current sensor should be zero, and the driving apparatus uses the value which is detected in this period to correct the offset.
However, for targets having strict margin levels for the position error such as the NC machine tool, in the offset error correction method of the current sensor with the method of the related art, the detected current value may be affected by noise and strain, and the detected value may not be sufficient for use as a correction value for suppressing the torque ripple and the position error.
In consideration of this, in Patent Literature 3, a method is proposed in which a compensator of the current offset is learned by a machine learning which has, as inputs, Fourier coefficients acquired by applying fast Fourier transform to a temperature in the motor driving apparatus, a temperature of the three-phase alternating current motor, voltages of various parts of the motor driving apparatus, an error between a commanded position and an actual position of the rotor, and the above-described position error.
Patent Literature
Patent Literature 1: JP 5447810 B
Patent Literature 2: JP 6080687 B
Patent Literature 3: JP 2017-79514 A
An advantage of the present disclosure lies in suppressing the position error caused by an error included in the detection value of the current sensor. As described above, with the method of correcting the offset using a value of a phase current of the motor during a period in which no current is applied, the actual position error is not evaluated. Therefore, as one method of achieving the reduction of the position error due to the torque ripple, a method may be considered in which a position error is evaluated in some form, and the offset is corrected using the evaluation value.
As one method of achieving this, there exists the use of machine learning as described in Patent Literature 3. In machine learning, a complicated behavior determination can be learned from simple inputs, but in general, a very long period of time is required until the learning converges. In particular, reinforcement learning is slow to converge because there is no teacher data.
Moreover, it is difficult to generalize and use a learning model which is acquired by one type of machine tool for other types of machine tools. Thus, it is necessary that a model is learned in each machine tool. Further, if the learning time is long, a large number of man-hours may be expected for the work to learn the model in each type of machine tool.
In consideration of this, there may be proposed selective use of information unique to the current offset correction problem and employing a method of fast convergence, in order to quickly achieve correction of the current offset while evaluating the actual position error.
Furthermore, while Patent Literature 3 does not explicitly describe a specific method of realization for the motor speed in the leaning, a method may be proposed in which the motor is driven under one or more constant speed conditions. In other words, a method may be proposed which does not require driving the motor under various conditions for correction of the offset error.
An advantage of the present disclosure lies in suppression of the control error caused by the error included in the detection value of the current sensor.
According to one aspect of the present disclosure, there is provided a motor driving apparatus comprising: a current sensor that detects a current supplied to a motor; and a computation device, wherein the computation device is configured to execute: a power spectrum computing process to determine a power spectrum for a position error based on a rotational position of the motor and a position command value; and an offset correction computing process to compute an offset correction amount of the current sensor based on the power spectrum determined by the power spectrum computing process, and the power spectrum computing process includes a process to compute a power spectrum of an electrical angle frequency of the position error when a rotational speed of the motor is a constant speed.
According to another aspect of the present disclosure, the offset correction computing process includes: a process to evaluate the power spectrum determined by the power spectrum computing process; a process to update the offset correction amount of the current sensor by an algorithm based on a gradient method; and a process to compute the offset correction amount of the current sensor, which reduces a value of the power spectrum determined by the power spectrum computing process.
According to another aspect of the present disclosure, there is provided a three-phase alternating current motor driving apparatus comprising: an inverter that supplies a current to a three-phase alternating current motor; a current sensor that measures the current supplied from the inverter to the three-phase alternating current motor; a controller that controls an amount of supply of the current from the inverter to the three-phase alternating current motor; a detector that detects an angle as a rotational position of the three-phase alternating current motor; a computation device that judges that the three-phase alternating current motor is at a constant speed, computes a position error by subtracting a detection angle from an angle command value, fast Fourier transforms the position error, and determines a power spectrum at an electrical angle frequency of the position error; and an offset correction computation unit that evaluates the power spectrum and corrects an offset error of the current sensor using an algorithm based on a gradient method. In this configuration, the torque ripple caused by the offset error of the current sensor of the three-phase alternating current motor driving apparatus and the position error of a control shaft of an NC machine tool are reduced.
According to the present disclosure, a control error caused by a detection error of a current sensor of a motor driving apparatus can be reduced. Further, according to an embodiment of the present disclosure described later, a torque ripple of a motor caused by an error included in a detection value of a current sensor of a motor driving apparatus can be reduced, a position error of an NC machine tool can be suppressed, and reliability and machining precision of the apparatus can be improved.
Embodiment(s) of the present disclosure will be described based on the following figures, wherein:
A torque ripple caused by an offset error of a current sensor and an evaluation method thereof will be briefly described. As a three-phase alternating current motor (motor), an SPM (Surface Permanent Magnet) motor may be employed.
A parameter τ represents a motor torque [N·m], a parameter Ke represents a torque constant [N·m/A], and a parameter iq represents a q-axis current [A]. A generation formula of torque in this case is as follows.
[Equation 1]
τ=Ke·iq (1)
In the SPM motor, the torque does not change even when a current is applied to a d axis, and the SPM motor has a characteristic in that the q-axis current iq and the torque are in a relationship of proportionality.
When a current of U phase, a current of V phase, and a current of W phase are respectively iu, iv, and iw, and an electrical angle is θre, the following relationship is true for the q-axis current iq.
Here, a case is considered in which, of the U phase, the V phase, and the W phase, current sensors are attached only for the U phase and the W phase. When offset errors of the current sensors of the U phase and the V phase are du and dw, the currents iu0 and iwo detected in the U phase and the W phase are respectively iuo=iu−du and iwo=iw−dw.
In place of attaching a current sensor for the V phase, an estimated value ivo of the V phase current iv is determined by the following equation.
[Equation 3]
ivo=−iuo−iwo (3)
An offset error dv of the V phase current estimation value is described as follows.
[Equation 4]
dv=−du−dw (4)
From Equation (2), the q-axis current iq is determined as follows.
A second term on the right side of Equation (5) shows an error component due to the offset of the current sensor.
If a ripple component of the torque caused by the offset error of the current sensor is described as τrip, due to linearity of iq as shown in Equation (1), the following equation can be obtained.
Further, using the relationship of Equation (4), Equation (6) can be rewritten in the following form.
From this equation, it can be seen that τrip oscillates at an electrical angle frequency.
Therefore, when the offset correction amounts of the currents detected in the U phase and the W phase are respectively a and b, and a power spectrum of the electrical angle frequency of a position error signal at the time of constant speed driving of the three-phase alternating current motor is P(θre), P(θre) can be expected to monotonically decrease with decreases of the offset errors du and dw. Thus, it is possible to evaluate the torque ripple caused by the offset error of the current sensor by measuring P(θre) during the constant speed driving.
Based on the above-described study, the problem of reducing the torque ripple by correcting the offset can be replaced with a problem of determining the offset correction amounts a and b which would reduce the power spectrum P(θre) during the constant speed driving.
If the rotational speed of the three-phase alternating current motor is not a constant speed, the change of P(θre) due to the offset error would depend on time. Specifically, because the position error due to τrip appears in a plurality of frequency components, it becomes difficult to accurately determine the evaluation value, caused by the torque ripple, for the current offset error.
An embodiment of the present disclosure will now be described.
Of the constituting elements shown in
The three-phase alternating current motor driving apparatus is connected to a position detector 107, receives an electrical signal from the position detector 107, and detects an angle θm as a rotational position of the three-phase alternating current motor. A control current is computed according to the detected angle θm and an angular speed ωm (not shown) obtained by time-differentiating the angle θm, and the control current is supplied through the inverter 104 to the three-phase alternating current motor 106. The three-phase alternating current motor 106 may be a synchronous motor having a rotor with a permanent magnet. For the rotor, a two-phase rotation (d and q axes) coordinate system is defined.
The current control device 101 computes a d-axis voltage command value vd and a q-axis voltage command value vq using a PI control and based on the d-axis current command value id* and the q-axis current command value iq* which are input, and a difference between the d-axis current value id and the q-axis current value iq converted by the three-phase-to-dq converter 108, and outputs the voltage command values to the dq-to-three-phase converter 102.
The dq-to-three-phase converter 102 computes voltage command values vu, vv, and vw for the U phase, the V phase, and the W phase based on the d-axis voltage command value vd and the q-axis voltage command value vq which are input, and the electrical angle θre of a rotor of the three-phase alternating current motor 106 detected by the position detector 107, and outputs the voltage command values to the PWM signal computation unit 103.
The PWM signal computation unit 103 computes a duty ratio corresponding to the U-phase voltage command value vu, the V-phase voltage command value vv, and the W-phase voltage command value vw, and outputs a pulse signal of the computed duty ratio to the inverter 104.
In the inverter 104, a ratio of ON times of a bridge upper semiconductor and a bridge lower semiconductor is controlled by the pulse signal, so as to apply alternating current voltages equal to the U-phase voltage command value vu, the V-phase voltage command value vv, and the W-phase voltage command value vw to three-phase windings (not shown) of the three-phase alternating current motor 106.
The current sensor 105 outputs detection values iuo and iwo of the U-phase current and the W-phase current, respectively, of the three-phase alternating current motor 106. The estimation value ivo of the V-phase current is computed as ivo=−iuo−iwo. The electrical angle θre is computed by multiplying the rotational angle θm by a number of pole pairs using the electrical angle converter 109. The three-phase-to-dq converter 108 computes and outputs the d-axis current id and the q-axis current iq by coordinate conversion, based on the electrical angle θre, the U-phase current iuo, and the W-phase current iwo.
The power spectrum computation unit 111 receives, as inputs, the electrical angle θre and a position error obtained by subtracting the angle θm from the commanded angle θm* (position command value), and computes and outputs a power spectrum P(θre) of a position error signal at the electrical angle frequency by fast Fourier transform.
The correction timing computation unit 112 judges a timing of correction based on the motor speed, a number of samplings necessary for the Fourier transform, or the like, and notifies the timing to the offset correction computation unit 110.
The offset correction computation unit 110 receives, as inputs, the power spectrum P(θre), and detection values and iuo and iwo the estimation value ivo of the phase currents, evaluates the power spectrum P(θre), and outputs an offset correction amount of the current sensor 105. An embodiment of the offset correction computation will now be described.
Next, the power spectrum is reduced by an algorithm similar to a gradient method. A reference sign tmp in
According to the value of the counter, i=1, 2, and 3, numerical value gradients grada and gradb for the offset correction amounts a and b are sequentially computed. Then, based on updating rules, a(n+1)=a(n)−κ·grada and b(n+1)=b(n)−κ·gradb, of the gradient method, the offset correction amounts a and b are updated. A reference sign n (not shown) indicates a number of updates of the offset correction amounts a and b. When the counter i reaches the count of 3, the counter i is initialized to 1.
The flowchart of
The offset correction computation unit 110 executes a process corresponding to the value i of the counter (S4, S21, S31). Specifically, the offset correction computation unit 110 executes step S5 when i=1, executes step S22 and then step S5 when i=2, and executes step S32 and then step S5 when i=3.
When i=1, the offset correction computation unit 110 determines the power spectrum P(θre) under a condition that the offset correction amounts a and b are initial values (S5). This process is executed by applying fast Fourier transform to the position error signal and determining a value of the spectrum at the electrical angle frequency.
When i=2, the offset correction computation unit 110 stores the value of the offset correction amount a in the variable tmp, and increases the offset correction amount a by the difference h (S22). In addition, when i=3, the offset correction computation unit 110 stores the value of the offset correction amount b in the variable tmp, and increases the offset correction amount b by the difference h (S32). The offset correction computation unit 110 determines the power spectrum P(θre) based on the offset correction amounts a and b which are set in step S22 or S32 (S5).
When i=1, the offset correction computation unit 110 sets the power spectrum P(θre), determined under the condition that the offset correction amounts a and b are initial values, as P1 (S6, S7). When i=2, the offset correction computation unit 110 sets the value of the offset correction amount a to the value stored in the variable tmp in step S22 (S23, S24). In addition, a numerical value gradient grada of the offset correction amount a is determined based on an equation of grada=(P(θre)−P1)/h (S24). When i=3, the offset correction computation unit 110 determines a numerical value gradient gradb of the offset correction amount b based on an equation of gradb=(P(θre)−P1)/h (S33, S34). In addition, the offset correction amount a is updated based on a formula of a=a−κ·grada (S34). Further, the offset correction amount b is updated based on a formula of b=tmp−κ·gradb (S34).
The offset correction computation unit 110 judges whether or not the value i of the counter is 3 or greater (S8), and, when the value i of the counter is 3 or greater, i is set to 1, and the process proceeds to a process of step S11 (S9). On the other hand, when the value i of the counter is 1 or 2, the offset correction computation unit 110 increments the value i of the counter by 1, and the process proceeds to the process of step S11 (S10). The offset correction computation unit 110 judges whether or not the position error is within an allowable range, that is, whether or not an absolute value of the position error is less than or equal to an allowable value (S11). When the position error is within the allowable range, the offset correction computation unit 110 completes the process, and, when the position error is outside of the allowable range, the process returns to the process of step S3.
As shown in
Further, as shown in
If the correction amount is to be updated once every 8 ms when the rotational speed of the three-phase alternating current motor is a constant speed, the value sufficiently converges when the constant speed section is 320 ms. Thus, according to the present method, the current offset is corrected in a simple manner without an in-advance adjustment or learning in each machine tool.
In the above-described embodiment, an algorithm similar to the steepest descent among the gradient method is used. Alternatively, the section method or other gradient methods may be used from the viewpoint of quickly reducing the power spectrum.
Number | Date | Country | Kind |
---|---|---|---|
JP2018-118781 | Jun 2018 | JP | national |
Number | Name | Date | Kind |
---|---|---|---|
6417982 | Ottesen | Jul 2002 | B1 |
7253987 | Shim | Aug 2007 | B1 |
8508171 | Miyaji | Aug 2013 | B2 |
8958170 | Harper | Feb 2015 | B1 |
9599969 | Miyaji | Mar 2017 | B2 |
10553248 | Iwashiro | Feb 2020 | B1 |
20070046677 | Hong | Mar 2007 | A1 |
20080117992 | Murokita | May 2008 | A1 |
20090252009 | Kubota | Oct 2009 | A1 |
20110051581 | Janik | Mar 2011 | A1 |
20140217952 | Miyaji | Aug 2014 | A1 |
20150137727 | Furutani | May 2015 | A1 |
20150158396 | Walters | Jun 2015 | A1 |
20160195869 | Sagemueller | Jul 2016 | A1 |
20170111000 | Saito | Apr 2017 | A1 |
20180262145 | Saito et al. | Sep 2018 | A1 |
Number | Date | Country |
---|---|---|
H089671 | Jan 1996 | JP |
2000152687 | May 2000 | JP |
2011061910 | Mar 2011 | JP |
5447810 | Mar 2014 | JP |
6080687 | Feb 2017 | JP |
2017079514 | Apr 2017 | JP |
Entry |
---|
JPO Notification of Reasons for Refusal for corresponding JP Application No. 2018-118781; dated, Aug. 17, 2021. |
Number | Date | Country | |
---|---|---|---|
20200059185 A1 | Feb 2020 | US |