Motor control device and motor control method
The motor control device and method address the issue of excessive current by using voltage command limiting based on rotational speed and fluctuation frequency, ensuring stable motor operation and preventing damage, even when current detection fails.
Patent Information
- Application Number
- JP2023073674
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-04-27
- Publication Date
- 2024-11-08
AI Technical Summary
Existing motor control systems fail to prevent excessive current from flowing to amplifiers or motors due to incorrect feedback signals from current detectors, leading to potential damage and malfunction of the amplifier and the motor, especially in robots with changing current requirements.
A motor control device and method that includes a current control unit, position detection, speed calculation, and voltage command limiting units to calculate and limit voltage command values based on rotational speed and fluctuation frequency, preventing excessive current by setting appropriate voltage limits for the d-axis and q-axis.
Prevents excessive current from flowing to the amplifier or motor, thereby protecting the amplifier and ensuring stable motor operation even when current detection systems fail, allowing for accurate motor control and preventing malfunctions.
Smart Images

Figure 2024158455000001_ABST
Abstract
Description
[Technical field]
[0001] The present disclosure relates to a motor control device and a motor control method. [Background technology]
[0002] Patent Document 1 discloses a motor control device including a speed control means, a torque control means, a power conversion means, and a speed feedback signal generation means. The motor control device includes a soft start means for generating a first speed command of a predetermined acceleration from a speed command and outputting the first speed command to the speed control means, and a voltage limiting means for generating a first voltage command so that the voltage command is equal to or lower than the limit voltage and outputting the first voltage command to the power conversion means, the first voltage command being set to a limit voltage equal to the sum of an induced voltage prediction value obtained by multiplying the first speed command by a motor induced voltage constant and an impedance voltage drop prediction value obtained by multiplying the motor impedance by a maximum current command. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2006-230119 A Summary of the Invention [Problem to be solved by the invention]
[0004] The present disclosure has been devised in view of the above-mentioned conventional situation, and has an object to prevent an excessive current from flowing to an amplifier or a motor. [Means for solving the problem]
[0005] The present disclosure provides a motor control device comprising a current control unit that supplies a drive current to a motor, a current detection unit that detects a current value of the drive current supplied to the motor, a position detection unit that detects a rotational position of the motor, and a speed calculation unit that calculates a rotational speed of the motor from the rotational position of the motor detected by the position detection unit, wherein the current control unit has a voltage command value calculation unit that calculates a voltage command value for driving the motor, based on a current command value of the motor and the current value detected by the current detection unit, and a voltage command limit unit that calculates a voltage command limit value that limits the voltage command value from the rotational speed of the motor calculated by the speed calculation unit and a fluctuation frequency of the current command value of the motor, and limits the voltage command value based on the calculated voltage command limit value.
[0006] The present disclosure also provides a motor control method including detecting a current value of a drive current supplied to a motor, detecting a rotational position of the motor, calculating a rotational speed of the motor from the detected rotational position of the motor, calculating a voltage command value for driving the motor based on a current command value of the motor and the detected current value, calculating a voltage command limit value that limits the voltage command value from the calculated rotational speed of the motor and a fluctuation frequency of the current command value of the motor, and limiting the voltage command value based on the calculated voltage command limit value.
[0007] These comprehensive or specific aspects may be realized as a system, an apparatus, a method, an integrated circuit, a computer program, or a recording medium, or may be realized as any combination of a system, an apparatus, a method, an integrated circuit, a computer program, and a recording medium. Effect of the Invention
[0008] According to the present disclosure, it is possible to prevent excessive current from flowing to an amplifier or a motor. [Brief description of the drawings]
[0009] [Figure 1] Block diagram of a conventional motor control system [Diagram 2] Block diagram of a motor control system according to an embodiment of the present invention. [Diagram 3] A diagram showing the voltage values required to accelerate the motor MT [Figure 4] A diagram showing an example of the motion of a robot driven by a motor MT. [Diagram 5] A diagram showing the voltage required to change the current when the robot moves in an arc. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0010] (Background to the present embodiment) As a method for driving a motor, there is known a control method using three-phase voltage commands for driving the motor by feeding back data on the motor position, motor speed, and actual measured values of the current flowing through the motor, which are detected by an encoder attached to the motor. As an example of control using three-phase voltage commands, there is known a control method using Pulse Width Modulation (hereinafter referred to as "PWM") commands. In the control method using three-phase voltage commands, the drive of the motor is controlled based on the various feedback signals described above.
[0011] Conventionally, when controlling the current of a motor, the limit value of the voltage command value for the amplifier that supplies current to the motor is set to the maximum allowable voltage that can be realized. However, if a failure occurs in a device that detects the current (e.g., a current detector or an A / D converter, etc.) and the device that detects the current is no longer able to detect the current flowing through the motor, the motor control device that controls the voltage will not be able to obtain a correct feedback signal. As a result, the motor control device may use an incorrect feedback signal to calculate a control voltage value, causing the voltage command value to reach the maximum allowable value, causing an excessive current to flow through the amplifier, which may destroy the amplifier. If an excessive current flows through the amplifier, the transistor in the main circuit of the amplifier will be damaged, destroying the amplifier.
[0012] In Patent Document 1, the limit voltage is the sum of an induced voltage prediction value obtained by multiplying a speed command value of a predetermined acceleration by the motor's induced voltage constant, and an impedance voltage drop prediction value obtained by multiplying the motor's impedance by the maximum current command.
[0013] However, if the limit voltage is set to a value required to maintain the rotation of the motor, the motor control device will not be able to output a voltage command required to change (i.e., increase) the current to the motor. Since the required current value changes according to the movement of a robot driven by a motor, there is a problem that the desired movement cannot be performed unless the voltage required to change the current value is obtained.
[0014] Hereinafter, with reference to the drawings as appropriate, a detailed description will be given of an embodiment specifically disclosing a motor control device and a motor control method according to the present disclosure. However, more detailed description than necessary may be omitted. For example, detailed description of already well-known matters and duplicated description of substantially identical configurations may be omitted. This is to avoid the following description becoming unnecessarily redundant and to facilitate understanding by those skilled in the art. Note that the accompanying drawings and the following description are provided to enable those skilled in the art to fully understand the present disclosure, and are not intended to limit the subject matter described in the claims.
[0015] First, a block diagram of a conventional motor control system 1 will be described with reference to Fig. 1. Fig. 1 is a block diagram of a conventional motor control system 1.
[0016] The motor control system 1 includes a power supply 5, a motor control device 10, an amplifier 20, an A / D converter 30, current detectors 31 and 32, a motor MT, and an encoder EN. Although not shown, the system may further include a memory and a communication interface.
[0017] The motor MT is, for example, a brushless motor such as a permanent magnet synchronous motor (PMSM), and includes a rotor that is rotatable about a shaft and holds a permanent magnet (not shown), and a stator that includes a three-phase coil in which three windings are wound around a stator core. The rotor is rotatably disposed so as to face the stator. In the motor MT, AC powers that are 120 degrees out of phase with each other are supplied from an amplifier 20 to the U-phase, V-phase, and W-phase windings (coils), causing the rotor of the motor MT to rotate about the shaft. The motor MT is used, for example, to drive industrial machines such as robots.
[0018] The encoder EN is attached to the motor MT. The encoder EN outputs a signal corresponding to the rotational position of the rotor (not shown) of the motor MT to the motor control device 10. In this way, the encoder EN detects the rotational position of the rotor of the motor MT as an electrical angle. If the rotational position or rotational speed of the rotor can be detected by estimation, the configuration of the encoder EN may be omitted. Also, instead of the encoder EN, a Hall element capable of detecting the rotational position of the motor MT may be arranged near the rotor. In this case, a signal indicating the position information detected by the Hall element is input as a feedback signal to each of the motor control devices 10.
[0019] The motor control device 10 controls the driving of the motor MT according to a command for the position of the motor MT and feedback of the position of the motor MT. The motor control device 10 performs vector control based on a dq-axis coordinate system consisting of a d-axis, which is the magnetic flux direction of a permanent magnet held by a rotor held by the motor MT, and a q-axis perpendicular to the d-axis, for a current to be passed through the motor MT for rotation control of the motor MT. More specifically, for example, the motor control device 10 performs current control based on vector control in which an input on the d-axis is used as a d-axis current value to generate a voltage command for the d-axis (hereinafter referred to as a d-axis voltage command), and an input on the q-axis is used as a q-axis current value to generate a voltage command for the q-axis (hereinafter referred to as a q-axis voltage command). Note that the rotation control of the motor MT performed by the motor control device 10 is not limited to the above example, and may be control in which current control based on vector control in which an input on the d-axis is used as a d-axis current value to generate a d-axis voltage command, and voltage control based on speed control in which an input on the q-axis is used to generate a q-axis voltage command. The motor control device 10 is communicatively connected to the amplifier 20, the A / D converter 30, and the encoder EN. The motor control device 10 outputs a command to the amplifier 20 to supply a current to the motor MT using the vector control described above.
[0020] The motor control device 10 has a movement command control unit 11 , a position control unit 12 , a speed control unit 13 , a movement amount calculation unit 14 , a speed calculation unit 15 , a current control unit 16 and a magnetic pole position calculation unit 17 .
[0021] The movement command control unit 11 generates a change amount of the rotation angle of the motor shaft based on an operation program of the driven body of the motor MT created by a user (e.g., a person who constructs the motor control system 1, etc.). The movement command control unit 11 generates a position command value Δθm* related to the position, which is the change amount of the motor MT position for each control period Tp. The movement command control unit 11 outputs the position command value Δθm* to the position control unit 12. Hereinafter, the command value related to the position is referred to as the position command value. The subscript m represents the axis of the robot driven by the motor MT. For example, when the motor MT drives a 6-axis robot, m is an integer from 1 to 6 corresponding to each axis.
[0022] Position control unit 12 calculates a command value for speed (hereinafter referred to as speed command value) W* based on the position command value Δθm* from movement command control unit 11 and a feedback signal (hereinafter referred to as position FB) Δθm of the position of motor MT from movement amount calculation unit 14. Position control unit 12 outputs the calculated speed command value W* to speed control unit 13. Note that FB is an abbreviation for Feedback. Position control unit 12 calculates the speed command value by multiplying the position deviation amount by a coefficient related to the position gain. The position deviation amount is a value expressed by the following (Equation 1).
[0023]
number
[0024] The speed control unit 13 calculates a current command value (hereinafter referred to as a q-axis current command value) Iq*, which is a target value of the current for the q-axis, based on the speed command value W* received from the position control unit 12 and a feedback signal (hereinafter referred to as a speed FB) W of the motor MT from the speed calculation unit 15. The speed control unit 13 outputs the calculated q-axis current command value Iq* to the PI control unit 162. Note that the current command value (hereinafter referred to as a d-axis current command value), which is a target value of the current for the d-axis, is set to 0.
[0025] The movement amount calculation unit 14 outputs to the position control unit 12 the amount of change per unit time of the rotation angle θm of the rotor detected by the encoder EN (that is, the position FBΔθm).
[0026] The speed calculation unit 15 calculates a speed FBW which is the rotational speed of the rotor of the motor MT by dividing a position FBΔθm which is the amount of change per unit time of the rotation angle θm of the rotor detected by the encoder, by a time corresponding to a predetermined period.
[0027] The current control unit 16 performs a two-phase to three-phase conversion process to convert voltage commands (a d-axis voltage command value Vd* and a q-axis voltage command value Vq*, which will be described later) for the d-axis, which is the field direction of the motor MT, and the q-axis, which is a direction perpendicular to the d-axis, into three-phase voltage commands (PWM commands) to be applied to the U-phase, V-phase, and W-phase of the motor MT. The current control unit 16 has a PI control unit 161, a PI control unit 162, a two-phase to three-phase conversion unit 165, a dq conversion unit 166, and a PWM processing unit 169.
[0028] The PI control unit 161 generates a d-axis voltage command value Vd* so that an error, which is a difference between the value of the d-axis current command value Id* and the d-axis current Id from the dq conversion unit 166, becomes zero. The d-axis voltage command value Vd* is a target value of the voltage for the d-axis. The d-axis current Id will be described later. For example, the PI control unit 161 performs proportional integral processing on the difference between the value of the d-axis current command value Id* and the value of the d-axis current Id, and sets the result of the proportional integral as the d-axis voltage command value Vd*.
[0029] The PI control unit 162 generates a q-axis voltage command value Vq* so that an error, which is a difference between the value of the q-axis current command value Iq* from the speed control unit 13 and the q-axis current Iq from the dq conversion unit 166, becomes zero. The q-axis voltage command value Vq* is a target value of the voltage for the q-axis. The q-axis current Iq will be described later. For example, the PI control unit 162 performs proportional integral processing on the difference between the value of the q-axis current command value Iq* and the value of the q-axis current Iq, and sets the result of the proportional integral as the q-axis voltage command value Vq*.
[0030] The PI control unit 161 and the PI control unit 162 perform fixed limit processing 163, 164. The fixed limit processing is a processing for setting the voltage command value to the maximum voltage value when the generated voltage command value exceeds the maximum voltage value that can be realized.
[0031] The 2-phase to 3-phase conversion unit 165 performs 2-phase to 3-phase conversion of the d-axis voltage command value Vd* from the PI control unit 161 and the q-axis voltage command value V1* from the PI control unit 162, using an electrical angle determined according to the rotation angle of the rotor (not shown) detected by the encoder EN and input from the magnetic pole position calculation unit 17, to calculate three-phase voltage command values (Vu*, Vv*, Vw*) for obtaining voltages to be applied to each phase of the motor MT.
[0032] The PWM processing unit 169 performs pulse width modulation (PWM) on the three-phase voltage command value from the two-phase to three-phase conversion unit 165, for example, by a triangular wave comparison method, to generate PWM signals U1, U2, V1, V2, W1, and W2, and outputs them to the amplifier 20. Here, the PWM signals U1 and U2 are signals that are turned ON / OFF at a ratio according to the magnitude of the three-phase voltage command value from the two-phase to three-phase conversion unit 165 within a certain time Ti (for example, 100 μs). When the PWM signal U1 is ON, a positive voltage Vp is applied from the power supply 5 to the U phase of the motor MT, and when the PWM signal U2 is ON, a negative voltage Vn is applied from the power supply 5 to the U phase of the motor MT. When either the PWM signal U1 or U2 is ON, the other is OFF. Depending on the ratio of the ON time of each of the PWM signals U1 and U2 within the time Ti, a voltage within the range of voltages Vp to Vn is equivalently realized. The same is true for the PWM signals V1, V2 and the PWM signals W1, W2, which correspond to the V phase and the W phase, respectively.
[0033] The dq conversion unit 166 calculates a d-axis current Id and a q-axis current Iq, which are the detected currents of the d-axis and q-axis, from the U-phase current Iu detected by the current detector 31, the V-phase current Iv detected by the current detector 32, and the electrical angle detected by the encoder EN and input from the magnetic pole position calculation unit 17. The U-phase current Iu is a feedback of the current value flowing through the U-phase. The V-phase current Iv is a feedback of the current value flowing through the V-phase. The d-axis current Id is input to the PI control unit 161 as a feedback of the d-axis current. The q-axis current Iq is input to the PI control unit 162 as a feedback of the q-axis current.
[0034] The magnetic pole position calculation unit 17 calculates the electrical angle θe from the rotor rotation angle θm detected by the encoder EN. For example, in the case of a rotor with two poles and one pair, θe=θm. In the case of a rotor with eight poles and four pairs, θe=4θm. The magnetic pole position calculation unit 17 outputs the electrical angle θe to the PWM processing unit 169 and the dq conversion unit 166.
[0035] The power supply 5 supplies a DC power supply voltage to the amplifier 20. The power supply 5 has an AC power supply 51, a diode 52, and a capacitor 53 connected in parallel, and supplies the amplifier 20 with a positive voltage Vp and a negative voltage Vn, which are DC voltages.
[0036] The amplifier 20 applies a voltage to the motor MT based on a PWM signal from the motor control device 10, and supplies the resulting current. The amplifier 20 receives the PWM signal from the motor control device 10, converts the DC voltage and DC current from the power supply 5 into AC voltage and AC current, and supplies them to the motor MT. The amplifier 20 is connected to the power supply 5, the motor control device 10, and the motor MT.
[0037] The A / D converter 30 converts the actual measured value of the current supplied to the motor, detected by the current detectors 31 and 32, from an analog signal to a digital signal using known technology. The current detector 31 detects a U-phase current Iu supplied to the U-phase and outputs it to the A / D converter 30. The current detector 32 detects a V-phase current Iv supplied to the V-phase and outputs it to the A / D converter 30. The W-phase current Iw, which is the current of the W-phase, is calculated from the U-phase current Iu and the V-phase current Iv using the relational equation Iu+Iv+Iw=0. The A / D converter 30, current detector 31, and current detector 32 are collectively referred to as a current detection system.
[0038] When the current detection system fails, the U-phase current Iu, the V-phase current Iv, and the W-phase current Iw output from the A / D converter 30 become erroneous values. When the current detection system fails, for example, the actual measured value of the current output from the A / D converter 30 is fixed to a certain value. When the actual measured value of the current output from the A / D converter 30 is fixed to a certain value, the values of the d-axis current Id and the q-axis current Iq output from the dq conversion unit 166 are also fixed to a certain value. The PI control unit 161 and the PI control unit 162 are the difference between the value of the current command value from the speed control unit 13 and the value from the dq conversion unit 166. As a result, the difference with the current command value (Iq*, Id*) does not become zero, and it is accumulated in the integral term of the PI control units 161 and 162, and the output (Vq*, Vd*) of the PI control units 161 and 162 diverges.
[0039] In the conventional motor control system 1, when the value of the d-axis voltage command value Vd* exceeds the maximum voltage value that can be realized, the PI control unit 161 sets the d-axis voltage command value Vd* to the maximum voltage value that can be realized based on the process 163. Similarly, when the value of the q-axis voltage command value Vq* exceeds the maximum voltage value that can be realized, the PI control unit 162 sets the q-axis voltage command value Vq* to the maximum voltage value that can be realized based on the process 164. When the motor MT is rotating at a low speed, if the d-axis voltage command value Vd* and the q-axis voltage command value Vq* are the maximum voltage values that can be realized, a current that exceeds the maximum allowable current value will flow to the motor MT, which may damage the amplifier 20 or the motor MT. Furthermore, when the motor MT is driven with an incorrect voltage command value, industrial machines such as robots driven by the motor MT may malfunction, causing an accident or failure.
[0040] Next, a block diagram of a motor control system 2 according to the present embodiment will be described with reference to Fig. 2. Fig. 2 is a block diagram of a motor control system 2 according to the present embodiment. The same components as those in Fig. 1 are denoted by the same reference numerals and description thereof will be omitted.
[0041] Motor control device 10A has voltage command limiting units 167 and 168 in current control unit 16A.
[0042] The speed calculation unit 15 outputs the calculated speed FBW to the voltage command limiting unit 167 and the voltage command limiting unit 168.
[0043] The voltage command limiting unit 167 limits the value of the d-axis voltage command value Vd* output from the PI control unit 161 and outputs the limiting value to the 2-phase to 3-phase conversion unit 165. The voltage command limiting unit 167 calculates the d-axis voltage command value Vd* from the rotation speed of the motor MT and a parameter specifying the rate of change of the current command value of the motor MT, and sets the value as the limiting value of the d-axis voltage command value Vd* (hereinafter referred to as the "d-axis voltage limiting value"). The d-axis voltage limiting value Vdlim is expressed by the following equation (2). The parameter specifying the rate of change of the current command value of the motor MT is defined as a fluctuation frequency. This parameter is given by a frequency value. Hereinafter, f1 and f2 are fluctuation frequencies.
[0044]
number
[0045] Here, Idmax is the maximum value of the d-axis current, Iqmax is the maximum value of the q-axis current, f2 is a parameter that specifies the speed of change of the d-axis current, L is the winding inductance of the motor MT, R is the winding resistance of the motor MT, p is the number of pole pairs of the motor, and W is the rotational speed of the motor MT.
[0046] The first term on the right side of equation (2) represents the maximum voltage required to change the d-axis current of motor MT at a speed specified by f2 while maintaining it within its maximum value Idmax. The second term on the right side of equation (2) represents the voltage required to cancel out the interference voltage due to the q-axis current. This interference voltage is the voltage that appears on the d-axis when the rotating magnetic field due to the q-axis current induces a three-phase AC voltage in the windings of motor MT and this three-phase AC voltage is subjected to dq conversion. The interference voltage is proportional to the product of the number of pole pairs p of the motor, which is the angular velocity of the three-phase AC, and the rotational speed W of motor MT.
[0047] The voltage command limiting unit 168 limits the value of the q-axis voltage command value Vq* output from the PI control unit 162 and outputs the limit to the 2-3 phase conversion unit 165. The voltage command limiting unit 168 calculates the q-axis voltage command value Vq* from the rotation speed of the motor MT and a parameter that specifies the rate of change of the current command value of the motor MT, and sets the value as a limit value of the q-axis voltage command value Vq* (hereinafter referred to as the "q-axis voltage limit value"). The q-axis voltage limit value Vqlim is expressed by the following equation (3).
[0048]
number
[0049] Here, Idmax is the maximum value of the d-axis current, Iqmax is the maximum value of the q-axis current, f1 is a parameter that specifies the speed of change of the q-axis current, L is the winding inductance of the motor MT, R is the winding resistance of the motor MT, p is the number of pole pairs of the motor, W is the rotational speed of the motor MT, and Kv is the induced voltage constant. It is.
[0050] The first term on the right side of equation (3) represents the maximum voltage required to change the magnitude of the q-axis current of motor MT at the speed specified by f1 while maintaining it within the range of its maximum value Iqmax. The second term on the right side of equation (3) represents the voltage required to cancel out the interference voltage caused by the d-axis current. The interference voltage is the voltage that appears on the q-axis when the rotating magnetic field caused by the d-axis current induces a three-phase AC voltage in the windings of motor MT and this three-phase AC voltage is subjected to dq conversion. The interference voltage is proportional to the product of the number of pole pairs p of the motor, which is the angular velocity of the three-phase AC, and the rotational speed W of motor MT. The third term on the right side of equation (3) represents the voltage required to cancel out the induced voltage generated by the rotating magnet.
[0051] The parameter f1 corresponds to the amount of change per unit time of the q-axis current required to change the rotation speed of the motor MT (i.e., the slope of graph C2 in FIG. 3). The fluctuation frequency f2 corresponds to the amount of change per unit time of the d-axis current required to change the rotation speed of the motor MT (i.e., the slope of graph C3 in FIG. 3). f1 and f2 are values determined in advance by the user. f1 and f2 are given as frequency values. In this case, the maximum speed of change of the q-axis current and the d-axis current is 2πf1 [s -1 ], 2πf2[s -1 For example, if f1 is set to 10 [Hz] and f2 is set to 1 [Hz], the maximum speed of change of the q-axis current and the d-axis current (slope with respect to time) will be approximately 62.8 [s -1 ], approximately 6.3[s -1 Note that the values of f1 and f2 are merely examples and are not limited to these.
[0052] Furthermore, since the interference voltage and induced voltage are proportional to the speed, the value increases as the speed increases, and the value decreases as the speed decreases.
[0053] As described above, from the formula (2) and the formula (3), the d-axis voltage limit value Vdlim and the q-axis voltage limit value Vqlim fluctuate in accordance with the rotation speed of the motor MT based on the respective values determined by the parameters f1 and f2. As a result, the voltage command limiting unit 167 can prevent the d-axis voltage command value from becoming the maximum voltage value that can be realized even if a failure occurs in the current detection system by limiting the d-axis voltage command value Vd* using the d-axis voltage limit value Vdlim in the formula (2). Furthermore, the voltage command limiting unit 168 can prevent the q-axis voltage command value from becoming the maximum voltage value that can be realized even if a failure occurs in the current detection system by limiting the q-axis voltage command value Vq* using the q-axis voltage limit value Vqlim in the formula (3). Furthermore, the voltage command limiting unit 167 and the voltage command limiting unit 168 calculate the d-axis voltage limit value Vdlim and the q-axis voltage limit value Vqlim in accordance with the fluctuation frequency and the rotation speed of the motor MT, and therefore can calculate appropriate limit values in accordance with the movement of a robot or the like driven by the motor MT. That is, the voltage command limiting unit 167 and the voltage command limiting unit 168 can set the d-axis voltage limit value Vdlim and the q-axis voltage limit value Vqlim to low values when the motor MT drives at a low speed, and can set the d-axis voltage limit value Vdlim and the q-axis voltage limit value Vqlim to high values when the motor MT drives at a high speed. This allows the voltage command limiting unit 167 and the voltage command limiting unit 168 to output to the PWM processing unit 169 a voltage command value that can cause a current value sufficient to drive the motor MT to flow while preventing the generation of an excessive current when the current detection system fails.
[0054] Next, voltage values required when accelerating the motor MT will be described with reference to Fig. 3. Fig. 3 is a diagram showing voltage values required when accelerating the motor MT.
[0055] The horizontal axis of graphs C1, C2, C3, C4, C5, and C6 is time, and all of them show the same time axis. The horizontal axis of graphs C1, C2, C3, C4, C5, and C6 shows the time t1 and time t2, respectively, represented by dotted lines.
[0056] Graph C1 shows the change in the rotational speed of the motor MT over time. The vertical axis is the rotational speed of the motor MT, W [rad / s]. Between time t1 and time t2, the rotational speed of the motor MT increases from speed Ws to speed Wk. In this case, the acceleration of the motor MT is (Wk-Ws) / (t2-t1) [rad / s 2 ] is expressed as
[0057] Graph C2 is a graph showing the q-axis current required when changing the rotation speed of motor MT as shown in graph C1. Graph C3 is a graph showing the d-axis current. The vertical axis represents the values of the q-axis current Iq [A] and the d-axis current Id [A]. From time t1, the q-axis current Iq increases in order to increase the rotation speed of motor MT. As the rotation speed of motor MT approaches speed Wk, the q-axis current Iq gradually decreases, and at time t2, the q-axis current Iq becomes a current value for maintaining speed Wk. This q-axis current Iq generates torque in motor MT. The torque of motor MT is expressed as the product of Kt and the q-axis current Iq. Kt is the torque constant. The maximum value of the change per unit time dIq / dt of the q-axis current in graph C2 corresponds to the parameter f1.
[0058] The d-axis current Id is normally 0 (zero) as it does not contribute to the generation of torque in the motor MT. When the motor MT rotates at high speed, it may be controlled to a negative d-axis current Id as shown in graph C3. By making the d-axis current Id negative, the magnetic field of the magnet in the motor MT is weakened, reducing the induced voltage caused by the magnet and achieving high speed rotation of the motor MT. The maximum value of the change per unit time of the d-axis current, dId / dt, in graph C3 corresponds to the parameter f2.
[0059] Graph C4 is a graph showing the phase current of phase U. The amplitude of the phase current is proportional to the following equation (4).
[0060]
number
[0061] The phase currents of the V and W phases are sine waves with the same amplitude as the phase current of the U phase and a phase difference of 2π / 3.
[0062] Graph C5 represents each component of the q-axis voltage required to change the rotation speed of the motor MT as shown in graph C1. Graph C51 represents the induced voltage caused by a rotating magnet. Graph C51 is expressed as the product of the induced voltage constant Kv and the rotation speed W of the motor MT. Graph C51 corresponds to the three items on the right side of equation (3).
[0063] Graph C52 is the sum of the voltage for maintaining the q-axis current and the voltage required to change the q-axis current. Graph C52 is expressed by the following formula (5).
[0064]
number
[0065] The first term in equation (5) represents the voltage required to maintain the q-axis current, and the second term represents the voltage required to change the q-axis current. Iq' is the first time derivative of the q-axis current Iq. The maximum value of graph C52 corresponds to the first term on the right side of equation (3).
[0066] Graph C53 shows the interference voltage due to the d-axis current. Graph C53 is expressed as the product of the number of pole pairs p of the motor MT, the rotation speed W of the motor MT, the winding inductance L of the motor MT, and the d-axis current Id. Graph C53 corresponds to the two items on the right side of equation (3).
[0067] The q-axis voltage limit value Vqlim is expressed as the sum of the maximum values of graphs C51 and C52 and graph C53 when the q-axis current and the d-axis current are at their maximum values (i.e., Iqmax, Idmax). In other words, the q-axis voltage limit value Vqlim is a value that changes over time in response to changes in the rotation speed of the motor MT. This allows the motor control device 10A to appropriately control the voltage limit value in response to changes in the rotation speed of the motor MT.
[0068] Graph C6 represents the d-axis voltage required when changing the rotation speed of motor MT as shown by graph C1.
[0069] Graph C61 shows the interference voltage due to the q-axis current. Graph C61 is expressed as the product of the number of pole pairs p of the motor MT, the rotation speed W of the motor MT, the winding inductance L of the motor MT, and the q-axis current Iq. Graph C61 corresponds to the two items on the right side of equation (2).
[0070] Graph C62 is the sum of the voltage for maintaining the d-axis current and the voltage required to change the d-axis current. Graph C62 is expressed by the following formula (6).
[0071]
number
[0072] The first term in equation (6) represents the voltage required to maintain the d-axis current, and the second term represents the voltage required to change the q-axis current. Id' is the value obtained by differentiating the d-axis current Id with respect to time t. Graph C62 corresponds to the first term on the right side of equation (2).
[0073] The d-axis voltage limit value Vdlim is expressed as the sum of graphs C61 and C62 when the q-axis current and the d-axis current are at their maximum values. In other words, the d-axis voltage limit value Vdlim is a value that changes over time in response to changes in the rotation speed of the motor MT. This allows the motor control device 10A to appropriately control the voltage limit value in response to changes in the rotation speed of the motor MT.
[0074] Hereinafter, with reference to Figs. 4 and 5, a description will be given of the change in the magnitude of the current and the voltage required for the movement of a robot driven by a motor MT.
[0075] Next, an example of the movement of the robot driven by the motor MT will be described with reference to Fig. 4. Fig. 4 is a diagram showing an example of the movement of the robot driven by the motor MT.
[0076] The robot RO is a six-axis robot arm having six joints driven by motors MT.
[0077] Below, we will explain the magnitude of the current change and the voltage required for the current change when the tip Am of the robot RO moves in an arc with one period T [s] with reference to Figure 5. The xyz coordinates of the center position of the circle are Pc (xc, 0, zc), and the radius is r [m].
[0078] Next, the voltage required for the current change when the robot performs an arc motion will be described with reference to Fig. 5. Fig. 5 is a diagram showing the voltage required for the current change when the robot performs an arc motion.
[0079] Graph C7 is a graph showing the position change in the y direction. The position change in the y direction is expressed by the following formula (7).
[0080]
number
[0081] Here, ω is the angular velocity of the movement of the tip Am and is expressed by the following equation (8).
[0082]
number
[0083] Here, T [s] is one period of the circular motion of the robot RO, and f is 1 / T [Hz].
[0084] Graph C8 is a graph showing the velocity y' (y'=dy / dt) in the y direction, and is expressed by the following formula (9).
[0085]
number
[0086] The rotation speed W of the motor MT of the first axis at the speed y' is approximately expressed by the following equation (10).
[0087]
number
[0088] Hereinafter, motor MT refers to the motor of the first axis.
[0089] Here, Rg is the reduction ratio and C = r Rg / xc.
[0090] Graph C9 is a graph showing the acceleration W' (W'=dW / dt) of the motor MT. The acceleration W' is expressed by the following formula (11).
[0091]
number
[0092] Graph C10 is a graph showing the q-axis current Iq required to obtain the acceleration W' of the motor MT. The q-axis current Iq is expressed by the following formula (12).
[0093]
number
[0094] Here, M represents the inertia converted into the motor shaft, Kt represents the torque constant of the motor, and the current Ia represents the maximum amplitude value of graph C10, C M / Kt ω 2 C and M change depending on the posture of the robot RO and the position of the tip Am. In other words, the value of the current Ia, which is the maximum value of the q-axis current Iq required to obtain the acceleration W' of the motor MT, changes depending on the posture and position of the robot RO.
[0095] The q-axis voltage vq for obtaining the q-axis current Iq is expressed by equation (13).
[0096]
number
[0097] Here, vr is the voltage required to maintain the q-axis current, and vl is the voltage required to change the q-axis current. vr is expressed by equation (14), and vl is expressed by equation (15).
[0098]
number
[0099]
number
[0100] From equations (13), (14), and (15), vq is expressed by equation (16).
[0101]
number
[0102] Where:
number
number
[0103] It is.
[0104] In this way, the q-axis voltage vq required for the robot RO to perform the arc motion is calculated. The value of the current Ia is the maximum value of the current required for the robot RO to perform the arc motion shown in Fig. 4. Note that, as shown in graph C62 in Fig. 3, the d-axis voltage hardly contributes to the operation of the robot RO, so a description thereof will be omitted.
[0105] In this way, the q-axis voltage required for the operation of an industrial machine such as a robot driven by the motor MT is calculated. The voltage command limiting unit 168 uses the maximum value Iqmax of the q-axis current to determine the limiting value of the q-axis voltage required for the operation of an industrial machine such as a robot driven by the motor MT, and can set an optimal limiting value of the q-axis voltage for the type of operation. This allows the motor control device 10A to prevent an excessive current from being supplied to the amplifier 20 and the motor MT while realizing the current change required for the desired operation.
[0106] The q-axis voltage limit value Vqlim may be expressed by replacing one term on the right side of equation (3) with equation (16). In this case, the value of current Ia is the maximum value Iqmax of the q-axis current or a value obtained by multiplying current Ia by a predetermined constant. This enables motor control device 10A to calculate q-axis voltage limit value Vqlim in accordance with the operation of industrial machinery such as a robot driven by motor MT, and to prevent excessive restriction of the voltage command value.
[0107] (Summary of this embodiment) The above description of the present embodiment discloses the following techniques.
[0108] <Technology 1> The motor control device according to this embodiment includes a current control unit that supplies a drive current to the motor, a current detection unit that detects the current value of the drive current supplied to the motor, a position detection unit that detects the rotational position of the motor, and a speed calculation unit that calculates the rotational speed of the motor from the rotational position of the motor detected by the position detection unit. The current control unit has a voltage command value calculation unit that calculates a voltage command value for driving the motor based on the motor current command value and the current value detected by the current detection unit, and a voltage command limiting unit that calculates a voltage command limit value that limits the voltage command value from the motor rotational speed calculated by the speed calculation unit and the fluctuation frequency of the motor current command value, and limits the voltage command value based on the calculated voltage command limiting value.
[0109] As a result, the motor control device according to this embodiment can prevent an excessive current from being supplied to the amplifier or motor even if the current detection system breaks down and the voltage command value diverges, by calculating a voltage command limit value that limits the voltage command value from the motor's variable frequency and rotation speed. Furthermore, because the motor control device calculates a voltage command limit value according to the desired operation of the motor each time, it can prevent the voltage command value from being excessively limited, making it impossible to ensure the voltage required to change the motor's rotation speed.
[0110] <Technology 2> In the motor control device described in Technique 1, the current control unit calculates voltage command limit values for the d-axis and q-axis, respectively.
[0111] This allows the motor control device according to this embodiment to calculate limit values appropriate for the d-axis voltage command value and the q-axis voltage command value, respectively, and thus prevents the motor control device from excessively limiting the voltage command value.
[0112] <Technology 3> In the motor control device described in Technique 1 or Technique 2, the current control unit calculates the sum of an impedance voltage value, which is the product of the maximum current and the impedance, using a variable frequency, and an interference voltage value, which is the product of the motor rotation speed and the maximum current, as a d-axis voltage command limit value.
[0113] As a result, the motor control device according to this embodiment can calculate the voltage command limit value based on the d-axis voltage value required when changing the rotation speed of the motor.
[0114] <Technology 4> In the motor control device according to any one of Techniques 1 to 3, the current control unit calculates, using a varying frequency, the sum of an impedance voltage value which is the product of the maximum current and the impedance, an interference voltage value which is the product of the motor rotation speed and the maximum current, and an induced voltage which is the product of an induced voltage constant and the motor rotation speed, as a q-axis voltage command control value.
[0115] As a result, the motor control device according to this embodiment can calculate the voltage command limit value based on the q-axis voltage value required when changing the rotation speed of the motor.
[0116] Although the embodiments have been described above with reference to the accompanying drawings, the present disclosure is not limited to such examples. It is clear that a person skilled in the art can conceive of various modifications, corrections, substitutions, additions, deletions, and equivalents within the scope of the claims, and it is understood that these also belong to the technical scope of the present disclosure. In addition, the components in the above-mentioned embodiments may be arbitrarily combined within the scope of the invention. [Industrial Applicability]
[0117] The technology disclosed herein is useful as a motor control device and a motor control method that prevent an excessive current from flowing to an amplifier or a motor. [Explanation of symbols]
[0118] 1,2 Motor control system 5 Power supply 10 Motor control device 11 Movement command control unit 12 Position control section 13 Speed control section 14. Movement amount calculation section 15 Speed calculation section 16 Current control section 17 Magnetic pole position calculation section 20 Amps 30 A / D converter 31,32 Current detector 51 AC power supply 52 Diode 53 Capacitor 161 PI control section 162 PI control section 163,164 Processing 165 2-phase to 3-phase converter 166 dq conversion unit 167,168 Voltage command limiter 169 PWM processing unit MT motor EN Encoder RO Robot Am tip
Claims
1. a current control unit for supplying a drive current to the motor; a current detection unit that detects a current value of the drive current supplied to the motor; a position detection unit that detects a rotational position of the motor; a speed calculation unit that calculates a rotation speed of the motor based on the rotation position of the motor detected by the position detection unit, The current control unit is a voltage command value calculation unit that calculates a voltage command value for driving the motor based on a current command value of the motor and the current value detected by the current detection unit; a voltage command limiting unit that calculates a voltage command limit value that limits the voltage command value from the rotation speed of the motor calculated by the speed calculation unit and a fluctuation frequency of the current command value of the motor, and that limits the voltage command value based on the calculated voltage command limit value. Motor control device.
2. The current control unit calculates the voltage command limit values of the d-axis and the q-axis, respectively. The motor control device according to claim 1 .
3. the current control unit calculates, as the d-axis voltage command limit value, the sum of a maximum voltage value required to maintain the d-axis current within a maximum current range and change it at the speed of the fluctuation frequency, and a voltage value required to cancel an interference voltage that is the product of the rotation speed of the motor and the maximum current value. The motor control device according to claim 2 .
4. the current control unit calculates, as the q-axis voltage command control value, the sum of a maximum voltage value required to maintain the q-axis current within a maximum current range and change it at the rate of the fluctuation frequency, a voltage value required to cancel an interference voltage that is the product of the rotation speed of the motor and the maximum current value, and a voltage required to cancel an induced voltage that is the product of an induced voltage constant and the rotation speed of the motor. The motor control device according to claim 2 .
5. Detecting the current value of the drive current supplied to the motor; Detecting a rotational position of the motor; calculating a rotation speed of the motor based on the detected rotation position of the motor; Calculating a voltage command value for driving the motor based on a current command value of the motor and the detected current value; calculating a voltage command limit value that limits the voltage command value from the calculated rotation speed of the motor and a variation frequency of the current command value of the motor; limiting the voltage command value based on the calculated voltage command limit value; Motor control methods.
Citation Information
Patent Citations
Motor controller and control method thereof
JP2006230119A
